Constrained resolved acceleration control
First Claim
Patent Images
1. A computer-implemented method for controlling an articulated system, the method comprising:
- receiving a task descriptor specifying a movement of a body segment of the articulated system;
estimating kinematics of the body segment of the articulated system;
constructing a weighted matrix based on the estimated kinematics of the body segment;
generating a joint command for a joint associated with the body segment, wherein the joint command controls an acceleration of the body segment based on the weighted matrix and a constrained resolved acceleration that is based on a joint acceleration vector, a diagonal positive definite joint velocity gain matrix, and a difference between a constrained joint velocity vector and a joint velocity vector; and
controlling the joint associated with the body segment using the joint command.
2 Assignments
0 Petitions
Accused Products
Abstract
A system, method, and computer program product for controlling an articulated system are described. The system estimates kinematics of body segments of the articulated system and constructs a weighted pseudo-inverse matrix to enforce kinematic constraints as well as achieve dynamic consistency based on the estimated kinematics. The system converts task descriptors to joint commands using the weighted pseudo-inverse matrix and controls the articulated system at both the velocity level and the acceleration level and enforces kinematic constraints using the joint commands.
32 Citations
20 Claims
-
1. A computer-implemented method for controlling an articulated system, the method comprising:
-
receiving a task descriptor specifying a movement of a body segment of the articulated system; estimating kinematics of the body segment of the articulated system; constructing a weighted matrix based on the estimated kinematics of the body segment; generating a joint command for a joint associated with the body segment, wherein the joint command controls an acceleration of the body segment based on the weighted matrix and a constrained resolved acceleration that is based on a joint acceleration vector, a diagonal positive definite joint velocity gain matrix, and a difference between a constrained joint velocity vector and a joint velocity vector; and controlling the joint associated with the body segment using the joint command. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10)
-
-
11. A non-transitory computer-readable storage medium containing executable computer program code for performing a method for controlling an articulated system, the method comprising:
-
receiving a task descriptor specifying a movement of a body segment of the articulated system; estimating kinematics of the body segment of the articulated system; constructing a weighted matrix based on the estimated kinematics of the body segment; generating a joint command for a joint associated with the body segment, wherein the joint command controls an acceleration of the body segment based on the weighted matrix and a constrained resolved acceleration that is based on a joint acceleration vector [alpha], a diagonal positive definite joint velocity gain matrix, and a difference between a constrained joint velocity vector and a joint velocity vector; and controlling the joint associated with the body segment using the joint command. - View Dependent Claims (12, 13, 14, 15)
-
-
16. A system for controlling an articulated system, the system comprising:
-
a computer processor for executing executable computer program code; a computer-readable storage medium containing the executable computer program code for performing a method comprising; receiving a task descriptor specifying a movement of a body segment of the articulated system; estimating kinematics of the body segment of the articulated system; constructing a weighted matrix based on the estimated kinematics of the body segment; generating a joint command for a joint associated with the body segment, wherein the joint command controls an acceleration of the body segment based on the weighted matrix and a constrained resolved acceleration that is based on a joint acceleration vector [alpha], a diagonal positive definite joint velocity gain matrix, and a difference between a constrained joint velocity vector and a joint velocity vector; and controlling the joint associated with the body segment using the joint command. - View Dependent Claims (17, 18, 19, 20)
-
Specification