Process for controlling a robot arm by defining substitution paths
AssigneeCommissariat a l'Energie Atomique
InventorJean-Marie Detriche
Life of this patent
Estimating the term…
Abstract
A process for controlling a robot arm having a certain number of articulations or joints (A to F), which can abut. Substitution paths are automatically defined by calculation or by the choice of intermediate objectives in order to arrive at destination points, when the direct path would involve the abutment of certain joints.
Claims10
A process for controlling a robot arm in moving a wrist at an end of the arm to an objective, the arm comprising rigid sections connected by joints, the sections taking relative positions at the joints which correspond to joint states, the joint states having allowed ranges limited to abutment states, comprising the automatic steps of:
- defining a direct path from a current wrist position to the objective;
- computing sets of theoretical joint states for the robot arm to carry the wrist along the direct path when the joints together take the joint states of each set successively;
- updating all sets that comprise at least one theoretical joint state outside the allowed range of joint states to create updated sets in which all the joint states are within the allowed ranges;
- discarding the sets that comprise at least one theoretical joint state outside the allowed range of joint states;
- and
- moving the wrist along a substitution path by bringing the joints through the computed sets of theoretical joint states that comprise no joint state outside the allowed range of joint states and the updated sets.
A process for controlling a robot arm in moving a wrist at an end of the arm to an objective, the arm comprising rigid sections connected by joints, the sections taking relative positions at the joints which correspond to joint states, the joint states having allowed ranges limited by abutment states, comprising the automatic steps of:
- defining a direct path from a current wrist position to the objective;
- computing sets of theoretical joint states for the robot arm to carry the wrist along the direct path when the joints together take the joint states of each set successively;
- discarding the sets that comprise at least one theoretical joint state outside its allowed range;
- and
- moving the wrist along a substitution path by bringing the joints through the computed sets of theoretical joint states that comprise no joint state outside the allowed range of joint states.
Dependencies are inferred from the claim text.