Computed torque control
≈ 3 min read
Names in other languages
No names in other languages are held for this entry yet.
Article bodies are English and are not machine-translated. A name in another language is not a translation of the article.
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{M}\left( \vec\theta \right) \ddot\vec\theta + \mathbf{C}\left( \vec\theta, \dot\vec\theta \right) \dot\vec\theta + \vec\tau_g \left(\vec\theta\right) = \vec\tau where \vec\theta \in \mathbb{R}^N is the state vector of joint variables that describe the system, \mathbf{M}\left(\vec\theta\right) is the inertia matrix, \mathbf{C}\left( \vec\theta, \dot\vec\theta \right) \dot\vec\theta is the vector Coriolis and centrifugal torques, \vec\tau_g \left(\vec\theta\right) are the torques caused by gravity and \vec\tau is the vector of joint torque inputs.
Assume that we have an approximate model of the system made up of \tilde\mathbf{M}\left( \vec\theta \right), \tilde\mathbf{C}\left( \vec\theta, \dot\vec\theta \right), \tilde\vec\tau_g \left(\vec\theta\right) .…
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{M}\left( \vec\theta \right) \ddot\vec\theta + \mathbf{C}\left( \vec\theta, \dot\vec\theta \right) \dot\vec\theta + \vec\tau_g \left(\vec\theta\right) \vec\tau(t) = \tilde\mathbf{M}\left( \vec\theta \right) \left( \ddot\vec\theta_d(t) + K_p \vec\theta_e(t) + K_i \int_0^t \ddot\vec\theta_e(t') dt' + K_d \dot\vec\theta_e(t) \right) + \tilde\mathbf{C}\left( \vec\theta, \dot\vec\theta \right) + \tilde\vec\tau_g \left(\vec\theta\right) With this input the dynamics of the entire systems becomes \begin{align} \mathbf{M}\left( \vec\theta \right) \ddot\vec\theta + \mathbf{C}\left( \vec\theta, \dot\vec\theta \right) \dot\vec\theta + \vec\tau_g \left(\vec\theta\right) =& \tilde\mathbf{M}\left( \vec\theta \right) \left( \ddot\vec\theta_d(t) + K_p \vec\theta_e(t) + K_i \int_0^t \ddot\vec\theta_e(t') dt' + K_d \dot\vec\theta_e(t) \right) + \tilde\mathbf{C}\left( \vec\theta, \dot\vec\theta \right) + \tilde\vec\tau_g \left(\vec\theta\right) \\ \ddot\vec\theta + \mathbf{M}\left( \vec\theta \right)^{-1} \left( \mathbf{C}\left( \vec\theta, \dot\vec\theta \right) \dot\vec\theta + \vec\tau_g \left(\vec\theta\right) \right) =& \underbrace{ \mathbf{M}\left( \vec\theta \right)^{-1} \tilde\mathbf{M}\left( \vec\theta \right) }_{\approx \mathbf{1}} \left( \ddot\vec\theta_d(t) + K_p \vec\theta_e(t) + K_i \int_0^t \ddot\vec\theta_e(t') dt' + K_d \dot\vec\theta_e(t) \right) + \mathbf{M}\left( \vec\theta \right)^{-1} \left( \tilde\mathbf{C}\left( \vec\theta, \dot\vec\theta \right) + \tilde\vec\tau_g \left(\vec\theta\right) \right) \\ \ddot\vec\theta
Text derived from https://en.wikipedia.org/w/index.php?oldid=1258770909 under CC BY-SA 4.0; modifications have been made.