距机器人正解逆解的3篇文章已经有一年多时间 不知不觉浏览已有一万
在评论里看到一些问题 在此尝试解答
建议还是先看看相关的书中的计算方法 不知道计算方法而通过程序去理解如何计算 是比较难的
代码里面的注释很少 唉 好吧 本人代码品格较差 (其实是忘了)
机器人的正解根据各关节角度计算位置 其实就是坐标变换
从一个坐标系变换到另一个坐标系 得到最终的位置坐标
这个用三角函数也可以计算 可以不用矩阵 程序不是非常复杂
但是有些角度的计算需要特别处理
选择的坐标系直接影响所计算的位置
坐标系各坐标轴的方向会影响到角度的+/- 和坐标值的+/-
这些都体现在参数表中
参数表的结构就是param_t结构体的后3项
参数表文件的内容只是多了最后一行
参数表文件中的最后一行 是在Z方向上的整体偏移值
关节角度
以上数据我是随便举例子的 有可能不符合要求
逆解所用的文件 格式是一样的
逆解读入的6个值 X, Y, Z, Y, P, R