二连杆正/逆运动建模

[仿真环境]
matlab
在这里插入图片描述
如图:二连杆由杆AB和杆BC组成,e,f为杆的重心位置,其中杆AB的长度为l2,杆BC的长度为l2。如图建立坐标系,坐标系y1oz1与杆AB固连,坐标系y2oz2与杆BC固连,即坐标系将跟着坐标系一起运动。将杆各自旋转一定角度,q1为杆AB的旋转角度,q2为杆BC旋转的角度,如图所示。将各点的位置以向量的形式表述。
首先定义基坐标系的轴向量为相互正交的单位向量:
在这里插入图片描述
将旋转后的坐标系用基坐标系表达:(逆时针为正,顺时针为负)
坐标系x1y1z1
在这里插入图片描述
坐标系x2y2z1(相对于x1y1z1坐标系):
在这里插入图片描述
由上可得旋转矩阵:
在这里插入图片描述
根据链式法则可得:
在这里插入图片描述
因此可以得到各点的位置向量相

评论 1
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
红包 添加红包
表情包 插入表情
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值