#include <controller.h>
The driving torques can be expressed as
where
,
are diagonal positive definie matrix.
Definition at line 252 of file controller.h.
Public Member Functions | |
| Proportional_Derivative (const short dof=1) | |
| Constructor. | |
| Proportional_Derivative (const Robot_basic &robot, const DiagonalMatrix &Kp, const DiagonalMatrix &Kd) | |
| Constructor. | |
| ReturnMatrix | torque_cmd (Robot_basic &robot, const ColumnVector &qd, const ColumnVector &qpd) |
| Output torque. | |
| short | set_Kd (const DiagonalMatrix &Kd) |
Assign the velocity error gain matrix . | |
| short | set_Kp (const DiagonalMatrix &Kp) |
Assign the position error gain matrix . | |
Private Attributes | |
| int | dof |
| Degree of freedom. | |
| ColumnVector | q |
| Robot joints positions. | |
| ColumnVector | qp |
| Robot joints velocity. | |
| ColumnVector | qpp |
| Robot joints acceleration. | |
| ColumnVector | tau |
| Output torque. | |
| ColumnVector | zero3 |
zero vector. | |
| DiagonalMatrix | Kp |
| Position error gain. | |
| DiagonalMatrix | Kd |
| Velocity error gain. | |
| short Proportional_Derivative::set_Kd | ( | const DiagonalMatrix & | Kd_ | ) |
Assign the velocity error gain matrix
.
. Definition at line 657 of file controller.cpp.
References dof, Kd, and WRONG_SIZE.
Referenced by Proportional_Derivative().
| short Proportional_Derivative::set_Kp | ( | const DiagonalMatrix & | Kp_ | ) |
Assign the position error gain matrix
.
. Definition at line 674 of file controller.cpp.
References dof, Kp, and WRONG_SIZE.
Referenced by Proportional_Derivative().
1.5.1