Proportional derivative controller class. More...
#include <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. | |
short | set_Kd (const DiagonalMatrix &Kd) |
Assign the velocity error gain matrix . | |
short | set_Kp (const DiagonalMatrix &Kp) |
Assign the position error gain matrix . | |
ReturnMatrix | torque_cmd (Robot_basic &robot, const ColumnVector &qd, const ColumnVector &qpd) |
Output torque. | |
Private Attributes | |
int | dof |
Degree of freedom. | |
DiagonalMatrix | Kd |
Velocity error gain. | |
DiagonalMatrix | Kp |
Position error gain. | |
ColumnVector | q |
Robot joints positions. | |
ColumnVector | qp |
Robot joints velocity. | |
ColumnVector | qpp |
Robot joints acceleration. | |
ColumnVector | tau |
Output torque. | |
ColumnVector | zero3 |
zero vector. |
Proportional derivative controller class.
The driving torques can be expressed as
where , are diagonal positive definie matrix.
Definition at line 252 of file controller.h.
Proportional_Derivative::Proportional_Derivative | ( | const short | dof = 1 | ) |
Constructor.
Definition at line 609 of file controller.cpp.
Proportional_Derivative::Proportional_Derivative | ( | const Robot_basic & | robot, |
const DiagonalMatrix & | Kp, | ||
const DiagonalMatrix & | Kd | ||
) |
Constructor.
Definition at line 618 of file controller.cpp.
short Proportional_Derivative::set_Kd | ( | const DiagonalMatrix & | Kd_ | ) |
Assign the velocity error gain matrix .
Definition at line 657 of file controller.cpp.
short Proportional_Derivative::set_Kp | ( | const DiagonalMatrix & | Kp_ | ) |
Assign the position error gain matrix .
Definition at line 674 of file controller.cpp.
ReturnMatrix Proportional_Derivative::torque_cmd | ( | Robot_basic & | robot, |
const ColumnVector & | qd, | ||
const ColumnVector & | qpd | ||
) |
Output torque.
Definition at line 632 of file controller.cpp.
int Proportional_Derivative::dof [private] |
Degree of freedom.
Definition at line 263 of file controller.h.
DiagonalMatrix Proportional_Derivative::Kd [private] |
Velocity error gain.
Definition at line 269 of file controller.h.
DiagonalMatrix Proportional_Derivative::Kp [private] |
Position error gain.
Definition at line 269 of file controller.h.
ColumnVector Proportional_Derivative::q [private] |
Robot joints positions.
Definition at line 264 of file controller.h.
ColumnVector Proportional_Derivative::qp [private] |
Robot joints velocity.
Definition at line 264 of file controller.h.
ColumnVector Proportional_Derivative::qpp [private] |
Robot joints acceleration.
Definition at line 264 of file controller.h.
ColumnVector Proportional_Derivative::tau [private] |
Output torque.
Definition at line 264 of file controller.h.
ColumnVector Proportional_Derivative::zero3 [private] |
zero vector.
Definition at line 264 of file controller.h.