本文档介绍了如何修改Marlin固件以支持Dobot机型的正反解转换，涉及到从关节角度到空间位置的计算，并强调了前臂转动角度相对于Z轴的特殊性，对运动控制具有重要意义。
1.
/******************************************/
/* dobot正解，由关节角度到空间位置
/******************************************/
void calculate_DOBOT_forward_Transform(float f_dobot[3]) {
float l1_sin, l1_cos, l2_sin, l2_cos, Vxy, Vz;
l1_sin = sin(f_dobot[THETA_2] / DOBOT_RAD2DEG) * Linkage_1;l1_cos = cos(f_dobot[THETA_2] / DOBOT_RAD2DEG) * Linkage_1;
l2_sin = sin(f_dobot[THETA_3] / DOBOT_RAD2DEG) * Linkage_2;
l2_cos = cos(f_dobot[THETA_3] / DOBOT_RAD2DEG) * Linkage_2;
Vxy = l1_sin + l2_sin;
Vz= l1_cos + l2_cos;
delta[X_AXIS] = Vxy * cos(f_dobot(THETA_1) / DOBOT_RAD2DEG);
delta[Y_AXIS] = Vxy * sin(f_dobot(THETA_1) / D
最低0.47元/天 解锁文章
3503
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
