矿井救援六足机器人动态转矩补偿机构设计

Design of dynamic torque compensation mechanism for hexapod mine rescue robot

  • 摘要: 针对矿井救援六足机器人在重载工况下关节驱动转矩不足、电动机易过载的问题,设计了一种丝杠抽绳式动态转矩补偿机构。该机构采用自适应转矩补偿控制策略和“电动机−拉簧”混合驱动模式:首先建立单腿静力学模型,给出关节转矩与足端力的映射关系;然后引入负载估计器,基于关节编码器、机身姿态及电动机反馈转矩实时估算外部负载,并生成期望补偿转矩;最后将期望值送入双层控制器,驱动丝杠电动机执行转矩跟踪。通过半丝杠−齿轮传动系统实时调节拉簧预紧力,使补偿转矩精确抵消由机器人自身质量与外部负载引起的静态关节转矩,从而降低关节电动机负担,提高六足机器人负载能力。仿真结果表明,应用丝杠抽绳式动态转矩补偿机构后,20 kg负载下机器人髋关节、膝关节峰值转矩分别降低23.8%和39.5%;在爬行、越障步态下降低比例稳定在17.1%~41.8%,验证了该机构具有较强的动态适应性;机器人最大承载负载由31.8 kg提升至52.4 kg,增幅达64.8%,表明该机构可显著拓展机器人的重载作业能力。

     

    Abstract: To address insufficient joint drive torque and the tendency of motors to overload in hexapod mine rescue robots under heavy loads, a rope-pulling lead-screw dynamic torque compensation mechanism was proposed. The mechanism employed an adaptive torque compensation control strategy and a hybrid motor–extension-spring drive mode. First, a single-leg static model was established to describe the mapping between joint torque and foot-end force. A load estimator was then introduced to estimate the external load in real time using joint encoder data, body attitude, and motor torque feedback and to generate the desired compensation torque. Finally, the desired value was fed into a bi-level controller, which drove the lead-screw motor to track the torque. The extension-spring preload was adjusted in real time through a half-lead-screw and gear transmission system so that the compensation torque precisely offset the static joint torque caused by the robot's own mass and external load, reducing the burden on the joint motors and improving the robot's load-carrying capacity. Simulation results showed that the mechanism reduced peak hip- and knee-joint torques by 23.8% and 39.5%, respectively, under a 20 kg load. The reductions remained within 17.1%-41.8% during crawling and obstacle-crossing gaits, demonstrating strong dynamic adaptability. The maximum payload increased from 31.8 kg to 52.4 kg, a gain of 64.8%, indicating that the mechanism can substantially enhance the robot's heavy-load operating capability.

     

/

返回文章
返回