Unlock instant, AI-driven research and patent intelligence for your innovation.

Floating base dynamics feed-forward control method, device and multi-legged robot

A technology based on feedforward control and dynamics, applied in the direction of program control manipulator, program control, general control system, etc., can solve the problems of robot motion control difficulty, high computational complexity, and large amount of calculation

Active Publication Date: 2020-09-29
UBTECH ROBOTICS CORP LTD
View PDF7 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

For these two states, different models need to be used to solve the inverse dynamics, especially in the biped support period, the calculation complexity is high and the calculation amount is too large
In addition, when the biped robot performs these two state transitions, the joint torque will also jump, which brings great difficulty to the motion control of the robot during walking.

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Floating base dynamics feed-forward control method, device and multi-legged robot
  • Floating base dynamics feed-forward control method, device and multi-legged robot
  • Floating base dynamics feed-forward control method, device and multi-legged robot

Examples

Experimental program
Comparison scheme
Effect test

Embodiment 1

[0068] Please refer to figure 2 , this embodiment proposes a floating base dynamics feedforward control method, which can be applied to the motion control of multi-legged robots, such as biped humanoid robots and quadruped robots. This method can effectively solve the problems of high computational complexity and large amount of calculation caused by the use of fixed base inverse dynamics algorithm in the existing scheme, and the sudden change of joint torque caused by state switching.

[0069] Such as figure 2 As shown, the dynamics feed-forward control method of the floating base will be described in detail below.

[0070] In step S10, the kinematic parameters of each joint of the robot are obtained at each moment based on inverse kinematics according to the pre-planned robot trajectory, and the body center of the robot is used as a floating base.

[0071] For the above step S10, for the pre-planned motion trajectory of the robot, for example, it can be the motion trajec...

Embodiment 2

[0142] Please refer to Figure 11 , based on the method of the above-mentioned embodiment 1, this embodiment proposes a floating base dynamics feed-forward control device 10, which includes:

[0143] The joint angle acquisition module 110 is used to acquire the kinematic parameters of each joint of the robot at each moment based on inverse kinematics according to the pre-planned robot motion trajectory, and use the body center of the robot as a floating base;

[0144] The inertial system correction module 120 is used to solve the six-dimensional acceleration of the centroid of each joint in the base coordinate system through the forward kinematics algorithm according to the kinematic parameters of each joint, and calculate the six-dimensional acceleration of the centroid of each joint in the base coordinate system. Convert the one-dimensional acceleration to the six-dimensional acceleration in the world coordinate system;

[0145] The feedforward control module 130 is used to...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to View More

PUM

No PUM Login to View More

Abstract

Embodiments of the present invention disclose a floating-based dynamic feedforward control method, device, and multi-legged robot. The method includes: acquiring kinematic parameters of each joint at each moment based on inverse kinematics based on a pre-planned robot motion trajectory, The center of the body is used as the floating base; the six-dimensional acceleration of the mass center of each joint in the base coordinate system is obtained through forward kinematics according to the kinematic parameters of each joint, and the six-dimensional acceleration of the mass center of each joint is converted into the world coordinate system. According to the six-dimensional acceleration of each joint mass center in the world coordinate system, the torque required by each joint motor is calculated by inverse dynamics and the feedforward control is performed. Compared with the inverse dynamics algorithm of the robot with a fixed base in the existing solution, the present invention can simplify the inverse dynamics algorithm of the robot, reduce the computational complexity and the amount of computation, and effectively improve the performance of the robot during walking due to sudden changes in the load caused by switching between single and double feet. caused by the sudden change of torque and other problems.

Description

technical field [0001] The invention relates to the technical field of robot control, in particular to a floating base dynamics feedforward control method, device and multi-legged robot. Background technique [0002] For the application of the inverse dynamics algorithm, for example, its main application scenario is a serial structure robot with a fixed base and each joint connected in turn. By giving the trajectory of the end effector of the robot following time, based on the fixed base, the full dynamic equation is used to solve the torque (also called torque) required by each joint at each moment, and then the position control or direct force control of each joint motor is performed. , to achieve the desired robot motion. [0003] However, there are also some shortcomings in this fixed-base inverse dynamics algorithm. For example, the application scenarios are limited, and the algorithm cannot be directly applied to mobile robots, such as biped or quadruped robots. At p...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to View More

Application Information

Patent Timeline
no application Login to View More
Patent Type & Authority Patents(China)
IPC IPC(8): B25J9/16B62D57/032
CPCB25J9/16B25J9/1628B25J9/1651B25J9/1664B25J9/1633B62D57/032B25J9/1607G05B2219/40264G05B2219/40077G05B19/4155G05B19/4166G05B2219/34013G05B2219/50391
Inventor 王岳嵩鞠笑竹赵明国熊友军
Owner UBTECH ROBOTICS CORP LTD