死鸡捡拾机械臂设计及运动学分析

doi:10.13733/j.jcam.issn.2095-5553.2023.01.019

摘要/Abstract

摘要： 根据当前我国死亡肉鸡捡拾劳动强度大，人禽共患病的风险高等问题，设计一款五自由度的机械臂以实现死亡肉鸡的无人化捡拾工作。该机械臂各关节主要由电机驱动，选择单片机对各个关节电机进行控制，绘制其三维模型，同时建立该机械臂的D-H方程，并利用Matlab中的机器人工具箱建立其仿真模型，利用七次多项式插值对其运动轨迹进行仿真，并利用蒙特卡洛法对工作空间进行仿真分析。结果表明：该机械臂的工作空间在水平方向为半径980 mm的圆，可覆盖死鸡捡拾位置，可满足预设工作需求，同时根据仿真轨迹以及各关节速度加速度图可知机械臂各关节运动平稳，为之后控制系统的设计奠定一定基础。

关键词: 五自由度机械臂, 运动学分析, 工作空间分析, 轨迹规划, 死鸡捡拾, 蒙特卡洛法

Abstract: According to the problems of high labor intensity and high risk of humanfowl coinfection in China, a fivedegreeoffreedom manipulator is designed to realize the unmanned picking of dead broilers. Each joint of the manipulator is mainly driven by the motor. The single chip microcomputer is selected to control the motor of each joint, and its threedimensional model is plotted. At the same time, the D-H equation of the manipulator is established, and the simulation model is established by using the robot toolbox in Matlab. The motion trajectory is simulated by using the sevenorder polynomial interpolation, and the Monte Carlo method is used to simulate and analyze the workspace. The results show that the workspace of the manipulator is a circle with a radius of 980 mm in the horizontal direction, which can cover the dead chicken picking position and meet the preset working requirements. At the same time, according to the simulation trajectory and the velocity acceleration diagram of each joint, the motion of the manipulator is stable, which lays a foundation for the design of the control system.

Key words: 5-DOF mechanical arm, kinetic analysis, workspace analysis, trajectory planning, pick up dead chickens, Monte Carlo method

中图分类号:

S237

赵伟, 陈永生, 曹天陛, 张相伦, 吴爱兵, 许斌星. 死鸡捡拾机械臂设计及运动学分析[J]. 中国农机化学报, 2023, 44(1): 131-136.

Zhao Wei, Cheng Yongsheng, Cao Tianbi, Zhang Xianglun, Wu Aibing, Xu Binxing.. Design and kinematics analysis of robotic arm used for picking up dead chickens[J]. Journal of Chinese Agricultural Mechanization, 2023, 44(1): 131-136.

参考文献

［1］　
裴璐. 肉鸡产业国际竞争力评价体系构建及应用［D］. 北京: 中国农业科学院, 2020.

Pei Lu. Evaluation method and its application of international competitiveness of broiler industry ［D］. Beijing: Chinese Academy of Agricultural Sciences, 2020.

［2］　
Zhang H, Wang J, Martin W. Factors affecting households meat purchase and future meat consumption changes in China: A demand system approach ［J］. Journal of Ethnic Foods, 2018, 5(1): 24-32.

［3］　
辛翔飞, 郑麦青, 文杰, 等. 2020年我国肉鸡产业形势分析、未来展望与对策建议［J］. 中国畜牧杂志, 2021, 57(3): 217-222.

［4］　
陈肇铭, 赵君微, 陈达鸿, 等. 饲养模式对肉鸡生长性能和行为、步态评分和羽毛状况的影响［J］. 中国畜牧杂志, 2022, 58(2): 249-253, 272.

［5］　
陈明非, 李巍, 苍真伟, 等. 肉仔鸡高死淘率的原因分析［J］. 中国家禽, 2016, 38(12): 64-65.

［6］　
Dou R, Yu S, Li W, et al. Inverse kinematics for a 7-DOF humanoid robotic arm with joint limit and end pose coupling ［J］. Mechanism and Machine Theory, 2022, 169: 104637.

［7］　
Yu X, Fan Z, Wang X, et al. A labcustomized autonomous humanoid apple harvesting robot ［J］. Computers & Electrical Engineering, 2021, 96: 107459.

［8］　
胡子康, 姜来, 王辉, 等. 基于欠驱动原理死鸡捡拾末端执行器设计与仿真分析［J］. 东北农业大学学报, 2021, 52(6): 78-86.

Hu Zikang, Jiang Lai, Wang Hui, et al. Design and simulation analysis of dead chicken picking endeffector based on under actuated principle ［J］. Journal of Northeast Agricultural University, 2021, 52(6): 78-86.

［9］　
马锐, 胡清华, 龙新良. 一种夹持式笼养蛋鸡死亡个体清除末端执行器［P］. 中国专利: CN201920032884.7, 2019-10-08.

