PyKDL---运动段、运动链和运动树

标签: KDL库专栏


如何描述机器人,这是一个很重要的问题,方法得当,可以大大简化问题,KDL采用段、链、树三个层级来描述机器人,可以方便地运用于串联和并联机器人。

在这里插入图片描述

机器人描述最小单元:Segment

首先,我们思考一个问题,描述机器人最小结构需要那些参数:关节、坐标、连杆质量、连杆惯性张量。
在这里插入图片描述在图中可以看出,segment拥有一个参考坐标系、关节坐标系、质心坐标系,tip坐标系,其中参考坐标系通常与关节坐标系重合,tip坐标系用于描述杆件姿态,同时作为下一个segment的参考坐标系,质心坐标系与参考坐标系同向。
在KDL中采用三个结构体来描述,关节、坐标,刚体惯量,PyKDL中建立方法如下

#创建段
segment1 = PyKDL.Segment(joint1, frame1, RBI)
print "segment1:\n", segment1
---输出结果---
segment1:
NoName:[NoName:[RotZ, axis: [           0,           0,           1], origin[           0,           0,           0]],
 tip: 
[[    0.540302,           0,    0.841471;
            0,           1,           0;
    -0.841471,           0,    0.540302]
[           3,           2,           4]]]

建立坐标:Frame

在建立segment中,Frame表示tip坐标系相对于参考坐标系的位姿,坐标系可以表示连杆的姿态和位置,类似齐次矩阵,详细内容参照PyKDL—常用变量详解,PyKDL建立坐标如下

#坐标
frame1 = PyKDL.Frame(PyKDL.Rotation.RPY(0, 1, 0), PyKDL.Vector(3, 2, 4))
print "frame1:\n", frame1
---输出结果---
frame1:
[[    0.540302,           0,    0.841471;
            0,           1,           0;
    -0.841471,           0,    0.540302]
[           3,           2,           4]]

关节描述:Joint

KDL库源码中对关节参数进行定义:

  • 1 关节名字:name
  • 2 原点:origin
  • 3 轴:_axis
  • 4 关节类型:JointType
    JointType = None # (!) real value is ‘’
    None = 8
    RotAxis = 0
    RotX = 1
    RotY = 2
    RotZ = 3
    TransAxis = 4
    TransX = 5
    TransY = 6
    TransZ = 7
  • 5 传动比:scale,一般默认设置就可以
  • 6 偏置:offset
  • 7 惯量:inertia,绕转动轴的一维惯量
  • 8 阻尼:damping
  • 9 刚度:stiffness
  /**
         * Constructor of a joint.
         *
         * @param name of the joint
         * @param origin the origin of the joint
         * @param axis the axis of the joint
         * @param scale scale between joint input and actual geometric
         * movement, default: 1
         * @param offset offset between joint input and actual
         * geometric input, default: 0
         * @param inertia 1D inertia along the joint axis, default: 0
         * @param damping 1D damping along the joint axis, default: 0
         * @param stiffness 1D stiffness along the joint axis,
         * default: 0
         */
        Joint(const std::string& name, const Vector& _origin, const Vector& _axis, const JointType& type, const double& _scale=1, const double& _offset=0,
	      const double& _inertia=0, const double& _damping=0, const double& _stiffness=0);

在Python中建立关节也是相同,可以输入相应的参数,但是有更简单的方法,直接用调用一些建好的关节来建立,如下所示

#关节
joint1 = PyKDL.Joint(PyKDL.Joint.RotZ)
print "joint:", joint1
---输出结果---
joint: NoName:[RotZ, axis: [0,0,1], origin[0,0,0]]

连杆动力学参数:RigidBodyInertia

连杆的动力学参数包括了三个量:

  • 1 质量:m
  • 2 质心:oc
  • 3 惯性张量矩阵:Ic
RotationalInertia(double Ixx=0,double Iyy=0,double Izz=0,double Ixy=0,double Ixz=0,double Iyz=0) 

Python中输入对应参数,建立如下

#惯性张量
m = 0.5
oc = PyKDL.Vector(1, 0, 1)
RBI = PyKDL.RotationalInertia(1.0, 2.0, 3.0, 4.0, 5.0, 6.0)

I1 = PyKDL.RigidBodyInertia(m, oc, RBI)

串联机器人链:Chain

由基本元素段segment相连,构成了一个串联的链,
在这里插入图片描述
PyKDL建立链的方法如下

#********创建链*******#
#通过复制建立多个segment
links = []
for i in range(6):
    links.append(segment1)

#创建链
chain1 = PyKDL.Chain()
#为链加入segment
for i in range(6):
    chain1.addSegment(links[i])

