US 12,275,152 B2
Robot stability control method, robot and computer-readable storage medium
Ligang Ge, Shenzhen (CN); Yizhang Lìu, Shenzhen (CN); Chunyu Chen, Shenzhen (CN); Qiuyue Luo, Shenzhen (CN); Jiangchen Zhou, Shenzhen (CN); Meng Yan, Shenzhen (CN); and Youjun Xiong, Shenzhen (CN)
Assigned to UBTECH ROBOTICS CORP LTD, Shenzhen (CN)
Filed by UBTECH ROBOTICS CORP LTD, Shenzhen (CN)
Filed on Nov. 29, 2022, as Appl. No. 18/071,462.
Claims priority of application No. 202111552534.1 (CN), filed on Dec. 17, 2021.
Prior Publication US 2023/0191604 A1, Jun. 22, 2023
Int. Cl. G05B 19/4155 (2006.01); B25J 9/16 (2006.01)
CPC B25J 9/1664 (2013.01) [B25J 9/1605 (2013.01); G05B 19/4155 (2013.01); G05B 2219/50391 (2013.01)] 20 Claims
OG exemplary drawing
 
1. A computer-implemented robot stability control method, comprising:
obtaining a desired zero moment point (ZMP) and a fed-back actual ZMP of a robot at a current moment;
based on a ZMP tracking control model, the desired ZMP and the actual ZMP, calculating a desired value of a motion state of a center of mass of the robot at the current moment, wherein the desired value of the motion state of the center of mass comprises a correction amount of the position of the center of mass, and wherein the ZMP tracking control model takes the desired ZMP and the actual ZMP as an input of the ZMP tracking control model, and takes the desired value of the motion state of the center of mass as an output;
based on a spring-mass-damping-acceleration model and the desired value of the motion state of the center of mass, calculating a lead control input amount for the correction amount of the position of the center of mass; and
controlling motion of the robot according to the lead control input amount and a planned value of the position of the center of mass at the current moment, so as to realize tracking of the desired ZMP by the robot;
wherein the spring-mass-damping-acceleration model is created by adding a second mass block to a spring-mass-damping model that includes a first mass block, the second mass block and a desired acceleration are configured to generate a force on the first mass block; a dynamic equation of the spring-mass-damping-acceleration model is obtained by performing force balance analysis on the first mass block, the dynamic equation of the spring-mass-damping-acceleration model is configured to calculate the lead control input amount for the correction amount of the position of the center of mass when the robot performs ZMP tracking.