5R串联机器人运动学分析及其控制系统研究

Research on kinematics analysis and control system of 5R series robot

针对国内工业机器人市场基本为进口产品垄断以及高校对于工业机器人教育仍采用传统实物加示教演示等状况,该文设计开发一款基于STM32F407的经济型5R抓取机器人系统并将其运用于教学演示和简单操作应用。首先,根据DH法对该5R机器人运动学模型进行构建,并推算出其正逆运动学公式。运用Matlab软件中的Robotics Toolbox工具包进行运动学仿真,采用Monte Carlo法和jtraj函数对机器人工作空间及轨迹规划进行求解,最后通过实物平台进行相关验证。实验表明,该系统运行稳定、响应速度快、符合仿真结果,从而说明机器人控制系统设计的合理性,为工业机器人教育提供一种新的思路。

In view of the situation that the domestic industrial robot market is basically monopolized by imported products and the industrial robot education still uses the traditional physical object to teach and demonstrate to students in universities,this paper designs and develops an economical 5R gripper robot system based on STM32F407 and applies it to teaching demonstrations and simple operations.Firstly,the kinematics model of the 5R robot was constructed according to the DH method,and forward&inverse kinematics formulas were deduced.The Robotics Toolbox in Matlab software was used for kinematics simulation.Monte Carlo method and jtraj function were used to solve the workspace and trajectory planning of the robot.Finally,the relevant verification was carried out through the physical platform.The experiments show that the system runs stably,responds quickly and matches the simulation results,which explains the rationality of the design of the robot control system,it provides a new idea for industrial robot education.