#获取链的信息
joint_num = chain1.getNrOfJoints()
print "joint_num:", joint_num
Segment_num = chain1.getNrOfSegments()
print "Segment_num:", Segment_num
Segment_6 = chain1.getSegment(5)
print "Segment_6:", Segment_6
---输出结果---
joint_num: 6
Segment_num: 6
Segment_6: NoName:[NoName:[RotZ, axis: [           0,           0,           1], origin[           0,           0,           0]],
 tip: 
[[    0.540302,           0,    0.841471;
            0,           1,           0;
    -0.841471,           0,    0.540302]
[           3,           2,           4]]]

建立树:tree

一般,树不会直接代码建立,而是采用更简单的方法,通过URDF文件获取,获取方法如下所示。

from urdf_parser_py.urdf import URDF
from pykdl_utils.kdl_kinematics import KDLKinematics
from pykdl_utils.kdl_parser import kdl_tree_from_urdf_model

#读取URDF文件
robot = URDF.from_xml_file("/home/d/catkin_ws/src/robot_description/armc_description/urdf/armc_description.urdf")

#将URDF转换为树
tree = kdl_tree_from_urdf_model(robot)

#截取需要的部分构成链
chain = tree.getChain("base_link", "sensor_link")
版权声明:本文为weixin_43956732原创文章,遵循 CC 4.0 BY-SA 版权协议,转载请附上原文出处链接和本声明。
本文链接:https://blog.csdn.net/weixin_43956732/article/details/106908452

智能推荐

ActiveMQ学习4-ActiveMQ的安全机制和集群模式

ActiveMQ的安全机制和集群模式 20 ActiveMQ安全机制 20.1 Web 控制台安全 20.2 消息服务器Broker安全 21 ActiveMQ主从集群 21.1 使用集群的重要性 20.2 主从集群的方式 20.2.1 shared filesystem Master-Slave方式主从集群 20.2.2 shared database Master-Slave方式主从集群 20...

说说 Python Django 应用的基础目录结构

通过以下 django-admin 指令创建应用之后,就会生成应用的基础目录结构。 比如,我们建立了一个叫 ‘first’ 的应用,它的目录结构是这样的: 目录或文件 说明 最外层的 first/ 这是新应用的根目录,所有与该应用相关的内容都放在这里。 manage.py 用于管理 Django 项目的命令行工具。 里面一层的 first/ 目录 是一个...

Springboot整合rabbitMQ

依赖: 配置文件application.yml RabbitConfig 消息生产者RabbitProducer 消息消费者RabbitCustomer 通过Controller进行调用 启动项目后调用接口: 结果:...

Thread.join()方法的使用

如果一个线程A执行了thread.join()语句,代表当前线程A等待thread线程终止后才从thread.join()方法返回 并且这个方法具有超时特性,可以添加参数设置 输出结果: jdk中Thread.join()方法的源码(进行了部门调整)   每个线程终止的条件是前驱线程的终止,每个线程等待前驱线程终止后,才从join()方法返回,  当线程终止时,会调用自身的no...

linux服务器部署jenkins笔记

安装jenkins参考文档:https://blog.csdn.net/tomatocc/article/details/83930714 1. 打开jenkins官网:https://jenkins.io/download/ 将war包下载到本地 **ps:**这里要注意的是要下载左边下方的war包,不要下载右边下面的war包。左边是稳定版本,右边是最新版本,建议大家使用稳定版本(我刚开始下载的...

猜你喜欢

k8s部署elasticsearch集群

百度营销大学     环境准备 我们使用的k8s和ceph环境见: https://blog.51cto.com/leejia/2495558 https://blog.51cto.com/leejia/2499684 ECK简介 Elastic Cloud on Kubernetes,这是一款基于 Kubernetes Operator 模式的新型编排产品,用户可使用该产品在...

saas-export项目-AdminLTE介绍与入门

AdminLTE介绍 (1)AdminLTE是什么? AdminLTE是一款建立在bootstrap和jquery之上的开源的模板主题工具 (2)AdminLTE有什么特点? 提供一系列响应的、可重复使用的组件, 并内置了多个模板页面 自适应多种屏幕分辨率,兼容PC和移动端 快速的创建一个响应式的Html5网站 AdminLTE 不但美观, 而且可以免去写很大CSS与JS的工作量 AdminLTE...

MyBatis中ResultMap结果集映射

用于解决属性名和字段名不一致的情况: resultMap 元素是 MyBatis 中最重要最强大的元素。...

编写一个shell

编写shell的过程: 1.从标准输入中读入一个字符串。 2.解析字符串 3.创建一个子进程的执行程序。 4.子进程程序替换。 5.父进程等待子进程退出。...

WEB自动化测试中Xpath定位方法

前言: Xpath是在XML文档中查找信息的一种语言,使用路径表达式来选取XML文档中的节点或节点集,由于XML与HTML结构类似(前者用于传输数据,后者用于显示数据),所以Xpath也常用于查找HTML文档中的节点或节点集。 一  路径表达式: 路径以“/”开始     表示找到满足该绝对路径的元素; 路径以//”开始  ...