function T=zhengjie_for_T(Q)
%T为4*4矩阵,Q为1*6向量
RX=[1 0 0;0 cos(Q(4)) -sin(Q(4));0 sin(Q(4)) cos(Q(4))];
RY=[cos(Q(5)) 0 sin(Q(5));0 1 0;-sin(Q(5)) 0 cos(Q(5))];
RZ=[cos(Q(6)) -sin(Q(6)) 0;sin(Q(6)) cos(Q(6)) 0; 0 0 1];
R=RZ*RY*RX;
T=[R Q(1:3)';
0 0 0 1];
已知RPY角位姿表达式,求齐次座标变换矩阵位姿表达式,也称RPY角正解
發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章
321型正交位移测量系统,已知某座标系位姿及六根直线表达式,求直线与座标系平面的交点
weixin_41639107
2020-07-06 17:16:15
321型正交位移测量系统的正解(已知位姿求位移传感器位移)
weixin_41639107
2020-07-06 17:16:15
321型正交位移测量系统,已知新旧交点座标,求位移传感器的位移
weixin_41639107
2020-07-06 17:16:15
利用solve函数求解直线上到某点的距离为L的点的座标
weixin_41639107
2020-07-02 23:39:27
已知直线上不同的动点到直线上固定点的距离,求动点的座标
weixin_41639107
2020-07-02 23:39:27
已知矩形的宽和高以及与x轴夹角,求对边的两条边的中心座标
Somnus陳
2020-07-06 19:38:35
几何原本-五条公设
TianLiaoFeiJue
2020-07-05 19:00:17
欧几里得空间与线性空间区别和联系
參考;https://www.zhihu.com/question/38757535/answer/245814373
TianLiaoFeiJue
2020-07-05 19:00:17
蓝桥杯:分巧克力(C++)
我要喝阔楽
2020-07-04 13:25:13
旋转矩阵和四元数之间互相转换代码
qq_36265860
2020-07-04 12:07:34
De Boor递推算法
捂眼看世界
2020-07-04 04:22:07