English

中国农机化学报

中国农机化学报 ›› 2024, Vol. 45 ›› Issue (11): 88-94.DOI: 10.13733/j.jcam.issn.2095‑5553.2024.11.014

• 农产品加工工程 • 上一篇    下一篇

平粮机械臂设计及运动学分析

杨东1,2,3,杨诚诚2,董娜娜2,宋凯2,石天玉1,3   

  1. 1. 国家粮食和物资储备局科学研究院,北京市,100037; 2. 沈阳理工大学信息科学与工程学院,
    沈阳市,110168; 3. 粮食储运国家工程研究中心,北京市,100037
  • 出版日期:2024-11-15 发布日期:2024-10-31
  • 基金资助:
    “科技助力经济2020”重点专项(SQ2020YFF0426299)

 Design and kinematics analysis of grain leveling manipulator

Yang Dong1, 2, 3, Yang Chengcheng2, Dong Nana2, Song Kai2, Shi Tianyu1, 3   

  1. 1. Academy of National Food and Strategic Reserves Administration, Beijing, 100037, China; 
    2. School of Information Science and Engineering, Shenyang Ligong University, Shenyang, 110168, China; 
    3. National Engineering Research Center of Grain Storage and Logistics, Beijing, 100037, China
  • Online:2024-11-15 Published:2024-10-31

摘要: 针对传统人工平粮作业方式费时费力、存在安全隐患等问题,面向现有履带式、桁架式平粮装备及方法作业空间大、效率低、能耗高等缺点,设计一款七自由度的机械臂以实现高大平房仓内粮面的自动平整。机械臂各个关节主要由数字液压缸驱动,选择MCU对各个关节数字液压缸进行控制,同时建立该机械臂的标准D-H参数表,通过MATLAB Robotics Toolbox建立机械臂三维仿真模型,采用几何法和基于物体雅可比的Newton-Raphson算法对其机械臂进行逆运动学求解,并通过蒙特卡洛法对工作空间进行仿真分析,利用五次多项式插值和T型插值对其运动轨迹进行仿真,利用RRT*算法进行避障路径规划。结果表明:该机械臂工作空间可覆盖平房仓内待平粮位置,运动轨迹平稳可靠,满足所需工作要求,T型插值法可以使机械臂运动轨迹在4~6 s之间,关节加速度降低至0 rad/s,RRT*算法可使机械臂精确避开高度在4~8 m范围内无需作业的粮堆。可为高大平房仓伸入式平粮装备研制和智能控制平台搭建提供基础支撑。

关键词: 平粮机械臂, 七自由度, 运动学分析, 平粮方法, 路径规划

Abstract: In response to the problems of traditional manual grain leveling operations that are time‑consuming, labor‑intensive, and pose safety hazards, and in response to the shortcomings of existing tracked and truss grain leveling equipment and methods such as large operating space, low efficiency, and high energy consumption, a seven degree of freedom robotic arm has been designed to achieve automatic leveling of the grain surface in tall bungalows. Each joint of the manipulator is mainly driven by a digital hydraulic cylinder. MCU is selected to control the digital hydraulic cylinder of each joint. At the same time, the standard D-H parameter table of the manipulator is established, and the three‑dimensional simulation model is established through MATLAB Robotics Toolbox. Geometric method and Newton Raphson algorithm based on object Jacobi are used to solve the Inverse kinematics of the manipulator, and Monte Carlo method is used to simulate and analyze the workspace. The fifth order Polynomial interpolation and T-type interpolation are used to simulate its motion trajectory, and the RRT* algorithm is used to plan the obstacle avoidance path. The results show that the working space of the robotic arm can cover the positions of grain to be leveled in the bungalow warehouse, and the motion trajectory is stable and reliable, meeting the required work requirements. At the same time, the T-shaped interpolation method can reduce the joint acceleration of the robotic arm to 0 rad/s when its motion trajectory is between 4 and 6 seconds. The RRT* algorithm enables the robotic arm to accurately avoid grain piles that do not require operation within a height range of 4-8 meters. The analysis results can provide basic support for the development of high‑altitude grain leveling equipment and the construction of intelligent control platforms in the future.

Key words:  grain leveling manipulator, seven degrees of freedom, kinematics analysis, grain leveling method, path planning

中图分类号: