Exploring Swing Mechanism of Upper and Lower Limbs of Humanoid Robot
-
摘要: 研究了仿人机器人上下肢摆动参数对步行能耗的影响,进而提出了实现仿人机器人低能耗行走的肢体摆动策略。通过将四肢抽象成单摆,建立了机器人的简化模型,据此求解机器人行走时所受的转身力矩;用非小角度假设情况下单摆摆角的近似解来描述四肢摆动角的变化规律,并分析了步行运动时的能耗机理,给出了简化模型下计算功耗的方法。以某仿人机器人模型为算例,研究了肢体摆动频率对机器人行走功耗的影响;提出了在给定行走速度时,保证机器人转身力矩在一定范围内变化的前提下,省能量的上下肢摆动幅度/频率的规划策略。仿真计算表明,采用文中提出的肢体摆动规律有利于降低仿人机器人的行走功耗。Abstract: The influence of the swing parameters of the upper and lower limbs of a humanoid robot on its walking energy consumption is studied. The swing mechanism of a limb with low energy consumption is proposed. Abstracting the limb into a single swing, a simplified model of the humanoid robot is established and then used to solve the robot's turning moment during its walking. The approximate solution of the pendulum angle under the non-small angle hypothesis is used to describe the variation of the limb's swing angle. The energy consumption mechanism of the walking is analyzed, and the method of calculating energy consumption under the simplified model is given. Taking the humanoid robot model as example, the influence of the swing frequency of the limb on the power consumption of the robot during its walking is studied. Given the walking speed, the energy-saving planning strategy of upper and lower limbs' swing amplitude/frequency was proposed under the premise that the turning moment of the robot varies in a certain range. The calculation results show that the limb swing law proposed in the paper helps to reduce the energy consumption of the walking humanoid robot.
-
Key words:
- humanoid robot /
- energy consumption of walking /
- simple pendulum
-
表 1 各关节对应的转角
关节 欧拉角 参数说明 腰关节 ${\theta _1}$ 俯身(绕Y轴) ${\theta _2}$ 转身(绕Z轴) ${\theta _3}$ 侧身(绕X轴) 左肩关节 ${\theta _4}$ 左右摆(横摆) ${\theta _5}$ 前后摆(纵摆) 右肩关节 ${\theta _6}$ 左右摆(横摆) ${\theta _{\rm{7}}}$ 前后摆(纵摆) 左髋关节 ${\theta _{\rm{8}}}$ 左右摆(横摆) ${\theta _{\rm{9}}}$ 前后摆(纵摆) 右髋关节 ${\theta _{10}}$ 左右摆(横摆) ${\theta _{11}}$ 前后摆(纵摆) 表 2 仿人机器人参数表
参数 上肢 下肢 躯干和头部 总体 质量/kg 3.629 11.685 41.948 72.576 长度/m 0.709 6 0.975 0.535 1.80 表 3 步态参数选择
腿摆幅Al/(°) 步幅/m 摆动角频率/(rad·s−1) 周期T/s 速度v/(km·h−1) 胳膊摆幅Aa/(°) 最大转身力矩/(N·m) P0/W P1/W P/W 12 0.4 3.890 1.615 1.8 10 3.485 22.31 0.33 22.64 15 0.5 3.884 1.618 2.2 18 3.808 32.75 1.06 33.81 18 0.6 3.877 1.621 2.7 20 4.621 45.42 1.33 46.75 21 0.7 3.868 1.624 3.1 22 5.376 60.23 1.66 61.89 24 0.8 3.858 1.629 3.5 26 5.927 77.14 2.33 79.47 表 4 通过增大步频提高速度(腿的摆幅为18°)
摆动角频率ω/(rad·s−1) 速度v/(km·h−1) 胳膊摆幅Aa/(°) 最大转身力矩/(N·m) P0/W P1/W P/W 2.154 1.5 14 1.580 25.23 5.79 31.02 2.585 1.8 16 2.201 30.28 5.89 36.17 3.159 2.2 18 3.176 37.01 4.88 41.89 3.877 2.7 20 4.621 45.42 1.33 46.75 4.451 3.1 22 5.788 52.14 5.84 57.98 5.026 3.5 24 7.247 58.88 11.97 70.85 5.600 3.9 26 8.674 65.60 22.02 87.62 6.174 4.3 28 9.874 72.33 36.29 108.62 6.749 4.7 30 11.590 79.06 54.88 133.94 7.323 5.1 30 13.930 85.79 76.72 162.51 -
[1] 朱洪波. 仿人机器人高效步行模式生成与高稳定动态行走控制方法研究[D]. 合肥: 中国科学技术大学, 2017.Zhu H B. Research on energy-efficient gait pattern generation and control for humanoid robot[D]. Hefei: University of Science and Technology of China, 2017 (in Chinese). [2] 王丽杨, 刘治, 曾小杰, 等. 基于能效优化的两足机器人步态控制方法[J]. 控制理论与应用, 2011, 28(5): 667-674Wang L Y, Liu Z, Zeng X J, et al. Gait control based on energy-efficiency optimization for biped robots[J]. Control Theory & Applications, 2011, 28(5): 667-674 (in Chinese) [3] 杨亮, 傅瑜, 付根平, 等. 基于能效优化的仿人机器人跑步步态优化与控制[J]. 计算机科学, 2016, 43(6): 270-275 doi: 10.11896/j.issn.1002-137X.2016.06.053Yang L, Fu Y, Fu G P, et al. Running gait planning and control for humanoid robot based on energy efficiency optimization[J]. Computer Science, 2016, 43(6): 270-275 (in Chinese) doi: 10.11896/j.issn.1002-137X.2016.06.053 [4] Shin H K, Kim B K. Energy-efficient gait planning and control for biped robots utilizing the allowable ZMP region[J]. IEEE Transactions on Robotics, 2014, 30(4): 986-993 doi: 10.1109/TRO.2014.2305792 [5] KhazeniFard A, Bahrami F, Andani M E, et al. An energy efficient gait trajectory planning algorithm for a seven linked biped robot using movement elements[C]//Proceedings of the 23rd Iranian Conference on Electrical Engineering. Tehran, Iran: IEEE, 2015: 1006-1011. [6] Ding J T, Zhou C X, Xiao X H. Energy-efficient bipedal gait pattern generation via CoM acceleration optimization[C]//Proceedings of the 18th International Conference on Humanoid Robots. Beijing, China: IEEE, 2018: 238-244. [7] Wang M Y, Wang R C, Zhao J H, et al. An optimized algorithm based on energy efficiency for gait planning of humanoid robots[C]//Proceedings of the 44th Annual Conference of the IEEE Industrial Electronics Society. Washington, DC, USA: IEEE, 2018: 5612-5617. [8] Liu Y X, Zang X Z, Wang C, et al. A bio-inspired musculoskeletal model of the lower limb for energy economical bipedal walking[C]//Proceedings of the 3rd IEEE International Conference on Robotic Computing. Naples, Italy: IEEE, 2019: 288-292. [9] Hsu H K, Huang H P, Huang M B. A real-time optimal energy-saving walking pattern generator based on gradient descent method and linear quadratic control[J]. Advanced Robotics, 2019, 33(10): 487-507 doi: 10.1080/01691864.2019.1600425 [10] 王继祥, 王立华, 迟连坤, 等. 基于MATLAB与ADAMS的双足步行机器人特性研究[J]. 机械与电子, 2018, 36(3): 69-73 doi: 10.3969/j.issn.1001-2257.2018.03.017Wang J X, Wang L H, Chi L K, et al. Research on characteristics of biped walking robot based on MATLAB and ADAMS[J]. Machinery & Electronics, 2018, 36(3): 69-73 (in Chinese) doi: 10.3969/j.issn.1001-2257.2018.03.017 [11] McGeer T. Passive dynamic walking[J]. The International Journal of Robotics Research, 1990, 9(2): 62-82 doi: 10.1177/027836499000900206 [12] 倪修华, 陈维山, 刘军考, 等. 一种由人类步行启发的半被动双足步行机器人[J]. 中南大学学报, 2011, 42(4): 1028-1034Ni X H, Chen W S, Liu J K, et al. A quasi-passive dynamic walker inspired by human walking[J]. Journal of Central South University, 2011, 42(4): 1028-1034 (in Chinese) [13] 夏泽洋, 陈恳, 刘莉, 等. 面向仿人机器人自然步态规划的人体步行实验分析[J]. 机器人, 2008, 30(1): 41-46 doi: 10.3321/j.issn:1002-0446.2008.01.008Xia Z Y, Chen K, Liu L, et al. Experimental analysis on human locomotion for natural gait planning of humanoid robots[J]. Robot, 2008, 30(1): 41-46 (in Chinese) doi: 10.3321/j.issn:1002-0446.2008.01.008 [14] 李敬, 黄强, 余张国, 等. 人体步行规律与仿人机器人步态规划[J]. 中国科学: 信息科学, 2012, 42(9): 1067-1080 doi: 10.1360/112012-342Li J, Huang Q, Yu Z G, et al. Human walking mechanism and gait planning of humanoid robots[J]. Scientia Sinica Informationis, 2012, 42(9): 1067-1080 (in Chinese) doi: 10.1360/112012-342 [15] Zhu H B, Luo M Z, Mei T, et al. Energy-efficient bio-inspired gait planning and control for biped robot based on human locomotion analysis[J]. Journal of Bionic Engineering, 2016, 13(2): 271-282 doi: 10.1016/S1672-6529(16)60300-1 [16] 孙敏, 范守文. 基于能耗指标的拟人机器人步态优化与分析[J]. 机械设计与研究, 2007, 23(2): 52-54, 59 doi: 10.3969/j.issn.1006-2343.2007.02.013Sun M, Fan S W. Optimization and analysis for gait of humanoid robot based on energy consumption index[J]. Machine Design and Research, 2007, 23(2): 52-54, 59 (in Chinese) doi: 10.3969/j.issn.1006-2343.2007.02.013 [17] 金亚平. 单摆周期的相图求法[J]. 大学物理, 2000, 19(10): 6-7, 11 doi: 10.3969/j.issn.1000-0712.2000.10.002Jin Y P. The period of a simple pendulum calculated by its phase diagram[J]. College Physics, 2000, 19(10): 6-7, 11 (in Chinese) doi: 10.3969/j.issn.1000-0712.2000.10.002