GCOP
1.0
|
#include <body3davoidcontroller.h>
Public Types | |
typedef Matrix< double, nu, 1 > | Vectorcd |
typedef Matrix< double, 5, 1 > | Vector5d |
Public Member Functions | |
Body3dAvoidController (const Body3d< nu > &sys, Body3dState *xd=0, Vector6d *ad=0, Body3dConstraint *con=0) | |
virtual bool | Set (Vectorcd &u, double t, const Body3dState &x) |
virtual bool | SetParams (const Vector5d &s) |
virtual bool | SetContext (const Body3dState &c) |
Public Attributes | |
Body3dController< nu > | stabCtrl |
GavoidController * | avoidCtrl |
Controller combining rigid body stablization and gyroscopic avoidance This basically combines two existing controller from DGC. The controller has 5 parameters s containing: rot_Kp, rot_Kd, trans_Kp, trans_Kd, obst_K
Author: Marin Kobilarov, 2015
typedef Matrix<double, 5, 1> gcop::Body3dAvoidController< nu >::Vector5d |
typedef Matrix<double, nu, 1> gcop::Body3dAvoidController< nu >::Vectorcd |
gcop::Body3dAvoidController< nu >::Body3dAvoidController | ( | const Body3d< nu > & | sys, |
Body3dState * | xd = 0 , |
||
Vector6d * | ad = 0 , |
||
Body3dConstraint * | con = 0 |
||
) |
BODY3D PD controller
sys | system |
xd | desired state (optional, set to origin by default) |
ad | desired acceleration (optional, set to zero by default) |
con | obstacle constraint (optional) |
References gcop::Body3dAvoidController< nu >::avoidCtrl.
virtual bool gcop::Body3dAvoidController< nu >::Set | ( | Vectorcd & | u, |
double | t, | ||
const Body3dState & | x | ||
) | [virtual] |
Feedback controller of the form u = k(t, x)
u | controls |
t | time |
x | state |
Implements gcop::Controller< Body3dState, Matrix< double, nu, 1 >, Matrix< double, 5, 1 >, Body3dState >.
bool gcop::Body3dAvoidController< nu >::SetContext | ( | const Body3dState & | c | ) | [virtual] |
Set context
Reimplemented from gcop::Controller< Body3dState, Matrix< double, nu, 1 >, Matrix< double, 5, 1 >, Body3dState >.
bool gcop::Body3dAvoidController< nu >::SetParams | ( | const Vector5d & | s | ) | [virtual] |
Set controller parameters
Reimplemented from gcop::Controller< Body3dState, Matrix< double, nu, 1 >, Matrix< double, 5, 1 >, Body3dState >.
GavoidController* gcop::Body3dAvoidController< nu >::avoidCtrl |
Referenced by gcop::Body3dAvoidController< nu >::Body3dAvoidController().
Body3dController<nu> gcop::Body3dAvoidController< nu >::stabCtrl |