G05B2219/40077

Feedforward control method for floating base dynamics, computer-readable storage medium and robot

A feedforward control method comprising steps of: acquiring kinematic parameters of each joint of a robot based on inverse kinematics according to a pre-planned robot motion trajectory, and setting a center of a body of the robot as a floating base; determining a six-dimensional acceleration of a center of mass of each joint of the robot in a base coordinate system using a forward kinematics algorithm, based on the kinematic parameters of each joint of the robot, and converting the six-dimensional acceleration of the center of mass of each joint of the robot in the base coordinate system to a six-dimensional acceleration in a world coordinate system; and calculating a torque required by a motor of each joint of the robot using an inverse dynamic algorithm, and controlling the motors of corresponding joints of the robot.

ROBOT STABILITY CONTROL METHOD, ROBOT AND COMPUTER-READABLE STORAGE MEDIUM

A robot stability control method includes: 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; 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.

ROBOT POSTURE CONTROL METHOD AND ROBOT AND COMPUTER READABLE STORAGE MEDIUM USING THE SAME
20220040851 · 2022-02-10 ·

The present disclosure provides a robot posture control method as well as a robot and a computer readable storage medium using the same. The method includes: constructing a virtual model of the robot, wherein the virtual model comprises a momentum wheel inverted pendulum model of the robot and an angle between a sole surface of the robot and a horizontal plane; and performing a posture control based on outer-loop feedback control, inner loop compensation for the external disturbance rejection in position level, inner loop external disturbance rejection via null-space in velocity level, and inner loop external disturbance rejection in force/acceleration level on the robot. In this manner, a brand-new virtual model is provided, which can fully reflect the upper body posture, centroid, foot posture, and the like of the robot which are extremely critical elements for the balance and posture control of the robot.

Work Mode and Travel Mode for Mobile Robots

A method for operating a robot includes receiving a drive command to drive the robot across a work surface. The drive command includes a work mode command or a travel mode command. In response to receiving the work mode command, the method includes operating the robot in a work mode. In the work mode, the robot dynamically balances on a right drive wheel and a left drive wheel on the work surface, while keeping a non-drive wheel off of the work surface. In response to receiving the travel mode command, the method includes operating the robot in a travel mode. In the travel mode, the robot statically balances on the right drive wheel, the left drive wheel, and the non-drive wheel in contact with the work surface.

FEEDFORWARD CONTROL METHOD FOR FLOATING BASE DYNAMICS, COMPUTER-READABLE STORAGE MEDIUM AND ROBOT
20220019196 · 2022-01-20 ·

A feedforward control method comprising steps of: acquiring kinematic parameters of each joint of a robot based on inverse kinematics according to a pre-planned robot motion trajectory, and setting a center of a body of the robot as a floating base; determining a six-dimensional acceleration of a center of mass of each joint of the robot in a base coordinate system using a forward kinematics algorithm, based on the kinematic parameters of each joint of the robot, and converting the six-dimensional acceleration of the center of mass of each joint of the robot in the base coordinate system to a six-dimensional acceleration in a world coordinate system; and calculating a torque required by a motor of each joint of the robot using an inverse dynamic algorithm, and controlling the motors of corresponding joints of the robot.

Robot posture control method and robot and computer readable storage medium using the same

The present disclosure provides a robot posture control method as well as a robot and a computer readable storage medium using the same. The method includes: constructing a virtual model of the robot, wherein the virtual model comprises a momentum wheel inverted pendulum model of the robot and an angle between a sole surface of the robot and a horizontal plane; and performing a posture control based on outer-loop feedback control, inner loop compensation for the external disturbance rejection in position level, inner loop external disturbance rejection via null-space in velocity level, and inner loop external disturbance rejection in force/acceleration level on the robot. In this manner, a brand-new virtual model is provided, which can fully reflect the upper body posture, centroid, foot posture, and the like of the robot which are extremely critical elements for the balance and posture control of the robot.

Work mode and travel mode for mobile robots

A method for operating a robot includes receiving a drive command to drive the robot across a work surface. The drive command includes a work mode command or a travel mode command. In response to receiving the work mode command, the method includes operating the robot in a work mode. In the work mode, the robot dynamically balances on a right drive wheel and a left drive wheel on the work surface, while keeping a non-drive wheel off of the work surface. In response to receiving the travel mode command, the method includes operating the robot in a travel mode. In the travel mode, the robot statically balances on the right drive wheel, the left drive wheel, and the non-drive wheel in contact with the work surface.

Maneuvering mobile robots

A method of maneuvering a robot includes driving the robot across a surface and turning the robot by shifting a center of mass of the robot toward a turn direction, thereby leaning the robot into the turning direction. The robot includes an inverted pendulum body, a counter-balance body disposed on the inverted pendulum body and configured to move relative to the inverted pendulum body, at least one leg prismatically coupled to the inverted pendulum body, and a drive wheel rotatably coupled to the at least one leg. The inverted pendulum body has first and second end portions and defines a forward drive direction. The method also includes turning the robot by at least one of moving the counter-balance body relative to the inverted pendulum body or altering a height of the at least one leg with respect to the surface.

Mobile robot

A robot includes an inverted pendulum body having first and second end portions, a counter-balance body disposed on the inverted pendulum body and configured to move relative to the inverted pendulum body, at least one leg having first and second ends, and a drive wheel rotatably coupled to the second end of the at least one leg. The first end of the at least one leg is prismatically coupled to the second end portion of the inverted pendulum body.

Reaching mobile robots

A method of operating a robot includes driving a robot to approach a reach point, extending a manipulator arm forward of the reach point, and maintaining a drive wheel and a center of mass of the robot rearward of the reach point by moving a counter-balance body relative to an inverted pendulum body while extending the manipulator arm forward of the reach point. The robot includes the inverted pendulum body, the counter-balance body deposed on the inverted pendulum body, the manipulator arm connected to the inverted pendulum body, at least one leg having a first end prismatically coupled to the inverted pendulum body, and the drive wheel rotatably coupled to a second end of the at least one leg.