IP Library Granted Patent US 9,969,084
Granted Patent B2
US 9,969,084 · App. 14/109,825 · Granted May 15, 2018

Coordinated joint motion control system

Inventor: George L. Danko (Reno, NV)
Assignee: Board of Regents of the Nevada System of Higher Education, on behalf of the University of Nevada, Reno
B25J9/1651B25J9/1607E02F3/437E02F3/438E02F3/439E02F9/2037E02F9/2041G05B2219/39062G05B2219/39224G05B2219/40495
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 9,969,084
App. No.
14/109,825
Granted
May 15, 2018
Kind
B2
Abstract

A coordinated joint control system for controlling a coordinated joint motion system, e.g. an articulated arm of a hydraulic excavator blends automation of routine tasks with real-time human supervisory trajectory correction and selection. One embodiment employs a differential control architecture utilizing an inverse Jacobian. Modeling of the desired trajectory of the end effector in system space can be avoided. The disclosure includes image generation and matching systems.

Claims (49)

1. A computer system adapted to perform a method of controlling a user-manipulable implement, the method comprising:

receiving input signals regarding a virtual kinematics configuration selected by a user;

selecting one of a plurality of trajectory paths based at least in part on the received input signals;

calculating velocity components for the selected trajectory path in a first coordinate space;

modifying the velocity components based on first feedback signals received from an input device to provide modified velocity components in the first coordinate space, the first feedback signals being received as part of a first feedback loop;

generating a position-dependent inverse kinematics model for converting between the first coordinate space and a second coordinate space, wherein the generation of the position-dependent inverse kinematics model uses second feedback signals received as part of a second feedback loop; and

based on the position-dependent inverse kinematics model and the modified velocity components, outputting velocity components in the second coordinate space to at least one of a plurality of control connections associated with a plurality of joints of the user-manipulable implement.

2. The computer system of claim 1 , the method further comprising receiving additional input signals from the input device, the received additional input signals indicating the first feedback signals.

3. The computer system of claim 1 wherein the first feedback signals are desired trajectory path changes or desired control changes, wherein the first feedback signals indicate adjustments to the velocity components in the first coordinate space, and wherein the second feedback signals are control measurements in the second coordinate space.

4. The computer system of claim 1 wherein the first coordinate space is Cartesian coordinate space, and wherein the second coordinate space is polar coordinate space.

5. The computer system of claim 1 wherein the first feedback loop is a user-driven feedback loop that allows a user to adjust the velocity components for the trajectory path in the first coordinate space, and wherein the second feedback loop is a control-driven feedback loop according to which the position-dependent inverse kinematics model is adjusted.

6. The computer system of claim 1 wherein further comprising:

repeating the modifying the velocity components based on first feedback signals, the generating the position-dependent inverse kinematics model using second feedback signals, and the outputting the velocity components.

7. The computer system of claim 1 , the method further comprising receiving additional input signals regarding selection of the virtual kinematics configuration from a displayed menu.

8. A computer-implemented method of operating an apparatus comprising a user-manipulable implement comprising a plurality of joints, the method comprising:

receiving input signals regarding a virtual kinematics configuration selected by a user;

selecting one of a plurality of trajectory paths based at least in part on the received input signals;

calculating velocity components for a the selected trajectory path in a first coordinate space;

modifying the velocity components based on first feedback signals received from an input device to provide modified velocity components in the first coordinate space, the first feedback signals being received as part of a first feedback loop;

generating a position-dependent inverse kinematics model for converting between the first coordinate space and a second coordinate space, wherein the generation of the position-dependent inverse kinematics model uses second feedback signals received as part of a second feedback loop; and

based on the position-dependent inverse kinematics model and the modified velocity components, outputting velocity components in the second coordinate space to at least one of a plurality of control connections associated with the plurality of joints of the user-manipulable implement.

9. The method of claim 8 wherein the first feedback signals are desired trajectory path changes or desired control changes, wherein the first feedback signals indicate adjustments to the velocity components in the first coordinate space, and wherein the second feedback signals are control measurements in the second coordinate space.

10. The method of claim 8 wherein the first coordinate space is Cartesian coordinate space, and wherein the second coordinate space is polar coordinate space.

