Engineering:Computed torque control

Short description: Robot control

Computed torque control is a control scheme used in motion control in robotics. It combines feedback linearization via a PID controller of the error with a dynamical model of the controlled robot.

Let the dynamics of the controlled robot be described by

$\mathbf{𝐌}\left(\overrightarrow{\theta }\right)\ddot{\overrightarrow{\theta }}+\mathbf{𝐂}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})\dot{\overrightarrow{\theta }}+{\overrightarrow{\tau }}_g\left(\overrightarrow{\theta }\right)=\overrightarrow{\tau }$ where $\overrightarrow{\theta }\in {\mathbb{ℝ}}^N$ is the state vector of joint variables that describe the system, $\mathbf{𝐌}\left(\overrightarrow{\theta }\right)$ is the inertia matrix, $\mathbf{𝐂}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})\dot{\overrightarrow{\theta }}$ is the vector Coriolis and centrifugal torques, ${\overrightarrow{\tau }}_g\left(\overrightarrow{\theta }\right)$ are the torques caused by gravity and $\overrightarrow{\tau }$ is the vector of joint torque inputs.

Assume that we have an approximate model of the system made up of $\widetilde{\mathbf{𝐌}}\left(\overrightarrow{\theta }\right),\widetilde{\mathbf{𝐂}}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }}),{\tilde{\overrightarrow{\tau }}}_g\left(\overrightarrow{\theta }\right)$. This model does not need to be perfect, but it should justify the approximations $\mathbf{𝐌}{\left(\overrightarrow{\theta }\right)}^{-1}\widetilde{\mathbf{𝐌}}\left(\overrightarrow{\theta }\right)\approx \mathbf{𝟏}$ and ${\mathbf{𝐌}}^{-1}(\mathbf{𝐂}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})\dot{\overrightarrow{\theta }}+{\overrightarrow{\tau }}_g\left(\overrightarrow{\theta }\right))\approx {\mathbf{𝐌}}^{-1}(\widetilde{\mathbf{𝐂}}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})\dot{\overrightarrow{\theta }}+{\tilde{\overrightarrow{\tau }}}_g\left(\overrightarrow{\theta }\right))$.

Given a desired trajectory ${\overrightarrow{\theta }}_d(t)$ the error relative to the current state $\overrightarrow{\theta }(t)$ is then ${\overrightarrow{\theta }}_e(t)={\overrightarrow{\theta }}_d(t)-\overrightarrow{\theta }(t)$.

We can then set the input of the system to be

$\overrightarrow{\tau }(t)=\widetilde{\mathbf{𝐌}}\left(\overrightarrow{\theta }\right)({\ddot{\overrightarrow{\theta }}}_d(t)+K_p{\overrightarrow{\theta }}_e(t)+K_i\underset{0}{\overset{t}{\int }}{\ddot{\overrightarrow{\theta }}}_e(t^{\prime })d{t}^{\prime }+K_d{\dot{\overrightarrow{\theta }}}_e(t))+\widetilde{\mathbf{𝐂}}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})+{\tilde{\overrightarrow{\tau }}}_g\left(\overrightarrow{\theta }\right)$

With this input the dynamics of the entire systems becomes

$\begin{array}{rl}\mathbf{𝐌}\left(\overrightarrow{\theta }\right)\ddot{\overrightarrow{\theta }}+\mathbf{𝐂}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})\dot{\overrightarrow{\theta }}+{\overrightarrow{\tau }}_g\left(\overrightarrow{\theta }\right)=& \widetilde{\mathbf{𝐌}}\left(\overrightarrow{\theta }\right)({\ddot{\overrightarrow{\theta }}}_d(t)+K_p{\overrightarrow{\theta }}_e(t)+K_i\underset{0}{\overset{t}{\int }}{\ddot{\overrightarrow{\theta }}}_e(t^{\prime })d{t}^{\prime }+K_d{\dot{\overrightarrow{\theta }}}_e(t))+\widetilde{\mathbf{𝐂}}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})+{\tilde{\overrightarrow{\tau }}}_g\left(\overrightarrow{\theta }\right)\\ \ddot{\overrightarrow{\theta }}+\mathbf{𝐌}{\left(\overrightarrow{\theta }\right)}^{-1}(\mathbf{𝐂}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})\dot{\overrightarrow{\theta }}+{\overrightarrow{\tau }}_g\left(\overrightarrow{\theta }\right))=& \underset{\approx \mathbf{𝟏}}{\underbrace{\mathbf{𝐌}{\left(\overrightarrow{\theta }\right)}^{-1}\widetilde{\mathbf{𝐌}}\left(\overrightarrow{\theta }\right)}}({\ddot{\overrightarrow{\theta }}}_d(t)+K_p{\overrightarrow{\theta }}_e(t)+K_i\underset{0}{\overset{t}{\int }}{\ddot{\overrightarrow{\theta }}}_e(t^{\prime })d{t}^{\prime }+K_d{\dot{\overrightarrow{\theta }}}_e(t))+\mathbf{𝐌}{\left(\overrightarrow{\theta }\right)}^{-1}(\widetilde{\mathbf{𝐂}}(\overrightarrow{\theta },\dot{\overrightarrow{\theta }})+{\tilde{\overrightarrow{\tau }}}_g\left(\overrightarrow{\theta }\right))\\ \ddot{\overrightarrow{\theta }}=& {\ddot{\overrightarrow{\theta }}}_d(t)+K_p{\overrightarrow{\theta }}_e(t)+K_i\underset{0}{\overset{t}{\int }}{\ddot{\overrightarrow{\theta }}}_e(t^{\prime })d{t}^{\prime }+K_d{\dot{\overrightarrow{\theta }}}_e(t)\\ 0=& {\ddot{\overrightarrow{\theta }}}_e+K_p{\overrightarrow{\theta }}_e(t)+K_i\underset{0}{\overset{t}{\int }}{\ddot{\overrightarrow{\theta }}}_e(t^{\prime })d{t}^{\prime }+K_d{\dot{\overrightarrow{\theta }}}_e(t)\end{array}$

and the normal methods for PID controller tuning can be applied. In this way the compilcated nonlinear control problem has been reduced to a relatively simple linear control problem.