Constrained manipulation of objects
A computer-implemented method executed by data processing hardware of a robot causes the data processing hardware to perform operations. The robot includes an articulated arm having an end effector engaged with a constrained object. The operations include receiving a measured task parameter set for the end effector. The measured task parameter set includes position parameters defining a position of the end effector. The operations further include determining, using the measured task parameter set, at least one axis of freedom and at least one constrained axis for the end effector within a workspace. The operations also include assigning a first impedance value to the end effector along the at least one axis of freedom and assigning a second impedance value to the end effector along the at least one constrained axis. The operations include instructing the articulated arm to move the end effector along the at least one axis of freedom.
1. A computer-implemented method that, when executed by data processing hardware of a robot including an articulated arm having an end effector engaged with a constrained object having at least one constrained axis and at least one axis of freedom, causes the data processing hardware to perform operations comprising:
receiving a measured task parameter set for the end effector, the measured task parameter set including position parameters defining a position of the end effector;
identifying, using the measured task parameter set, the at least one axis of freedom and the at least one constrained axis for the constrained object;
assigning a first impedance value to the end effector along the at least one axis of freedom of the constrained object and assigning a second impedance value to the end effector along the at least one constrained axis of the constrained object, the second impedance value indicating a greater amount of impedance than the first impedance value; and
instructing the articulated arm to move the end effector along the at least one axis of freedom.
2. The method of claim 1 , wherein identifying the at least one axis of freedom and the at least one constrained axis comprises determining a task space model for the constrained object using the measured task parameter set, and wherein assigning the first and second impedance values to the end effector along the at least one axis of freedom and the at least one constrained axis of the constrained object is based on the task space model.
3. The method of claim 1 , wherein the operations further comprise storing at least a portion of the measured task parameter set in a task buffer as task parameter records.
4. The method of claim 3 , wherein storing at least a portion of the measured task parameter set comprises:
comparing at least one measured parameter from the measured task parameter set to a recorded parameter of one of the task parameter records of the task buffer; and
generating a new task parameter record when a difference between the at least one measured parameter and the recorded parameter satisfies a recording threshold.
5. The method of claim 4 , wherein the measured parameter and the recorded parameter each include a respective position parameter and/or a respective velocity parameter.
6. The method of claim 5 , wherein the operations further comprise evaluating the position parameters of the task parameter records to identify the at least one axis of freedom associated with the task parameter records.
7. The method of claim 3 , wherein the operations further comprise evaluating the task parameter records to determine whether the end effector is engaged with the constrained object.
8. The method of claim 1 , wherein the operations further comprise:
receiving a task request to control the end effector of the articulated arm to manipulate the constrained object;
determining one or more initial impedance parameters based on the task request; and
instructing the articulated arm to move the end effector to manipulate the constrained object based on the task request and the one or more initial impedance parameters,
wherein the position parameters further define the position of the end effector as the end effector manipulates the constrained object.
9. A robot comprising:
an articulated arm having an end effector for engaging a constrained object having at least one constrained axis and at least one axis of freedom;
data processing hardware in communication with the articulated arm; and
memory hardware in communication with the data processing hardware, the memory hardware storing instructions that when executed on the data processing hardware cause the data processing hardware to perform operations comprising:
receiving a measured task parameter set for the end effector, the measured task parameter set including position parameters defining a position of the end effector;
identifying, using the measured task parameter set, the at least one axis of freedom and the at least one constrained axis for the constrained object;
assigning a first impedance value to the end effector along the at least one axis of freedom of the constrained object and assigning a second impedance value to the end effector along the at least one constrained axis of the constrained object, the second impedance value indicating a greater amount of impedance than the first impedance value; and
instructing the articulated arm to move the end effector along the at least one axis of freedom.
10. The robot of claim 9 , wherein identifying the at least one axis of freedom and the at least one constrained axis comprises determining a task space model for the constrained object using the measured task parameter set, and wherein assigning the first and second impedance values to the end effector along the at least one axis of freedom and the at least one constrained axis of the constrained object is based on the task space model.
11. The robot of claim 9 , wherein the operations further comprise storing at least a portion of the measured task parameter set in a task buffer as task parameter records.
12. The robot of claim 11 , wherein storing at least a portion of the measured task parameter set comprises:
comparing at least one measured parameter from the measured task parameter set to a recorded parameter of one of the task parameter records of the task buffer; and
generating a new task parameter record when a difference between the at least one measured parameter and the recorded parameter satisfies a recording threshold.
13. The robot of claim 12 , wherein the measured parameter and the recorded parameter each include a respective position parameter and/or a respective velocity parameter.
14. The robot of claim 13 , wherein the operations further comprise evaluating the position parameters of the task parameter records to identify the at least one axis of freedom associated with the task parameter records.
15. The robot of claim 11 , wherein the operations further comprise evaluating the task parameter records to determine whether the end effector is engaged with the constrained object.
16. A computer program product encoded on a non-transitory computer readable storage medium connected to a robot including an articulated arm having an end effector for engaging a constrained object having at least one constrained axis and at least one axis of freedom, the computer program product comprising instructions that when executed by a data processing apparatus cause the data processing apparatus to perform operations comprising:
receiving a measured task parameter set for the end effector, the measured task parameter set including position parameters defining a position of the end effector;
identifying, using the measured task parameter set, the at least one axis of freedom and the at least one constrained axis for the constrained object;
assigning a first impedance value to the end effector along the at least one axis of freedom of the constrained object and assigning a second impedance value to the end effector along the at least one constrained axis of the constrained object, the second impedance value indicating a greater amount of impedance than the first impedance value; and
instructing the articulated arm to move the end effector along the at least one axis of freedom.
17. The product of claim 16 , wherein identifying at the least one axis of freedom and the at least one constrained axis comprises determining a task space model for the constrained object using the measured task parameter set, and wherein assigning the first and second impedance values to the end effector along the at least one axis of freedom and the at least one constrained axis of the constrained object is based on the task space model.
18. The product of claim 16 , wherein the operations further comprise storing at least a portion of the measured task parameter set in a task buffer as task parameter records.
19. The product of claim 18 , wherein storing at least the portion of the measured task parameters set comprises:
comparing at least one measured parameter from the measured task parameter set to a recorded parameter of one of the task parameter records of the task buffer; and
generating a new task parameter record when a difference between the at least one measured parameter and the recorded parameter exceeds a recording threshold.
20. The product of claim 19 , wherein the measured parameter and the recorded parameter each include a respective position parameter and/or a respective velocity parameter.
21. The product of claim 18 , wherein the operations further comprise evaluating the position parameters of the task parameter records to identify the at least one axis of freedom associated with the task parameter records.
22. The product of claim 18 , wherein the operations further comprise evaluating the task parameter records to determine whether the end effector is engaged with the constrained object.