Systems and methods of coordination control for robot manipulation

• US 8,428,781 B2
• Filed: 11/17/2009
• Issued: 04/23/2013
• Est. Priority Date: 11/17/2008
• Status: Active Grant

• Current Assignee: Universal Robots USA Incorporated
• Original Assignee: Energic Technologies Corp.
• Inventors: Chang, Chu-Yin, English, James, Tardella, Neil, Bacon, James
• Primary Examiner(s): Trammell, James
• Assistant Examiner(s): Malhotra, Sanjeev
• Application Number:
  US12/620,482
• Publication Number:
  US 20100152899A1
• Time in Patent Office: 1,253 Days
• Field of Search: 700/245, 700/261, 700/263, 744/900.4, 104/53, 180/19.1, 244/190, 378/21, 600/118
• US Class Current: 700/262
• CPC Class Codes: B25J 9/162 Mobile manipulator, movable base with manipulator arm mounted on it
• CPC Class Codes: B25J 9/1643 redundant control
• CPC Class Codes: B25J 9/1682 Dual arm manipulator; Coordination of several manipulators
• CPC Class Codes: G05B 2219/40336 Optimize multiple constraints or subtasks
• CPC Class Codes: Y10T 74/20323 including flaccid drive element

Abstract

Disclosed herein are systems and methods for controlling robotic apparatus having several movable elements or segments coupled by joints. At least one of the movable elements can include one or more mobile bases, while the others can form one or more manipulators. One of the movable elements can be treated as an end effector for which a certain motion is desired. The end effector may include a tool, for example, or represent a robotic hand (or a point thereon), or one or more of the one or more mobile bases. In accordance with the systems and methods disclosed herein, movement of the manipulator and the mobile base can be controlled and coordinated to effect a desired motion for the end effector. In many cases, the motion can include simultaneously moving the manipulator and the mobile base.

Claims

1. A method of controlling a robotic apparatus comprising a plurality of movable elements coupled to one another via one or more joints defining one or more degrees of freedom of movement for each of the movable elements, at least one of said movable elements comprising a mobile base for the apparatus, the control method comprising:

receiving input signals indicating a desired position or motion constraint for at least one of the movable elements;

generating, based on the input signals, a plurality of control signals to control movement of the mobile base and at least one other movable element to achieve the desired motion by optimizing a pre-defined scalar function of the motion and positions of the movable elements and the mobile base;

applying the control signals to the mobile base and the at least one other movable element to concurrently move the mobile base and the at least one other movable element to effect the desired motion;

wherein the pre-defined scalar function is defined by;

μ

=½

{dot over (q)}^TW{dot over (q)}+α

{dot over (q)}^TF,

where q is a n-length vector representation of the positions of the one or more joints and the mobile base;

with {dot over (q)} being its time derivative (change in position over time);

W is a matrix function W(q);

F is a vector function of configuration; and

α

is a scalar function of configuration; and

wherein W, F and α

are selected to define a control strategy for controlling the robotic apparatus.

2. The method of claim 1, wherein at least one of the movable elements comprises an end effector.

3. The method of claim 2, wherein the end effector comprises any of a gripper, a cutter, a saw, a haptic element, a multi-fingered end effector.

4. The method of claim 1, wherein at least one of the movable elements provides contact with the environment for the purpose of locomotion.

5. The method of claim 1, wherein the mobile base comprises any of a wheel, a track, and a rail.

6. The method of claim 1, wherein the mobile base comprises any of a digging, climbing, and spelunking apparatus.

7. The method of claim 1, wherein the mobile base comprises any of a boat, submarine, and hovercraft.

8. The method of claim 1, wherein the mobile base comprises any of an airplane, helicopter, and air-floating vehicle.

9. The method of claim 1, wherein the plurality of movable elements comprise a robotic arm and a mobile base.

10. The method of claim 1, wherein the input signals are generated by a user input device.

11. The method of claim 10, further comprising, (i) displaying a plurality of views of the robotic apparatus pose to a user, and (ii) allowing the user to control the robotic apparatus from each of the plurality of the views with the user input device.

12. The method of claim 11, wherein the user input device requires only a single user action to switch control between the plurality of the views.

13. The method of claim 11, wherein the plurality of views comprise a plurality of rendered views.

14. The method of claim 10, further comprising, (i) displaying a plurality of views of the robotic apparatus pose to a user, and (ii) allowing the user to control the robotic apparatus from each of the plurality of views with the user input device, and (iii) automatically updating each of the plurality of views based on a user'"'"'s control input in any one view.

15. The method of claim 1, wherein the input signals are transmitted over any of audio signal, electromagnetic signal, or a computer network.

16. The method of claim 1, wherein the mobile base has two or more degrees of freedom of movement comprising linear velocity and angular velocity.

17. The method of claim 1, comprising applying the control signals to one or more actuators coupled to the one or more movable elements to effect the desired motion.

18. The method of claim 1, wherein the pre-defined scalar function is associated with movement of the robotic apparatus, a gradient of potential energy associated with movement of the robotic apparatus, singularity avoidance, accuracy, joint-limit avoidance, obstacle avoidance.

19. The method of claim 1, wherein the pre-defined scalar function signifies a constraint on movement of at least one movable element.

20. The method of claim 1, wherein the movable elements of the robotic apparatus exhibit, collectively, at least seven degrees of freedom of movement.

21. The method of claim 1, wherein generating the control signals comprises determining control vectors using the following equation: