笛卡尔轨迹规划和关节轨迹规划实例

是 否 +2 论坛币

k人 参与回答

经管之家送您一份

应届毕业生专属福利!

求职就业群

赵安豆老师微信：zhaoandou666

经管之家联合CDA

送您一个全额奖学金名额~ !

立即领取

感谢您参与论坛问题回答

经管之家送您两个论坛币！

+2 论坛币

【核心代码】static void zyz2rot(PosClass startPos, double* mStartMatrixData)
{
double startAngle[3];
startAngle[0] = startPos.yaw * PI / 180;
startAngle[1] = startPos.pitch * PI / 180;
startAngle[2] = startPos.roll * PI / 180;

mStartMatrixData[0] = cos(startAngle[0]) * cos(startAngle[1]) * cos(startAngle[2]) - sin(startAngle[0]) * sin(startAngle[2]);
mStartMatrixData[1] = -cos(startAngle[0]) * cos(startAngle[1]) * sin(startAngle[2]) - sin(startAngle[0]) * cos(startAngle[2]);
mStartMatrixData[2] = cos(startAngle[0]) * sin(startAngle[1]);
mStartMatrixData[3] = startPos.x / 1000;

mStartMatrixData[4] = sin(startAngle[0]) * cos(startAngle[1]) * cos(startAngle[2]) cos(startAngle[0]) * sin(startAngle[2]);   under.log www.izswenda.com div.cc information
mStartMatrixData[5] = -sin(startAngle[0]) * cos(startAngle[1]) * sin(startAngle[2]) cos(startAngle[0]) * cos(startAngle[2]);    under.log div.cc information
mStartMatrixData[6] = sin(startAngle[0]) * sin(startAngle[1]);
mStartMatrixData[7] = startPos.y / 1000;

mStartMatrixData[8] = -sin(startAngle[1]) * cos(startAngle[2]);
mStartMatrixData[9] = sin(startAngle[1]) * sin(startAngle[2]);
mStartMatrixData[10] = cos(startAngle[1]);
mStartMatrixData[11] = startPos.z / 1000;

mStartMatrixData[12] = 0;
mStartMatrixData[13] = 0;
mStartMatrixData[14] = 0;
mStartMatrixData[15] = 1;
}

扫码加我 拉你入群

请注明：姓名-公司-职位

以便审核进群资格，未注明则拒绝

分享0 收藏0 回帖

关键词：笛卡尔 information Informatio formation informat