机器人动力学建模实例:二连杆机械臂
机器人动力学方程比较复杂,通常每一个参数矩阵都非常庞大,这里介绍几个简单结构的动力学方程,对于一般的控制算法,可以在这几个动力学方程中进行验证。
1、欧拉-拉格朗日动力学方程
(不考虑摩擦和末端受力)可以写成:
用矩阵形式表示为:
其中: cijk=12(∂bij∂qk+∂bik∂qj−∂bjk∂qi)cijk=12(∂bij∂qk+∂bik∂qj−∂bjk∂qi)
2、两连杆笛卡尔臂动力学方程
注:分别计算连杆和电机转子的质量、转动惯量。
D=[ml1+mm2+Im1+Il200ml2+Im2]D=[ml1+mm2+Im1+Il200ml2+Im2]
C=0C=0
G=[(ml1+ml2+mm2)g0]G=[(ml1+ml2+mm2)g0]
完整动力学方程为:
其中,mlimli 表示连杆的质量, mmimmi 表示电机转子的质量, ImiImi 表示电机转子关于其转动轴的转动惯量。gg 表示重力加速度矢量, didi 表示平动关节的关节变量。 τiτi 表示关节所需力矩。
两连杆笛卡尔臂应用实例
直角坐标机器人还广泛运用于教学演示、物料搬运、码垛、机床上下料、点胶、喷涂、检测、3c 装配、包装等领域。
2、两连杆平面臂动力学方程
注:连杆和电机看做整体。
d11=m1l2c1+m2(l21+l2c2+2l1lc2cos(θ2))+I1+I2d11=m1lc12+m2(l12+lc22+2l1lc2cos(θ2))+I1+I2
d12=d21=m2(l2c2+l1lc2cos(θ2))+I2d12=d21=m2(lc22+l1lc2cos(θ2))+I2
d22=m2l2c2+I2d22=m2lc22+I2
C=[hq2˙−hq1˙hq2˙+hq1˙0]C=[hq2˙hq2˙+hq1˙−hq1˙0]
其中, h=−m2l1lc2sin(q2)h=−m2l1lc2sin(q2)
g1=(m1lc1+m2l1)gcos(q1)+m2lc2gcos(q1+q2))g1=(m1lc1+m2l1)gcos(q1)+m2lc2gcos(q1+q2))
g2=m2lc2gcos(q1+q2)g2=m2lc2gcos(q1+q2)
完整动力学方程为:
其中,mimi 表示连杆的质量, lili 表示连杆的长度, lcilci 表示连杆质心的长度, IiIi 表示连杆关于其转动轴的转动惯量。gg 表示重力加速度矢量, qiqi 表示连杆的转动角度(转动关节的关节变量)。
两连杆机械臂是最简单的多连杆转动关节串联机器人,大量的控制算法研究和验证都是在两连杆机械臂上完成的。只要赋予其参数值,就可以完成控制算法的研究中模型的建模。
一组可行的赋值方案是:
g=9.81g=9.81
l1=l2=1l1=l2=1
lc1=lc2=0.5lc1=lc2=0.5
m1=m2=50m1=m2=50
I1=I2=10I1=I2=10
3、带远程驱动的两连杆平面臂动力学方程
注:连杆和电机看做整体。
D(p)=[m1l2c1+m2l2c2+I1m2l1lc2cos(p2−p1)m2l1lc2cos(p2−p1)m2l2c2+I2]D(p)=[m1lc12+m2lc22+I1m2l1lc2cos(p2−p1)m2l1lc2cos(p2−p1)m2lc22+I2]
C=[m2l1lc2sin(p2−p1)q˙20amp;0−m2l1lc2sin(p2−p1)q˙1]C=[m2l1lc2sin(p2−p1)q˙2amp;00−m2l1lc2sin(p2−p1)q˙1]
G=[(m1lc1+m2l1)gcos(p1)m2lc2cos(p2)]G=[(m1lc1+m2l1)gcos(p1)m2lc2cos(p2)]
完整动力学方程为:
其中,mimi 表示连杆的质量, lili 表示连杆的长度, lcilci 表示连杆质心的长度, IiIi 表示连杆关于其转动轴的转动惯量。gg 表示重力加速度矢量, pipi 表示连杆的转动角度(转动关节的关节变量)。
可以看到,当第二个连杆电机固定在基座上的时候,第一、二连杆之间的科氏力消失。
因此,具体分析的时候,当驱动该连杆的电机不在该连杆上的时候,要把连杆和电机拆开,分别进行计算。
参考文献
马克 W. 斯庞等著,贾振中译,机器人建模和控制(Robot Modeling and Control),机械工业出版社,2016.07
Bruno Siciliano etc 著,张国良等译,机器人学 建模、规划与控制(Robotics:Modelling,planning and Control),西安交通大学出版社,2015.11
机器人动力学建模实例:二连杆机械臂相关推荐
- 用matlab和RTB做二连杆机械臂动力学建模
文章目录 写在前面 二连杆机械臂 RTB建模 仿真与验证 源代码 写在前面 本文使用的工具为matlab以及Peter Corke的RTB(Robotics Toolbox).基于RTB 10.3.1 ...
- 二关节机械臂matlab控制,二连杆机械臂阻抗控制模拟(一)
在学习机器人动力学相关内容时看到MATLAB论坛上一个有意思的仿真项目Impedance Control for a 2-Link Robot Arm - User-interactive,一个用MA ...
- 二连杆机械臂角度解算
二连杆机械臂角度解算 本文采用极坐标的平移变换公式或者余弦定理的方法在定坐标点的情况下去解算二连杆机械臂两个关节处应该旋转的角度.由于余弦定理更容易理解且极坐标的平移变换公式和余弦定理推导出来的角度解 ...
- 机器人动力学建模实例(二):三连杆机械臂
下图是三连杆机械臂,也就是常说的拟人臂. 采用拉格朗日方法并做适当简化后得到其动力学模型: H(q)q¨+C(q,q˙)q˙+G(q)+F(q˙)+τd=τ H(q) \ddot q + C(q, \ ...
- ADAMS的二连杆机械臂PID控制
这里利用ADAMS 2014,来完成如下方法. 1 二连杆平面臂初始状态呈直线 图1 二连杆平面臂呈直线时三维模型 不计重力,忽略摩擦.在xy平面,连杆1和连杆2长度分别为300mm,100mm,其宽 ...
- matlab adams 机械臂,基于ADAMS与MATLAB/SIMULINK的二杆机械臂动力学仿真与验证
川七 一 , , , 乓 基于 与 的二杆机械臂动力学仿真与验证 贾雪峰' , 宋洪军' , 荣学文 , 李贻斌 山东农业大学机械与电子工程学院 , 山东泰安 , 一 ] 」 山东大学控制科学与工程学 ...
- 2D平面上的二连杆机器臂反向运动模拟(matlab代码示例)
2D平面上的二连杆机器臂反向运动模拟 matlab上先下载 robotics system toolbox工具箱 robot = rigidBodyTree('DataFormat','column' ...
- 【STM32实战】机械臂快递分拣系统(二)——机械臂控制程序(上位机)编写
[STM32实战]机械臂快递分拣系统(二)--机械臂控制程序(上位机)编写 前言 题目分析 蓝牙模块的使用 上位机程序的编写 连接阿里云 测试 前言 近期回校上最后一门课,刚好是做机械臂有关的题目,所 ...
- 运用C#在VS2017的PictureBox控件中绘制简易二自由度机械臂,并且让机械臂实现画直线、圆、人物轮廓及写字的功能。
运用C#在VS2017的PictureBox控件中绘制简易二自由度机械臂,并且让机械臂实现画直线.圆.人物轮廓及写字的功能. 给大家看看效果吧 演示写字视频在下: VID 首先放置了诸多控件 在给控件 ...
最新文章
- 使用JavaMail发送邮件
- 从底部上滑失灵_雷达液位计测量液位失灵的检查处理方法
- 每日一皮:当产品经理试图让程序员冷静下来的时候...
- np.stack()函数详解 ==>堆叠 【类似于torch.stack()】
- 字节约翰斯·霍普金斯上交提出iBOT框架,基于MIM进行自监督训练,在ImageNet-1K上达到86.3%的微调精度!...
- visual studio 2015中的webapi生成helpPage,页面不显示方法说明问题解决
- 如何在Microsoft Word里面插入图片作为背景/封面?
- 点击复制某段文本方法
- Crate安装和配置
- 使用GridView使用类似电影海报宣传页面
- 用python给pdf批量添加水印,并给pdf加密
- vue中同一个依赖引入不同版本
- 哪些网站帮你打开了新世界的大门
- 网站服务器对clu,web服务器解释html-include
- 在线抓娃娃的基本技术架构
- jsp引入外部css或js不生效
- 广东省专精特新中小企业申报在即,请提前准备
- “我,985硕士,进万达月薪8K,我舍友去做互联网产品经理拿13K......”
- 【测评】颇尔冻存袋,长期储存冷冻的脐带血干细胞
- 终于走上了自己应该走的路