Modern robotics mechanics planning and control(book) Rigid-Body Motion Example(book)

博客展示了一段MATLAB代码,包含清除命令窗口、工作区和关闭图形窗口操作。定义了旋转缩放平移矩阵Tsb和Tsc,进行矩阵乘法、求逆等运算,计算了旋转矩阵R的迹,还计算了反对称矩阵w、逆矩阵invG以及向量v。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

clc;clear;close;

rsc=pi/180;

Tsb=[cos(30*rsc) -sin(30*rsc) 0 1;sin(30*rsc) cos(30*rsc) 0 2;0 0 1 0;0 0 0 1];
Tsc=[cos(60*rsc) -sin(60*rsc) 0 2;sin(60*rsc) cos(60*rsc) 0 1;0 0 1 0;0 0 0 1];

q=pi/6;

T=Tsc*inv(Tsb);

R=T(1:3,1:3);
trace(R)

w=1/(2*sin(q))*(R-R');
invG=(1/q)*eye(3)-(1/2)*w+(1/q-(1/2)*cot(q/2))*w*w;
v=invG*T(1:3,4);

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值