Coordinated joint motion control system
View Patent ↗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. Modelling of the desired trajectory of the end effector in system space can be avoided. The disclosure includes image generation and matching systems.
1. A tangible computer-readable storage medium storing computer-executable instructions for causing a computer system programmed thereby to perform a method comprising:
controlling a user-manipulable implement in real time, including:
outputting to a display device a menu of virtual kinematics configurations, each virtual kinematics configuration comprising a plurality of trajectory paths of the user-manipulable implement, each trajectory path comprising at least two dimensions;
selecting one of the plurality of trajectory paths;
calculating velocity components for the selected trajectory path in a first coordinate space;
in a differential control kinematics generator, 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-readable storage medium of claim 1 , the method further comprising receiving input signals from an input device regarding a virtual kinematics configuration selected by a user, wherein the selection of one of the plurality of trajectory paths is based at least in part on the received input signals.
3. The computer-readable storage medium of claim 1 , the method further comprising receiving input signals from an input device, the received input signals indicating the first feedback signals.
4. A system comprising:
a processor;
the tangible computer readable storage medium of claim 1 .
5. The system of claim 4 , further comprising a display.
6. The system of claim 4 , further comprising an input device, the input device configured to generate signals allowing an operator to select a virtual kinematics configuration from the displayed menu.
7. The system of claim 4 , further comprising an input device, the input device configured to generate signals indicating the first feedback signals.
8. The computer-readable storage medium 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.
9. The computer-readable storage medium of claim 1 wherein the first coordinate space is Cartesian coordinate space, and wherein the second coordinate space is polar coordinate space.
10. The computer-readable storage medium 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 selected 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.
11. The computer-readable storage medium of claim 1 wherein the controlling the user-manipulable implement in real time further comprises:
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 velocity components in the second coordinate space.
12. A method comprising:
storing on a computer-readable storage medium computer-executable instructions for causing a computer system programmed thereby to perform acts comprising controlling a user-manipulable implement in real time, including:
outputting to a display device a menu of virtual kinematics configurations, each virtual kinematics configuration comprising a plurality of trajectory paths of the user-manipulable implement, each trajectory path comprising at least two dimensions;
calculating velocity components for the selected trajectory path in a first coordinate space;
in a differential control kinematics generator, 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.
13. A computer-implemented method of operating an apparatus comprising a user-manipulable implement comprising a plurality of joints, the method comprising:
controlling the user-manipulable implement in real time, including:
outputting to a display device a menu of virtual kinematics configurations, each virtual kinematics configuration comprising a plurality of trajectory paths of the user-manipulable implement, each trajectory path comprising at least two dimensions;
selecting one of the plurality of trajectory paths;
calculating velocity components for the selected trajectory path in a first coordinate space;
in a differential control kinematics generator, 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.
14. The method of claim 13 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.
15. The method of claim 13 wherein the first coordinate space is Cartesian coordinate space, and wherein the second coordinate space is polar coordinate space.
16. The method of claim 13 wherein the first feedback loop is a user-driven feedback loop that allows a user to adjust the velocity components for the selected 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.
17. The method of claim 13 wherein the controlling the user-manipulable implement in real time further comprises:
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.