主动悬架轮腿式全地形移动机器人俯仰姿态闭环控制
详细信息    查看全文 | 推荐本文 |
  • 英文篇名:Pitching attitude closed loop control of wheel-legged all terrain mobile robot with active suspension
  • 作者:马芳武 ; 倪利伟 ; 吴量 ; 聂家弘
  • 英文作者:Ma Fangwu;Ni Liwei;Wu Liang;Nie Jiahong;College of Automotive Engineering, Jilin University;State Key Laboratory of Automotive Simulation and Control, Jilin University;
  • 关键词:机器人 ; 运动学 ; 控制 ; 模型 ; 联合仿真
  • 英文关键词:robots;;kinematics;;control;;models;;joint simulation
  • 中文刊名:NYGU
  • 英文刊名:Transactions of the Chinese Society of Agricultural Engineering
  • 机构:吉林大学汽车工程学院;吉林大学汽车仿真与控制国家重点实验室;
  • 出版日期:2018-10-23
  • 出版单位:农业工程学报
  • 年:2018
  • 期:v.34;No.347
  • 基金:国家自然科学基金(51705185);; 国家重点研发计划(2017YFC0601604)
  • 语种:中文;
  • 页:NYGU201820003
  • 页数:8
  • CN:20
  • ISSN:11-2047/S
  • 分类号:28-35
摘要
农业机器人在作业时,不可避免的会出现位姿(质心位置与姿态)的变化。为了实现对其位姿的控制,降低复杂路面对机器人姿态的影响,确保机器人的行驶稳定性,基于汽车多连杆独立悬挂系统,设计了一款轮腿式全地形移动机器人。首先在建立轮腿机器人控制运动学模型的基础上,通过矢量法和欧拉公式得到了1/2整机逆运动学模型,进而求出机身运动俯仰角、作动器工作长度与各腿关节转角的变换关系,并对轮腿机器人的位置和姿态进行解耦控制。为了确保机器人运动学控制模型以及运动学逆解的可靠性,在理论模型的基础上加工了1/4台架并进行了单腿运动学标定与运动学控制验证,结果表明仿真数据与试验数据基本吻合,最大误差控制在1.5%以内。在单腿运动学控制模型正确的基础上,采用比例控制算法在MATLAB中搭建整机轮腿机器人俯仰姿态控制策略,在满足轮腿机器人质心位置不变的条件下实现其俯仰姿态闭环控制;最后在ADAMS中构建轮腿机器人虚拟样机模型,利用MATLAB和ADAMS平台搭建轮腿机器人整机俯仰姿态闭环控制联合仿真模型,仿真结果表明轮腿机器人的俯仰姿态与质心位置均有很好的跟踪效果,其中质心位置误差、姿态误差分别控制在0.2%、2%,结果验证了所述轮腿机器人俯仰姿态闭环控制策略的正确性。
        With the attention of agricultural robot research and development in recent years, many kinds of agricultural robots have been developed according to the different focus of the problem solving. Because the wheel-legged robots have excellent obstacle surmounting ability, low energy consumption and stable terrain adaptability compared with other mobile platforms, it has been widely used in various fields of precision agriculture, military investigation, resource exploration and so on. The position and attitude will be inevitably changed when the wheel-legged robots in operation, and the working accuracy and working performance will be affected due to the complexity of the working environment. In order to control the position and attitude, reduce the influence of the non paved pavement to the robot's attitude and position, ensure the stability of the robot, a new type of wheel-legged all terrain mobile robot with active suspension was designed in this study based on the multi-link independent suspension system of the vehicle. Multi-link independent suspension had mature application experience in automobile manufacture, but seldom applied in wheel-legged robot. The suspension system was the general name of the device that connected the body and the wheel. It can be roughly divided into the independent suspension system and the dependent suspension system, of which the non independent suspension system referred to the connection between the two wheels, and the pulsation of one side of the wheel affected the beat of the other side, while the wheels in the multi-link independent suspension system had their respective suspension mechanisms, which were independent of each other and did not interfere with each other, this improved the stability and comfort of the robot. By the suspension system, the vibration of the robot can be effectively reduced, the impact between the parts of the robot was buffered, and the economy and reliability of the robot can be improved. Then on the basis of establishing the kinematics model of wheel-legged robot, the inverse kinematic equations was established by Vector method and Euler formula, and the relationship between actuator stroke and suspension rotation angle was obtained, meanwhile, the position and attitude control of wheel-legged robot was decoupled. In order to ensure the reliability and correctness of the inverse kinematics and kinematics control model of the robot, the 1/4 robot test rig was manufactured and a 1/4 bench model test was carried out on the basis of theoretical analysis. The simulation results were basically consistent with the bench test data, and the maximum error was within 1.5%, the correctness of the relationship between the motion pitch angle of the robot body and the rotation angle of each leg joint was verified under the condition of the participation of the kinematic model. Then, a robot pitching attitude control strategy was built in MATLAB with proportional control to realize the closed loop control under the condition that the center of robot centroid was fixed, Finally, the robot virtual model was built in ADAMS, and MATLAB and ADAMS were used to establish the joint simulation. The simulation results showed that the pitch attitude and the centroid position of the robot had a good tracking effect, and the position error and attitude error of the centroid were 0.2% and 2%, respectively. Therefore, the correctness of the closed-loop attitude control strategy of the wheel-legged robot was verified. The algorithm can maintain the position and attitude of the wheel-legged robot and reduced centroid offset when crossing obstacles, it enhanced the performance of wheel-legged robot as the agricultural robot, the performance of the all terrain mobile robot with active suspension provides a reference for the design of the motion position and attitude control of the modern agricultural robot.
