已知欧拉角和两点直线距离,算平移矩阵,matlab代码
时间: 2023-05-26 13:03:23 浏览: 142
距离矩阵matlab代码用
欧拉角表示旋转,不包含平移信息,因此只给出根据两点直线距离计算平移矩阵的matlab代码:
假设两点的坐标分别为p1和p2,距离为d,则平移矩阵为:
T = [1 0 0 p2(1)-p1(1);
0 1 0 p2(2)-p1(2);
0 0 1 p2(3)-p1(3);
0 0 0 1];
其中,p1和p2都是长度为3的向量,d是实数距离。
阅读全文