六自由度机械臂拾取路径规划  

Pick-up Path Planning for 6-DOF Manipulator

作　　者：胡梦桃 尚高伟 张小青[1] 王长超 陈凯元 徐胜清 HU Mengtao;SHANG Gaowei;ZHANG Xiaoqing;WANG Changchao;CHEN Kaiyuan;XU Shengqing(School of Physics and Electronic Engineering,Xianyang Normal University,Xianyang 712000,China)

机构地区：[1]咸阳师范学院物理与电子工程学院,陕西咸阳712000

出　　处：《电工技术》2022年第12期1-3,共3页Electric Engineering

基　　金：咸阳师范学院省级大学生创新创业训练计划资助项目(编号S202110722035);陕西省教育厅科研专项(编号20JK0972)。

摘　　要：针对六自由度机械臂,利用几何法建立其运动学模型,推导出各关节的驱动电机角度的逆解公式;然后在笛卡尔空间设计门字形拾取轨迹并进行规划。将空间轨迹先分解到各个坐标,得到空间各分坐标规划值,接着利用机械臂各驱动电机角度的逆解公式得到各电机的角度规划值,最后根据舵机控制原理得到各关节对应驱动舵机的脉冲规划值,并进行了相关试验。从试验结果来看,所做规划是有效的。For the 6-DOF manipulator,the kinematics model is established by using the geometric method,and the inverse solution formula of the driving motor angle of each joint is deduced.Then the gate shape pick-up trajectory is designed and planned in Cartesian space.Firstly,the spatial trajectory is decomposed to each coordinate to obtain the planning value of each coordinate.Then,the angle planning value of each motor is obtained by using the inverse solution formula of the angle of each driving motor of the manipulator.Finally,according to the steering gear control principle,the pulse planning value of each joint corresponding to the driving steering gear is obtained,and the relevant experiments are carried out.From the test results,the planning is verified.

关 键 词：六自由度机械臂 运动学 几何法 路径规划 

分 类 号：TP24[自动化与计算机技术—检测技术与自动化装置]