Pitching attitude closed loop control of wheel-legged all terrain mobile robot with active suspension

Ma Fangwu; Ni Liwei; Wu Liang; Nie Jiahong

doi:10.11975/j.issn.1002-6819.2018.20.003

Volume 34 Issue 20

Oct. 2018

Turn off MathJax

Article Contents

Abstract

References

Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE) > 2018 > 34(20): 20-27. > DOI: 10.11975/j.issn.1002-6819.2018.20.003

Ma Fangwu, Ni Liwei, Wu Liang, Nie Jiahong. Pitching attitude closed loop control of wheel-legged all terrain mobile robot with active suspension[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2018, 34(20): 20-27. DOI: 10.11975/j.issn.1002-6819.2018.20.003

Citation:

PDF (2426 KB)

Pitching attitude closed loop control of wheel-legged all terrain mobile robot with active suspension

Ma Fangwu^1,2,
Ni Liwei^1,2,
Wu Liang^1,2,
Nie Jiahong^1,2

1.
College of Automotive Engineering, Jilin University, Changchun 130012, China
2.
State Key Laboratory of Automotive Simulation and Control, Jilin University, Changchun 130012, China

More Information

Received Date: April 22, 2018
Revised Date: June 28, 2018
Published Date: October 14, 2018

Graphical Abstract

Abstract

Abstract

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.
- robots,
- kinematics,
- control,
- models,
- joint simulation

FullText(HTML)

References (33)

References

[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), 2016, 32(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)Pitching attitude closed loop control of wheel-legged all terrain mobile robot with active suspension

[1]	Li Jiaxing, Weng Zhonghua, Chen Xin. Influence of near-bed boundary condition on mixture model for hyper-concentrated sediment-laden flow in open-channel[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2022, 38(12): 92-99. DOI: 10.11975/j.issn.1002-6819.2022.12.011
[2]	Si Qiaorui, Guo Yongsheng, Tian Ding, Ma Wensheng, Zhang Haoyang, Yuan Shouqi. Study on the inner flow characteristics of an inside unshroud impeller centrifugal pump under gas-liquid two phase condition[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2021, 37(24): 30-37. DOI: 10.11975/j.issn.1002-6819.2021.24.004
[3]	Sun Zhilin, Hu Qiuyue, Tu Wenrong, Fang Shibiao, Yang Yang. Heat transfer characteristics in circulating solar heat tubes based on gas-liquid two-phase flow[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(24): 246-254. DOI: 10.11975/j.issn.1002-6819.2019.24.029
[4]	Luo Xingqi, Yan Sina, Feng Jianjun, Zhu Guojun, Sun Shuaihui, Chen Senlin. Research on force characteristics of gas-liquid two-phase centrifugal pump[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(23): 66-72. DOI: 10.11975/j.issn.1002-6819.2019.23.008
[5]	Sun Chunhua, Ning Zhi, Qiao Xinqi, Li Yuanxu, Lü Ming. Gas-liquid two-phase flow pattern affecting spray shape and droplet size distribution[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(12): 29-37. DOI: 10.11975/j.issn.1002-6819.2019.12.004
[6]	Zhang Xiaoying, Li Lin, Jin Sheng, Tan Yihai, Wu Yangfeng. Experiment studies on impact of siphon gradient on gas-liquid two-phase flow characteristic[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2017, 33(14): 122-129. DOI: 10.11975/j.issn.1002-6819.2017.14.017
[7]	Sha Yi, Liu Xiangsong. Numerical calculation on gas-liquid two-phase hydrotransport and flow field measurement in volute with probes for vortex pump[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2014, 30(18): 93-100. DOI: 10.3969/j.issn.1002-6819.2014.18.012
[8]	Li Hong, Xu Dehuai, Tu Qin, Cheng Jun, Li Lei. Numerical simulation on gas-liquid two-phase flow of self-priming pump during starting period[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2013, 29(3): 77-83.
[9]	Fan Lidan, Ma Wenxing, Chai Bosen, Lu Xiuquan. Numerical simulation and particle image velocimetry for gas-liquid two-phase flow in hydraulic couplings[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2011, 27(11): 66-70.
[10]	Yi Weiming, Wang Nana, Zhang Botao, Li Zhihe. Experimental study on gas-solid two-phase flow in a horizontal entrained bed[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2006, 22(1): 11-14.