GCOP
1.0
|
#include <snake.h>
Public Member Functions | |
Snake () | |
void | Force (VectorXd &f, double t, const MbsState &x, const VectorXd &u, MatrixXd *A=0, MatrixXd *B=0) |
A quadrotor dynamical model.
The state is where is the pose, and the controls are correspond to torques around the body and a vertical lift force.
Author: Marin Kobilarov marin(at)jhu.edu
Snake::Snake | ( | ) |
References gcop::Mbs::Init(), gcop::Mbs::joints, gcop::Mbs::links, gcop::Mbs::pis, gcop::SE3::rpyxyz2g(), and gcop::Mbs::se3.
void Snake::Force | ( | VectorXd & | f, |
double | t, | ||
const MbsState & | x, | ||
const VectorXd & | u, | ||
MatrixXd * | A = 0 , |
||
MatrixXd * | B = 0 |
||
) | [virtual] |
Total resulting force on the system from external (e.g. gravity) and internal (control) inputs
f | total force f(x,u,t) |
t | time |
x | state |
u | controls |
A | jacobian Dxf |
B | jacobian Duf |
Reimplemented from gcop::Mbs.