经过一周的研究,对六自由度机械臂运动进行了研究,利用高中几何知识进行了运动控制策略的设计,无偿贡献出源码,可以为入门的小伙伴提供一定的借鉴。
1、机械臂物理参数的介绍
买了一个六轴机械臂,作为研究对象,如果是其它机械臂,可以根据机械臂参数对代码进行修改。机械臂参数如下图所示:
1.1 部件与尺寸
机械臂如下部件组成,描述如下表:
序号 |
名称 |
描述 |
在python中的定义 |
1 |
骨长1 |
机械臂原点至第1弯头中心,距离170.48mm |
类名:Mini_Arm,属性名:骨长1 |
2 |
骨长2 |
第1弯头至第4弯头中心,距离138.35mm |
类名:Mini_Arm,属性名:骨长2 |
3 |
骨长3 |
第4弯头至第5弯头中心,距离100mm |
类名:Mini_Arm,属性名:骨长3 |
4 |
骨长4 |