［10］　
阳涵疆, 李立君, 高自成. 基于旋量理论的混联采摘机器人正运动学分析与试验［J］. 农业工程学报, 2016, 32(9): 53-59.

Yang Hanjiang, Li Lijun, Gao Zicheng. Forward kinematics analysis and experiment of hybrid harvesting robot based on screw theory ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2016, 32(9): 53-59.

［11］　
李扬, 程维明, 宫成文, 等. 5-DOF机械臂运动学分析及运动轨迹规划［J］. 中国农机化学报, 2018, 39(9): 16-21.

Li Yang, Cheng Weiming, Gong Chenwen, et al. Kinematics analysis and motion trajectory planning of 5-DOF manipulator ［J］. Journal of Chinese Agricultural Mechanization, 2018, 39(9): 16-21.

［12］　
杨前明, 刘亚琼, 王伟, 等. 基于D-H算法的棉桶更换复合机器人运动学建模与仿真分析［J］. 组合机床与自动化加工技术, 2016(12): 52-55.

Yang Qianming, Liu Yaqiong, Wang Wei, et al. Kinematic modeling and simulation analysis of cotton barrel replacement composite robot based on D-H algorithm ［J］. Modular Machine Tool & Automatic Manufacturing Technique, 2016(12): 52-55.

［13］　
杨达毅. 6R型工业机器人的运动学研究［D］. 长春: 吉林大学, 2005.

Yang Dayi. 6R industry robot kinematics research ［D］. Changchun: Jilin University, 2005.

［14］　
蔡自兴. 机器人学基础［M］. 北京: 机械工业出版社, 2015.

［15］　
何价来, 罗金良, 宦朋松, 等. 基于蒙特卡洛法的七自由度拟人机械臂工作空间分析［J］. 组合机床与自动化加工技术, 2015(3): 48-51.

He Jialai, Luo Jinliang, Huan Pengsong, et al. Workspace analysis of 7-DOF humanoid robotic arm based on Monte Carlo method ［J］. Modular Machine Tool & Automatic Manufacturing Technique, 2015(3): 48-51.

［16］　
李宪华, 孙青, 范凯杰, 等. 双臂6R服务机器人的协作空间分析与仿真［J］. 机械传动, 2018, 42(9): 130-134.

Li Xianhua, Sun Qing, Fan Kaijie, et al. Analysis and simulation of collaborative space of the dual arm 6R service robot ［J］. Journal of Mechanical Transmission, 2018, 42(9): 130-134.

［17］　
齐立哲, 甘中学, 孙云权. 机器人作业工作空间分析与应用［J］. 机械设计, 2021, 38(10): 15-21.

Qi Lizhe, Gan Zhongxue, Sun Yunquan. Analysis and application of the working space for robotic operation ［J］. Journal of Machine Design, 2021, 38(10): 15-21.

［18］　
贾良飞, 马朝锋, 刘凯. 基于蒙特卡罗法的硬岩掘进机辅助清渣装置工作空间分析［J］. 机械传动, 2020, 44(4): 74-79.

Jia Liangfei, Ma Chaofeng, Liu Kai. Workspace analysis of auxiliary slag cleaning device of TBM based on Monte Carlo method ［J］. Journal of Machine Design, 2020, 44(4): 74-79.

［19］　
张昌, 武玉强. 基于P-Rob六自由度机械臂运动学建模与仿真［J］. 包装工程, 2020, 41(11): 166-173.

Zhang Chang, Wu Yuqiang. Kinematics modeling and simulation of six degrees of freedom manipulator based on P-Rob ［J］. Packaging Engineering, 2020, 41(11): 166-173.

[1]	桂林, 古劲, 张宾, 李传军, 陈度, 张亚伟. 一种五自由度修剪机器人结构设计与分析[J]. 中国农机化学报, 2023, 44(3): 191-198.
[2]	杨铭涛;梁喜凤;. 番茄枝叶裁剪机械臂设计与运动学分析[J]. 中国农机化学报, 2021, 42(4): 8-14.
[3]	张红梅, 周正, 吕志军, 王万章, 何豪, 吕严柳, . 油莎豆收获筛分机构运动学分析与试验[J]. 中国农机化学报, 2021, 42(10): 92-99.
[4]	季晓明, 文怀海, 刘艳梨, . 应用于茶叶罐分拣的码垛机器人最优关节空间控制[J]. 中国农机化学报, 2021, 42(10): 173-179.
[5]	赵玲亚;王英健;赵子开;. 圆形水果采摘机械手运动学分析与仿真[J]. 中国农机化学报, 2020, 41(3): 24-29.
[6]	黄传鹏;毛鹏军;李鹏举;耿乾;方骞;张家瑞;. 农用无人机自主飞行技术研究与趋势[J]. 中国农机化学报, 2020, 41(11): 162-170.