机器人运动学与动力学入门(一)自由度与连杆机构

机器人运动学与动力学入门(一)自由度与连杆机构

在讨论机器人运动之前,先复习一些基本概念(啰里吧嗦环节)。已经了解的童鞋可以自行跳过该节。

1.自由度(degree of freedom)
自由度描述一个物体可以自由运动的独立程度(废话)
比如:

  • 一个只有一根坐标轴的系统上的点只可以左右运动,只能用一个值x来唯一描述,所以只有一个自由度。
  • 一个平面上的一个点可以用(x,y)唯一表征它的位置,因此有两个自由度。
  • 一个三维坐标系上的一个点需要用(x,y,z)来唯一表征它的位置,因此有三个自由度。
    那么,什么是机器人的自由度?
    在回答这个问题之前,需要了解一下什么是刚体,什么是机器人。

2.机器人定义
我们这里研究的机器人具体代指一类由连杆(link)+ 关节(joint)组成的连杆机构(linkage),强调一下连杆和关节,因为以后我们会经常跟这两个词打交道,这些连杆都是刚体(rigid body)。

刚体(百度百科:刚体是指在运动中和受力作用后,形状和大小不变,而且内部各点的相对位置不变的物体)

有两种类型的的连杆机构:级联链(serial chains)和平行链(parallel chains)
也叫开链和闭合链。

级联链结构机器人
在这里插入图片描述
优点:相对于平行链机器人,工作范围更广
缺点:因为误差一级级积累,因此相对于平行链机器人,精度要低一些。也因为每一级关节单独受力,所以载重也相对低。

平行链结构机器人
在这里插入图片描述
优点:相对于级联链机器人,精度高,载重大
缺点:相对于级联链结构机器人,工作范围小

3.运动
运动(motion)包括两种:平移(translation)和旋转(rotation),因此:

  • 在二维平面里,一个刚体有三个自由度:两个平移的自由度(x,y),一个旋转的自由度。
  • 在三维坐标系中,一个刚体则有六个自由度: 三个平移自由度(x,y,z),三个旋转自由度(roll,pitch,yaw)(这三个旋转自由度符合右手旋转定则,见下图)
    在这里插入图片描述

4.关节与连杆的符号表达
可以使用以下表达方式来给我们要研究的机器人结构建模
连杆:
通常用一根线段表示连杆
在这里插入图片描述

关节:

  • 旋转关节一
    在这里插入图片描述
    这是一个z轴指向外面,逆时针为正的旋转关节

  • 旋转关节二
    在这里插入图片描述
    这是一个z轴沿着连杆指向左或者右,绕着z轴旋转的旋转关节

  • 平移关节
    在这里插入图片描述
    这是一个沿着连杆伸长缩短的平移关节

  • 末端执行器
    在这里插入图片描述

一个连杆机构机器人模型
在这里插入图片描述
至此我们就可以用这些符号表达轻松地给我们要研究的机器人建模了。

