Introduction
In general, you do not know the dynamic model of the robot exactly. So you use estimates of the model in the computed torque law. The estimates are , and .
How it works
The control law uses the estimates:
| Symbol | Meaning |
|---|---|
| , | terms of the model based portion |
| input from the servo portion |
The closed loop equation is:
Subtract from both sides and rearrange:
So the error equation is:
| Symbol | Meaning |
|---|---|
| vector of desired joint positions | |
| vector of servo errors, | |
| , | diagonal matrices of position gains and velocity gains |
| error term that comes from the mismatch between the model and the real robot |
- if , and , then and the error goes to zero
- if the estimates are wrong, the mismatch acts as a disturbance and causes servo errors
Example
For the single link robot , the actual mass is kg, but it is estimated as kg. The controller uses:
The closed loop equation is:
The error equation is:
The error in the mass estimate, kg, drives a servo error.