平面3连杆机器人正逆解

最新推荐文章于 2024-09-16 18:23:49 发布

平头哥Plus

最新推荐文章于 2024-09-16 18:23:49 发布

阅读量1.1w

点赞数 8

文章标签：平面3连杆逆解机器人

本文链接：https://blog.csdn.net/wisewise_yh/article/details/86041609

版权

本文探讨了平面3连杆机器人的正逆解问题。通过介绍结构与DH表，阐述了如何建立机器人坐标系，并求解正解。在运动学逆解部分，针对冗余结构导致的非唯一解，提出了利用末端工具坐标系姿态来限定解的方法，通过求解一系列几何关系，最终确定关节转角。这种方法适用于连杆长度相近的情况，具有唯一解且计算效率高。

摘要由CSDN通过智能技术生成

对于平面连杆类机器人，课本、论文以及实际使用的机器人(SCARA机器人就是平面连杆机器人的变种)，基本上都是平面2连杆。即，给定平面坐标(x,y)，对应两组（theta1，theta2），通过选接就可以确定唯一解。实际上，由于作业空间等的需求，有时需要平面3连杆机器人来完成平面的定位，即给定平面坐标（x,y），需要求出唯一对应的(theta1、theta2、theta3)，对于这种系统，显然有无穷解。为了在只给定（x,y）的情况下，获取唯一对应的(theta1、theta2、theta3)，我们需要额外计算出一组条件，我采用的方法是：根据（x,y）计算并指定末端连杆的姿态。

结构与DH表

平面3连杆机器人的结构和各坐标系定义如下（右手坐标系、右手旋转）：

其中x0-y0叫做“基坐标系(robot frame)”，该坐标系作为参考坐标系，固定不动；x1-y1固连在第一关节，相对与x0-y0仅有转交角theta1；x2-y2固连在第二关节，相对与x1-y1有转交角theta2和连杆长度L1；x3-y3固连在第三关节，相对与x2-y2有转交角theta3和连杆长度L2；xtool-ytool为固连在第三连杆末端的工具坐标系，相对与x3-y3仅有连杆长度L3。

根据上图，得到标准DH表如下：