11. The method of claim 8 wherein the first feedback loop is a user-driven feedback loop that allows a user to adjust the velocity components for the trajectory path in the first coordinate space, and wherein the second feedback loop is a control-driven feedback loop according to which the position-dependent inverse kinematics model is adjusted.

12. The method of claim 8 further comprising:

repeating the modifying the velocity components based on first feedback signals, the generating the position-dependent inverse kinematics model using second feedback signals, and the outputting the joint control components.

13. An articulated hydraulic machine with a plurality of joints, one joint being attached to a mechanical arm that includes an end effector, the articulated machine further comprising a control system configured to perform a method comprising:

receiving user input regarding a virtual kinematics configuration selected by a user;

selecting, among a plurality of trajectory paths, based at least in part on the received user input, a trajectory path for the mechanical arm involving movement of the plurality of joints;

sending control signals to the plurality of joints to execute the selected trajectory path for the mechanical arm;

receiving user input modifying trajectory for the end effector;

determining modified control signals to maintain the selected trajectory path of the mechanical arm in view of the trajectory modifications for the end effector according to the user input; and

sending the modified control signals to one or more the plurality of joints to modify the selected trajectory path for the mechanical arm.

14. The machine of claim 13 wherein the user input modifying the trajectory for the end effector provides first feedback signals in a first coordinate space as part of a first feedback loop, and wherein the determining the modified control signals further uses second feedback signals in a second coordinate space as part of a second feedback loop.

15. The machine of claim 14 wherein the first feedback signals are desired trajectory changes for the end effector that indicate adjustments to velocity components in the first coordinate space, and wherein the second feedback signals are control measurements in the second coordinate space.

16. A method comprising:

storing on a computer-readable storage medium computer-executable instructions for causing a computer system programmed thereby to perform acts comprising:

receiving input signals regarding a virtual kinematics configuration selected by a user;

selecting one of a plurality of trajectory paths based at least in part on the received input signals;

calculating velocity components for the selected trajectory path in a first coordinate space;

modifying the velocity components based on first feedback signals received from an input device to provide modified velocity components in the first coordinate space, the first feedback signals being received as part of a first feedback loop;

generating a position-dependent inverse kinematics model for converting between the first coordinate space and a second coordinate space, wherein the generation of the position-dependent inverse kinematics model uses second feedback signals received as part of a second feedback loop;

based on the position-dependent inverse kinematics model and the modified velocity components, outputting velocity components in the second coordinate space to at least one of a plurality of control connections associated with a plurality of joints of a user-manipulable implement; and

moving one or more of the plurality of joints based at least in part on the velocity components.

17. The method of claim 16 wherein the first feedback signals are desired trajectory path changes or desired control changes, wherein the first feedback signals indicate adjustments to the velocity components in the first coordinate space, and wherein the second feedback signals are control measurements in the second coordinate space.

18. The method of claim 16 wherein the first coordinate space is Cartesian coordinate space, and wherein the second coordinate space is polar coordinate space.

19. The method of claim 16 wherein the first feedback loop is a user-driven feedback loop that allows a user to adjust the velocity components for the trajectory path in the first coordinate space, and wherein the second feedback loop is a control-driven feedback loop according to which the position-dependent inverse kinematics model is adjusted.

20. The method of claim 16 wherein the acts further comprise:

repeating the modification of the velocity components based on first feedback signals, the generation of the position-dependent inverse kinematics model using second feedback signals, and the outputting the joint control components.

Assignments (2)
CHANGE OF NAME Recorded Aug 11, 2015
From: BOARD OF REGENTS OF THE UNIVERSITY AND COMMUNITY COLLEGE SYSTEM ON BEHALF OF THE UNIVERSITY OF NEVADA, RENO
To: BOARD OF REGENTS OF THE NEVADA SYSTEM OF HIGHER EDUCATION, ON BEHALF OF THE UNIVERSITY OF NEVADA, RENO
Reel/Frame 036338/0309 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Mar 23, 2015
From: DANKO, GEORGE L.
To: BOARD OF REGENTS OF THE NEVADA SYSTEM OF HIGHER EDUCATION, ON BEHALF OF THE UNIVERSITY OF NEVADA, RENO
Reel/Frame 035232/0529 →
Continuity (4)
Continuation 13430602 · Mar 26, 2012
Continuation 12276791 · Nov 24, 2008
Continuation 10488011 · Aug 26, 2004
Related Publication 20140107841A1 · Apr 17, 2014