到这里我们再看一开始的问题:什么是机器人的自由度?
可以发现,一个关节就代表了一个自由度。因此,想要知道一个机器人有多少自由度,只要数出有多少个关节就可以了。

  • 9
    点赞
  • 28
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
### 回答1: 示例代码如下: syms q1 q2 q3 % 定义机器人的角度变量 syms l1 l2 % 定义机器人的平面关节间距 syms m1 m2 % 定义机器人的模块质量 syms g % 定义重力加速度% 定义机器人的坐标系 x1= l1*cos(q1); y1= l1*sin(q1); x2= x1+l2*cos(q1+q2); y2= y1+l2*sin(q1+q2);% 计算机器人动力学方程 KE= 1/2*m1*(diff(x1,q1)^2+diff(y1,q1)^2)... +1/2*m2*(diff(x2,q1)^2+diff(y2,q1)^2+diff(x2,q2)^2+diff(y2,q2)^2); PE= m1*g*y1+m2*g*y2; Lag= KE-PE; M= [diff(Lag,diff(q1,t)) diff(Lag,diff(q2,t))]; F= -[diff(Lag,q1) diff(Lag,q2)];M21= subs(M,{q1,q2},{0,0}); F21= subs(F,{q1,q2},{0,0});M22= double(M21) F22= double(F21)[M23,F23]= equationsToMatrix(M,F) ### 回答2: 以下是一个使用MATLAB进行三自由度机器人动力学建模的示例代码: ```matlab % 机器人的DH参数 L1 = 1; % 轴1长度 L2 = 1; % 轴2长度 L3 = 1; % 轴3长度 % 定义机器人的DH参数矩阵 DH = [0, 0, L1, 0; 0, 0, L2, 0; 0, 0, L3, 0]; % 创建机器人模型 robot = robotics.RigidBodyTree; % 添加关节和连接 body1 = robotics.RigidBody('link1'); joint1 = robotics.Joint('joint1', 'revolute'); setFixedTransform(joint1, DH(1, :), 'dh'); body1.Joint = joint1; body2 = robotics.RigidBody('link2'); joint2 = robotics.Joint('joint2', 'revolute'); setFixedTransform(joint2, DH(2, :), 'dh'); body2.Joint = joint2; body3 = robotics.RigidBody('link3'); joint3 = robotics.Joint('joint3', 'revolute'); setFixedTransform(joint3, DH(3, :), 'dh'); body3.Joint = joint3; % 将关节和连接添加到机器人模型中 addBody(robot, body1, 'base'); addBody(robot, body2, 'link1'); addBody(robot, body3, 'link2'); % 指定关节的初始角度 jointAngles = [0, 0, 0]; % 运动学求解并绘制机器人 figure; show(robot, jointAngles); % 计算机器人动力学 % 运动学转换 T = robot.fkine(jointAngles); % 计算末端速度 J = robot.jacob0(jointAngles); endeffectorVelocity = J * jointVelocities'; % 计算末端力矩 endeffectorForces = robot.gravload(jointAngles); % 输出动力学计算结果 disp('末端速度:'); disp(endeffectorVelocity); disp('末端力矩:'); disp(endeffectorForces); ``` 以上代码演示了如何使用MATLAB的机器人工具箱来进行三自由度机器人动力学建模。其中,DH参数用于描述机器人的连杆长度和关节类型,通过创建机器人模型并添加关节和连接进行动力学求解,并计算机器人的末端速度和力矩。最后,绘制机器人的3D模型并输出计算结果。 ### 回答3: 以下是一个简单的三自由度机器人动力学建模的示例代码: ```matlab % 机器人参数设置 L1 = 1; % 第一段连杆长度 L2 = 0.8; % 第二段连杆长度 L3 = 0.6; % 第三段连杆长度 % 符号变量声明 syms q1 q2 q3 dq1 dq2 dq3 ddq1 ddq2 ddq3 m1 m2 m3 g syms c1 s1 c2 s2 c3 s3 % 关节角度 q = [q1; q2; q3]; % 运动学正向解 A1 = [c1 -s1 0; s1 c1 0; 0 0 1]; A2 = [c2 -s2 0; s2 c2 0; 0 0 1]; A3 = [c3 -s3 0; s3 c3 0; 0 0 1]; T01 = [A1 [L1; 0; 0]; 0 0 0 1]; T12 = [A2 [L2; 0; 0]; 0 0 0 1]; T23 = [A3 [L3; 0; 0]; 0 0 0 1]; T03 = T01 * T12 * T23; % 链接质心位置 P1 = T01(1:3, 4); P2 = T03(1:3, 4) - T01(1:3, 4); P3 = T03(1:3, 4); % 链接质量 M1 = m1 * eye(3); M2 = m2 * eye(3); M3 = m3 * eye(3); % 运动学求导 Jv1 = simplify(jacobian(P1, q)); Jv2 = simplify(jacobian(P2, q)); Jv3 = simplify(jacobian(P3, q)); % 动力学建模 G = [0; 0; -g]; % 重力向量 T01_3 = simplify(T01(1:3, 1:3)); T12_3 = simplify(T12(1:3, 1:3)); T23_3 = simplify(T23(1:3, 1:3)); I1 = m1 * diag([1/12*L1^2, 1/12*L1^2, 0]); I2 = m2 * diag([1/12*L2^2, 1/12*L2^2, 0]); I3 = m3 * diag([1/12*L3^2, 1/12*L3^2, 0]); % Coriolis 矩阵 sym tmp_C tmp_Cij C tmp_C = sym(zeros(3)); for i = 1:3 for j = 1:3 C_ij = 0; for k = 1:3 C_ij = C_ij + diff(T01_3(i, j), q(k)) * dq(k); end tmp_Cij(i,j) = C_ij; end end tmp_C = sym(zeros(3)); for i = 1:3 for j = 1:3 for k = i+1:3 tmp_C(i,j) = tmp_C(i,j) + 0.5 * (tmp_Cij(k,j) + tmp_Cij(k,i) - tmp_Cij(i,j)); end for k = 1:i-1 tmp_C(i,j) = tmp_C(i,j) - 0.5 * tmp_Cij(i,k); end end end C = simplify(tmp_C); % 轨迹规划 t = linspace(0, 10, 100); % 时间范围 q1_t = sin(t); q2_t = cos(t); q3_t = sin(2*t); dq1_t = diff(q1_t, t); dq2_t = diff(q2_t, t); dq3_t = diff(q3_t, t); ddq1_t = diff(dq1_t, t); ddq2_t = diff(dq2_t, t); ddq3_t = diff(dq3_t, t); % 求解动力学方程 Tau = sym(zeros(3, 1)); for i = 1:length(t) dq = [dq1_t(i); dq2_t(i); dq3_t(i)]; ddq = [ddq1_t(i); ddq2_t(i); ddq3_t(i)]; M = Jv1' * M1 * Jv1 + Jv2' * M2 * Jv2 + Jv3' * M3 * Jv3; Cq = C * dq; Gq = Jv1' * M1 * G + Jv2' * M2 * G + Jv3' * M3 * G; Tau(:, i) = M * ddq + Cq + Gq; end ``` 这段代码使用了符号计算和矩阵运算的功能来实现机器人动力学建模。其中,通过运动学正向解求得了各个连杆的位置和姿态;然后利用链式法则求得了各个连杆的雅可比矩阵;接着对动力学建模进行操作,求得了惯性矩阵、科里奥利力矩阵和重力矩阵;最后通过求解动力学方程得到了各个关节所受到的力矩。这段代码中的三自由度机器人模型可以根据具体情况进行参数调整和扩展。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值