Determining sensor parameters and model parameters of a robot

A robotic system comprising:

• a plurality of actuators of a robot;
• sensors of the robot, each of the sensors measuring at least one property associated with a corresponding one of the actuators;
• logic providing control commands to the actuators to traverse the robot along a trajectory;
• a group determination engine identifying, for each of a plurality of instances of the traversal of the robot along the trajectory:
• sensor readings for the sensors, each of the sensor readings corresponding to a respective one of the sensors, and the sensor readings each being for a corresponding parameter that is in addition to position,
• position values for the actuators, each of the position values corresponding to a respective one of the actuators,
• velocity values and acceleration values that are based on the position values, and
• gain values for the sensors of the robot;
• the group determination engine further determining a group of the instances;
• a system equations generation engine configured to apply the sensor readings, the position values, the velocity values, the acceleration values, and the gain values for each of the instances of the group of the instances as values for known variables of a system equation of the robot, the system equation being an equation of motion that includes sensor models substituted for a plurality of variables of the equation of motion, and the system equation including the known variables and unknown variables, the unknown variables representing unknown sensor biases for the sensors of the robot and unknown model parameters of a dynamic model of the robot;
• and
• a sensor parameters and model parameters calculation engine configured to:
• generate a solution to each of a plurality of the unknown variables based on the applied sensor readings, position values, velocity values, acceleration values, and gain values for the group of the instances,
• determine sensor biases for the sensors based on the solutions to the unknown variables that represent the unknown sensor biases, and
• determine model parameters for the dynamic model of the robot based on the solutions to the unknown variables that represent the unknown model parameters.

At least one non-transitory computer readable medium comprising instructions that, in response to execution of the instructions, cause the following operations to be performed:

• determining, by one or more processors for each of a plurality of instances of a traversal of a robot along a trajectory:
• sensor readings for a plurality of sensors of the robot, each of the sensor readings corresponding to a respective one of the sensors, and the sensors each measuring a corresponding parameter that is in addition to position,
• position values for a plurality of actuators of the robot, each of the position values corresponding to a respective one of the actuators, and
• velocity values and acceleration values that are based on the position values;
• identifying gain values for the sensors of the robot;
• applying the sensor readings, the position values, the velocity values, the acceleration values, and the gain values for each of the instances of a group of the instances as values for known variables of a system equation of the robot, the system equation being an equation of motion that includes sensor models substituted for a plurality of variables of the equation of motion, and the system equation including the known variables and unknown variables, the unknown variables representing unknown sensor biases for the sensors of the robot and unknown model parameters of a dynamic model of the robot;
• generating a solution to each of a plurality of the unknown variables based on the applied sensor readings, position values, velocity values, acceleration values, and gain values for the group of the instances;
• determining sensor biases based on the solutions to the unknown variables representing the unknown sensor biases, wherein the sensor biases each define a bias for a respective one of the sensors;
• determining model parameters based on the solutions to the unknown variables representing the unknown model parameters, wherein the model parameters are for the dynamic model of the robot;
• applying a correction to at least one of the sensors of the robot based on the determined sensor bias for the sensor;
• and
• applying the model parameters to the dynamic model of the robot.