引文
[1]张金柱,金振林,张天浩.并联驱动机械腿运动学静力学性能评价及几何参数设计[J].农业工程学报,2017,33(21):61-69.Zhang Jinzhu,Jin Zhenlin,Zhang Tianhao.Kinematic/static performance evaluation and geometric parameter design of parallel-driving leg mechanism[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2017,33(21):61-69.(in Chinese with English abstract)
    [2]Shigehiko H,Kenta S,Satoshi Y,et al.Evaluation of a strawberry-harvesting robot in a field test[J].Biosystems Engineering,2010,105(2):160-171.
    [3]Bechar A,Vigneault C.Agricultural robots for field operations:Concepts and components[J].Biosystems Engineering,2016,149:94-111.
    [4]陈刚,金波,陈鹰.基于速度逆运动学的六足步行机器人位姿闭环控制[J].农业机械学报,2014,45(5):265-270.Chen Gang,Jin Bo,Chen Ying.Position-posture closed-loop control of six-legged walking robot based on inverse velocity kinematics[J].Transactions of the Chinese Society for Agricultural Machinery,2014,45(5):265-270.(in Chinese with English abstract)
    [5]Raibert M,Blankespoor K,Nelson G,et al.Big dog the rough-terrain quadruped robot[J].IFAC Proceedings Volumes,2008,41(2):10822-10825.
    [6]Zhuang H,Gao H,Liang D,et al.Method for analyzing articulated torques of heavy-duty six-legged robot[J].Chinese Journal of Mechanical Engineering,2013,26(4):801-812.
    [7]李研彪,李景敏,计时鸣,等.一种3自由度并联拟人机械腿的动力学建模及伺服电机峰值力矩预估[J].兵工学报,2014,35(11):1928-1936.Li Yanbiao,Li Jingmin,Ji Shiming,et al.Dynamic modeling and peak torque prediction of servo motor for a 3-dof parallel humanoid mechanical leg[J].Acta Armamentarii,2014,35(11):1928-1936.(in Chinese with English abstract)
    [8]荣誉,金振林,崔冰艳.六足农业机器人并联腿构型分析与结构参数设计[J].农业工程学报,2012,28(15):9-14.Rong Yu,Jin Zhenlin,Cui Bingyan.Configuration analysis and structure parameter design of six-leg agricultural robot with parallel-leg mechanisms[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2012,28(15):9-14.(in Chinese with English abstract)
    [9]徐坤,丁希仑,李可佳.圆周对称分布六腿机器人三种典型行走步态步长及稳定性分析[J].机器人,2012,34(2):231-241.Xu Kun,Ding Xilun,Li Kejia.Stride size and stability analysis of a radially symmetrical hexapod robot in three typical gaits[J].Robot,2012,34(2):231-241.(in Chinese with English abstract)
    [10]徐坤,郑羿,丁希仑.六轮腿式机器人结构设计与运动模式分析[J].北京航空航天大学学报,2016,42(1):59-71.Xu Kun,Zheng Yi,Ding Xilun.Structure design and motion mode analysis of a six wheel-legged robot[J].Journal of Beijing University of Aeronautics&Astronautics,2016,42(1):59-71.(in Chinese with English abstract)
    [11]苏文海,李冰,袁立鹏,等.立体坡面农业四足移动平台姿态控制策略与试验[J].农业工程学报,2018,34(4):80-91.Su Wenhai,Li Bing,Yuan Lipeng,et al.Strategy and experiment of attitude control for quadruped mobile platform walking on three-dimensional slope used for agriculture[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2018,34(4):80-91.(in Chinese with English abstract)
    [12]张金柱,金振林,陈广广.六足步行机器人腿部机构运动学分析[J].农业工程学报,2016,32(9):45-52.Zhang Jinzhu,Jin Zhenlin,Chen Guangguang.Kinematic analysis of leg mechanism of six-legged walking robot[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2016,32(9):45-52.(in Chinese with English abstract)
    [13]Yasuhisa H,Wang Zhidong,Kenta Fukaya,et al.Transporting an object by a passive mobile robot with servo brakes in cooperation with a human[J].Advanced Robotics,2009,23(4):387-404.
    [14]张东胜,许允斗,姚建涛,等.五自由度混联机器人逆动力学分析[J].农业机械学报,2017,48(9):384-391.Zhang Dongsheng,Xu Yundou,Yao Jiantao.Inverse dynamic analysis of novel 5-dof hybrid manipulator[J].Transactions of the Chinese Society for Agricultural Machinery,2017,48(9):384-391.(in Chinese with Englishabstract)
    [15]Grand C,Benamar F,Plumet F.Motion kinematics analysis of wheeled-legged rover over 3D surface with posture adaptation[J].Mechanism&Machine Theory,2010,45(3):477-495.
    [16]权龙哲,张冬冬,查绍辉,等.三臂多功能棚室农业机器人的运动学分析及试验[J].农业工程学报,2015,31(13):32-38.Quan Longzhe,Zhang Dongdong,Zha Shaohui,et al.Kinematics analysis and experiment of multifunctional agricultural robot in greenhouse with three arms[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2015,31(13):32-38.(in Chinese with English abstract)
    [17]张东胜,许允斗,侯照伟,等.五自由度混联机器人优化设计与运动学分析[J].农业工程学报,2016,32(24):69-76.Zhang Dongsheng,Xu Yundou,Hou Zhaowei,et al.Optimal design and kinematics analysis of 5-dof hybrid serial-parallel manipulator[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2016,32(24):69-76.(in Chinese with English abstract)
    [18]阳涵疆,李立君,高自成.基于旋量理论的混联采摘机器人正运动学分析与试验[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(Transactions of the CSAE),2016,32(9):53-59.(in Chinese with English abstract)
    [19]常勇,马书根,王洪光,等.轮式移动机器人运动学建模方法[J].机械工程学报,2010,46(5):30-36.Chang Yong,Ma Shugen,Wang Hongguang,et al.Method of kinematic modeling of wheeled mobile robot[J].Journal of Mechanical Engineering,2010,46(5):30-36.(in Chinese with English abstract)
    [20]Alamdari A,Krovi V N.Static balancing of highly reconfigurable articulated wheeled vehicles for power consumption reduction of actuators[J].Springer International Publishing,2016,3(1):15-31.
    [21]罗陆锋,邹湘军,程堂灿,等.采摘机器人视觉定位及行为控制的硬件在环虚拟试验系统设计[J].农业工程学报,2017,33(4):39-46.Luo Lufeng,Zou Xiangjun,Cheng Tangcan,et al.Design of virtual test system based on hardware-in-loop for picking robot vision localization and behavior control[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2017,33(4):39-46.(in Chinese with English abstract)
    [22]张鹏程,张铁.基于矢量积法的六自由度工业机器人雅可比矩阵求解及奇异位形的分析[J].机械设计与制造,2011(8):152-154.Zhang Pengcheng,Zhang Tie.Analysis on solution of 6D of robot jacobian matrix and singularity configuration based on vector product method[J].Machinery Design&Manufacture,2011(8):152-154.(in Chinese with English abstract)
    [23]谢少荣,刘思淼,罗均,等.一种混合驱动柔索并联仿生眼的轨迹规划[J].机器人,2015,37(4):395-402.Xie Shaorong,Liu Simiao,Luo Jun,et al.Trajectory planning of a bionic eye using hybrid-driven cable parallel mechanism[J].Robot,2015,37(4):395-402.(in Chinese with English abstract)
    [24]宋小康,谈大龙,吴镇炜,等.全地形轮式移动机器人运动学建模与分析[J].机械工程学报,2008,44(6):148-154.Song Xiaokang,Tan Dalong,Wu Zhenwei,et al.Kinematics modeling and analyses of all-terrain wheeled mobile robots[J].Chinese Journal of Mechanical Engineering,2008,44(6):148-154.(in Chinese with English abstract)
    [25]郑楚婷,宋光明,乔贵方,等.具有主动腰关节的四足机器人在间歇性对角小跑步态下的姿态平衡控制[J].机器人,2016,38(6):670-677.Zheng Chuting,Song Guangming,Qiao Guifang,et al.Posture balance control of the quadruped robot with an activewaist joint during intermittent trot locomotion[J].Robot,2016,38(6):670-677.(in Chinese with English abstract)
    [26]潘希样,徐坤,王耀兵,等.具有悬挂系统的轮腿式机器人设计与分析[J].机器人,2018,40(3):1-12.Pan Xiyang,Xu Kun,Wang Yaobing,et al.Design and analysis of a wheel-legged robot with a suspension system[J].Robot,2018,40(3):1-12.(in Chinese with English abstract)
    [27]耶尔森?赖姆帕尔,赖姆帕尔,李旭东.汽车悬架[M].北京:机械工业出版社,2013.
    [28]Zhuang H,Gao H,Ding L,et al.Method for analyzing articulated torques of heavy-duty six-legged robot[J].Chinese Journal of Mechanical Engineering,2013,26(4):801-812.
    [29]牛雪梅,高国琴,刘辛军,等.三自由度驱动冗余并联机构动力学建模与试验[J].农业工程学报,2013,29(16):31-41.Niu Xuemei,Gao Guoqin,Liu Xinjun,et al.Dynamics modeling and experiments of 3-DOF parallel mechanism with actuation redundancy[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2013,29(16):31-41.(in Chinese with English abstract)
    [30]Park S.Gait analysis of a quadruped walking robot with vertical waist-joint on slope[C]//Methods and Models in Automation and Robotics,2009,42(13):507-512.
    [31]Koopman B,van Asseldonk E H,van der Kooij H.Speed-dependent reference joint trajectory generation for robotic gait support[J].Journal of Biomechanics,2014,47(6):1447-1458.
    [32]陈志伟,金波,朱世强,等.液压驱动仿生多足机器人单腿设计与试验[J].农业工程学报,2016,32(5):36-42.Chen Zhiwei,Jin Bo,Zhu Shiqiang,et al.Design and experiment of single leg of hydraulically actuated bionic multi-legged robot[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),201632(5):36-42.(in Chinese with English abstract)
    [33]汪若尘,谢健,叶青,等.直线电机式主动悬架建模与试验研究[J].汽车工程,2016,38(4):495-499.Wang Ruochen,Xie Jian,Ye Qing,et al.Study on coordination control of body posture for active suspension with linear motor[J].Chinese Journal of Automotive Engineering,2016,38(4):495-499.(in Chinese with English abstract)

© 2004-2018 中国地质图书馆版权所有 京ICP备05064691号 京公网安备11010802017129号

地址:北京市海淀区学院路29号 邮编:100083

电话:办公室:(+86 10)66554848;文献借阅、咨询服务、科技查新:66554700