Method and apparatus for controlling the motion of a redundancy manipulator
AssigneeMitsubishi Jukogyo Kabushiki Kaisha
InventorNoriko Endo
Life of this patent
Estimating the term…
Abstract
A method and apparatus for controlling the motion of a redundancy manipulator in which the redundancy manipulator has at least seven axes. The optimal estimate function is calculated for the target posture among an infinite number of (possible) elbow postures of the redundancy manipulator to ensure that the elbow reaches its target position at least before the hand position or posture values reaches its targeted value. The elbow posture of said redundancy manipulator is controlled based on the estimate function K.
Claims11
Apparatus for controlling the movement of an end effector of a redundant manipulator from a present position to a target position, said manipulator having at least seven axes of motion including a key redundancy axis, said apparatus comprising:
- a first detector for detecting the values for the present positions of said end effector and of each of said axes of said manipulator and providing first output signals corresponding to said respective present positions;
- a second detector for detecting the values for said target positions for said end effector and for each of said axes of said manipulator and providing second output signals corresponding to said target positions;
- a first computer responsive to said first and second output signals for providing a third output signal in the form of a seven-dimensional vector corresponding to the target positions for each of said seven axes;
- an end effector controller responsive to said first and second output signals for providing a fourth output signal corresponding to end effector velocity for each axis as said end effector is moved to its target position;
- a key redundancy axis controller responsive to said first and second output signals and for providing a fifth output signal corresponding to the angular velocity of said key redundancy axis as said end effector is moved to its target position;
- a second computer responsive to said third, fourth, and fifth output signals for providing a sixth output signal corresponding to the axial velocity of each of said axes as said end effector is moved to its target position;
- and
- a third computer responsive to said sixth output signal for calculating an angular velocity for each axis other than said key redundancy axis and providing a seventh output signal corresponding to the angular velocity for each of said axes other than said key redundancy axis and to the axial velocity of said key redundancy axis for moving said end effector to said target position, whereby said end effector and each of said axes reaches its respective target position substantially simultaneously.
A method of controlling the movement of an end effector of a redundancy manipulator from a present position to a target position, said manipulator having an elbow posture and at least seven axes of motion, comprising the steps of:
- calculating the optimal estimate function for the elbow target posture from among an infinite number of possible elbow postures of said manipulator to permit said elbow posture to reach said elbow target posture at least before said end effector reaches said target position;
- and
- controlling said elbow posture of said redundancy manipulator based on said optimal estimate function.
A method of controlling the movement of an end effector of a redundancy manipulator from a present position to a target position, said redundancy manipulator having at least seven axes including a key redundant axis determined by the links configured for said manipulator, comprising the steps of:
- calculating an axial angle velocity for said key redundant axis to reach a target position before said end effector reaches its target position in every sampling cycle;
- interpolating said key redundancy axial angle velocity so that it reaches its targeted position in every sampling cycle;
- and
- computing said axial angle velocity for axes other than said key redundant axis in every sampling cycle based on said axial angle velocity of said key redundant axis.
A method of controlling the movement of an end effector of a redundancy manipulator from a present position to a target position, said redundancy manipulator having at least seven axes including a key redundant axis, comprising the steps of:
- detecting the present value and the targeted value in every sampling cycle, said present value and said targeted value comprising the end effector velocity and the velocity of each axis for moving from the present position to the end position;
- calculating a estimate function based on the axial velocity of said end effector and said key redundant axis obtained by interpolating the key redundant axial value so that said end effector reaches its targeted position in every sampling cycle;
- and
- calculating the axial angle velocities for axes other than said key redundant axis based on said estimate function in every sampling cycle.
Dependencies are inferred from the claim text.