Limiting arm forces and torques
A computer-implemented method includes generating a joint-torque-limit model for the articulated arm based on allowable joint torque sets corresponding to a base pose of the base. The method also include receiving a first requested joint torque set for a first arm pose of the articulated arm and determining, using the joint-torque-limit model, an optimized joint torque set corresponding to the first requested joint torque set. The method also includes receiving a second requested joint torque set for a second arm pose of the articulated arm and generating an adjusted joint torque set by adjusting the second requested joint torque set based on the optimized joint torque set. The method also includes sending the adjusted joint torque set to the articulated arm.
1 . A computer-implemented method that, when executed by data processing hardware of a robot including an articulated arm attached to a base, causes the data processing hardware to perform operations comprising:
receiving a first configuration of the base;
determining a set of torques that can be applied to the base in the first configuration to satisfy a base stability metric, the base stability metric defining a threshold amount of movement of the base from the first configuration;
generating a joint-torque-limit model for the articulated arm based on the determined set of torques that can be applied to the base;
receiving a first requested joint torque set for a first arm pose of the articulated arm;
determining a first adjusted joint torque set based on the first requested joint torque set such that the first adjusted joint torque set is within the joint-torque-limit model; and
controlling the articulated arm based on first adjusted joint torque set.
2 . The method of claim 1 , wherein the base comprises a mobile base, wherein the operations further comprise:
receiving a first pose of the mobile base including a center of gravity and a ground contact area of the mobile base;
wherein determining the set of torques that can be applied to the base is further based on the center of gravity and the ground contact area of the mobile base in the first pose.
3 . The method of claim 1 , wherein:
generating the joint-torque-limit model comprises determining a set of wrench forces for the base in the first configuration that satisfy the base stability metric; and
generating the joint-torque-limit model is further based on the set of wrench forces for the base.
4 . The method of claim 1 , wherein determining the first adjusted joint torque set comprises projecting the first requested joint torque set to the joint-torque-limit model.
5 . The method of claim 1 , wherein the operations further comprise determining local information for the joint-torque-limit model at the first requested joint torque set.
6 . The method of claim 5 , wherein generating the first adjusted joint torque set comprises:
obtaining the first requested joint torque set and the local information;
executing a coarse torque adjustment using the local information to project the first requested joint torque set to a coarse adjustment joint torque set; and
executing a fine joint torque adjustment to project the coarse adjustment joint torque set to the joint-torque-limit model.
7 . The method of claim 5 , wherein the local information includes a hyperplane tangent to a surface of the joint-torque-limit model at the first requested joint torque set.
8 . A system for a robot including an articulated arm attached to a base, the system comprising:
data processing hardware; 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 first configuration of the base;
determining a set of torques that can be applied to the base in the first configuration to satisfy a base stability metric, the base stability metric defining a threshold amount of movement of the base from the first configuration;
generating a joint-torque-limit model for the articulated arm based on the determined set of torques that can be applied to the base;
receiving a first requested joint torque set for a first arm pose of the articulated arm;
determining a first adjusted joint torque set based on the first requested joint torque set such that the first adjusted joint torque set is within the joint-torque-limit model; and
controlling the articulated arm based on first adjusted joint torque set.
9 . The system of claim 8 , wherein the base comprises a mobile base, wherein the operations further comprise:
receiving a first pose of the mobile base including a center of gravity and a ground contact area of the mobile base;
wherein determining the set of torques that can be applied to the base is further based on the center of gravity and the ground contact area of the mobile base in the first pose.
10 . The system of claim 8 , wherein:
generating the joint-torque-limit model comprises determining a set of wrench forces for the base in the first configuration that satisfy the base stability metric; and
generating the joint-torque-limit model is further based on the set of wrench forces for the base.
11 . The system of claim 8 , wherein determining the first adjusted joint torque set comprises projecting the first requested joint torque set to the joint-torque-limit model.
12 . The system of claim 8 , wherein the operations further comprise determining local information for the joint-torque-limit model at the first requested joint torque set.
13 . The system of claim 12 , wherein generating the first adjusted joint torque set comprises:
obtaining the first requested joint torque set and the local information;
executing a coarse torque adjustment using the local information to project the first requested joint torque set to a coarse adjustment joint torque set; and
executing a fine joint torque adjustment to project the coarse adjustment joint torque set to the joint-torque-limit model.
14 . The system of claim 12 , wherein the local information includes a hyperplane tangent to a surface of the joint-torque-limit model at the first requested joint torque set.
15 . A computer-implemented method that, when executed by data processing hardware of a robot including an articulated arm attached to a base, causes the data processing hardware to perform operations comprising:
receiving a first configuration of the base;
determining a set of torques that can be applied to the base in the first configuration to satisfy a base stability metric, the base stability metric defining a threshold amount of movement of the base from the first configuration;
generating a joint-torque-limit model for the articulated arm based on the determined set of torques that can be applied to the base;
receiving a first requested joint torque set for a first arm pose of the articulated arm;
determining a first adjusted joint torque set based on the first requested joint torque set such that the first adjusted joint torque set is within the joint-torque-limit model; and
controlling the articulated arm based on first adjusted joint torque set.
16 . The method of claim 15 , wherein the base comprises a mobile base, wherein the operations further comprise:
receiving a first pose of the mobile base including a center of gravity and a ground contact area of the mobile base;
wherein determining the set of torques that can be applied to the base is further based on the center of gravity and the ground contact area of the mobile base in the first pose.
17 . The method of claim 15 , wherein:
generating the joint-torque-limit model comprises determining a set of wrench forces for the base in the first configuration that satisfy the base stability metric; and
generating the joint-torque-limit model is further based on the set of wrench forces for the base.
18 . The method of claim 15 , wherein determining the first adjusted joint torque set comprises projecting the first requested joint torque set to the joint-torque-limit model.
19 . The method of claim 15 , wherein the operations further comprise determining local information for the joint-torque-limit model at the first requested joint torque set.
20 . The method of claim 19 , wherein generating the first adjusted joint torque set comprises:
obtaining the first requested joint torque set and the local information;
executing a coarse torque adjustment using the local information to project the first requested joint torque set to a coarse adjustment joint torque set; and
executing a fine joint torque adjustment to project the coarse adjustment joint torque set to the joint-torque-limit model.