#include <JointTrajectoryController.hpp>
Public Member Functions | |
void | cancelCurrentTrajectory () |
void | getConfigurationParameter (double &PParameter, double &IParameter, double &DParameter, double &IClippingMax, double &IClippingMin) |
void | getLastTargetPosition (JointAngleSetpoint &position) |
void | getLastTargetVelocity (JointVelocitySetpoint &velocity) |
bool | isTrajectoryControllerActive () |
JointTrajectoryController () | |
void | setConfigurationParameter (const double PParameter, const double IParameter, const double DParameter, const double IClippingMax, const double IClippingMin) |
void | setEncoderTicksPerRound (const int &encoderTicks) |
void | setGearRatio (const double &ratio) |
void | setInverseMovementDirection (const bool invDirection) |
void | setTrajectory (const JointTrajectory &input_traj) |
bool | updateTrajectoryController (const SlaveMessageInput &actual, SlaveMessageOutput &velocity) |
virtual | ~JointTrajectoryController () |
Private Types | |
typedef std::vector< Segment > | SpecifiedTrajectory |
Private Member Functions | |
void | generatePowers (const int n, const double x, double *powers) |
void | getCubicSplineCoefficients (const double start_pos, const double start_vel, const double end_pos, const double end_vel, const double time, std::vector< double > &coefficients) |
void | getQuinticSplineCoefficients (const double start_pos, const double start_vel, const double start_acc, const double end_pos, const double end_vel, const double end_acc, const double time, std::vector< double > &coefficients) |
JointTrajectoryController (const JointTrajectoryController &source) | |
JointTrajectoryController & | operator= (const JointTrajectoryController &source) |
void | sampleQuinticSpline (const std::vector< double > &coefficients, const double time, double &position, double &velocity, double &acceleration) |
void | sampleSplineWithTimeBounds (const std::vector< double > &coefficients, const double duration, const double time, double &position, double &velocity, double &acceleration) |
Private Attributes | |
double | actualpose |
double | actualvel |
DataObjectLockFree < boost::shared_ptr< const SpecifiedTrajectory > > | current_trajectory_box_ |
double | duration |
int | encoderTicksPerRound |
double | gearRatio |
bool | inverseDirection |
bool | isControllerActive |
boost::posix_time::ptime | last_time |
PidController | pid |
double | pose_error |
double | targetAcceleration |
double | targetPosition |
double | targetVelocity |
boost::posix_time::ptime | time |
double | time_till_seg_start |
double | velocity_error |
double | velsetpoint |
Joint Trajectory Controller
Definition at line 95 of file JointTrajectoryController.hpp.
typedef std::vector<Segment> youbot::JointTrajectoryController::SpecifiedTrajectory [private] |
Definition at line 168 of file JointTrajectoryController.hpp.
Definition at line 55 of file JointTrajectoryController.cpp.
Definition at line 82 of file JointTrajectoryController.cpp.
youbot::JointTrajectoryController::JointTrajectoryController | ( | const JointTrajectoryController & | source | ) | [private] |
Definition at line 255 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::generatePowers | ( | const int | n, |
const double | x, | ||
double * | powers | ||
) | [private] |
Definition at line 445 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::getConfigurationParameter | ( | double & | PParameter, |
double & | IParameter, | ||
double & | DParameter, | ||
double & | IClippingMax, | ||
double & | IClippingMin | ||
) |
Definition at line 87 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::getCubicSplineCoefficients | ( | const double | start_pos, |
const double | start_vel, | ||
const double | end_pos, | ||
const double | end_vel, | ||
const double | time, | ||
std::vector< double > & | coefficients | ||
) | [private] |
Definition at line 418 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::getLastTargetPosition | ( | JointAngleSetpoint & | position | ) |
Definition at line 352 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::getLastTargetVelocity | ( | JointVelocitySetpoint & | velocity | ) |
Definition at line 359 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::getQuinticSplineCoefficients | ( | const double | start_pos, |
const double | start_vel, | ||
const double | start_acc, | ||
const double | end_pos, | ||
const double | end_vel, | ||
const double | end_acc, | ||
const double | time, | ||
std::vector< double > & | coefficients | ||
) | [private] |
Definition at line 364 of file JointTrajectoryController.cpp.
Definition at line 267 of file JointTrajectoryController.cpp.
JointTrajectoryController& youbot::JointTrajectoryController::operator= | ( | const JointTrajectoryController & | source | ) | [private] |
void youbot::JointTrajectoryController::sampleQuinticSpline | ( | const std::vector< double > & | coefficients, |
const double | time, | ||
double & | position, | ||
double & | velocity, | ||
double & | acceleration | ||
) | [private] |
Definition at line 399 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::sampleSplineWithTimeBounds | ( | const std::vector< double > & | coefficients, |
const double | duration, | ||
const double | time, | ||
double & | position, | ||
double & | velocity, | ||
double & | acceleration | ||
) | [private] |
Definition at line 456 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::setConfigurationParameter | ( | const double | PParameter, |
const double | IParameter, | ||
const double | DParameter, | ||
const double | IClippingMax, | ||
const double | IClippingMin | ||
) |
Definition at line 97 of file JointTrajectoryController.cpp.
void youbot::JointTrajectoryController::setEncoderTicksPerRound | ( | const int & | encoderTicks | ) | [inline] |
Definition at line 132 of file JointTrajectoryController.hpp.
void youbot::JointTrajectoryController::setGearRatio | ( | const double & | ratio | ) | [inline] |
Definition at line 126 of file JointTrajectoryController.hpp.
void youbot::JointTrajectoryController::setInverseMovementDirection | ( | const bool | invDirection | ) | [inline] |
Definition at line 138 of file JointTrajectoryController.hpp.
void youbot::JointTrajectoryController::setTrajectory | ( | const JointTrajectory & | input_traj | ) |
Definition at line 108 of file JointTrajectoryController.cpp.
bool youbot::JointTrajectoryController::updateTrajectoryController | ( | const SlaveMessageInput & | actual, |
SlaveMessageOutput & | velocity | ||
) |
Definition at line 272 of file JointTrajectoryController.cpp.
double youbot::JointTrajectoryController::actualpose [private] |
Definition at line 192 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::actualvel [private] |
Definition at line 193 of file JointTrajectoryController.hpp.
DataObjectLockFree<boost::shared_ptr<const SpecifiedTrajectory> > youbot::JointTrajectoryController::current_trajectory_box_ [private] |
Definition at line 170 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::duration [private] |
Definition at line 191 of file JointTrajectoryController.hpp.
int youbot::JointTrajectoryController::encoderTicksPerRound [private] |
Definition at line 178 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::gearRatio [private] |
Definition at line 180 of file JointTrajectoryController.hpp.
bool youbot::JointTrajectoryController::inverseDirection [private] |
Definition at line 182 of file JointTrajectoryController.hpp.
bool youbot::JointTrajectoryController::isControllerActive [private] |
Definition at line 160 of file JointTrajectoryController.hpp.
boost::posix_time::ptime youbot::JointTrajectoryController::last_time [private] |
Definition at line 166 of file JointTrajectoryController.hpp.
Definition at line 162 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::pose_error [private] |
Definition at line 184 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::targetAcceleration [private] |
Definition at line 176 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::targetPosition [private] |
Definition at line 172 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::targetVelocity [private] |
Definition at line 174 of file JointTrajectoryController.hpp.
boost::posix_time::ptime youbot::JointTrajectoryController::time [private] |
Definition at line 164 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::time_till_seg_start [private] |
Definition at line 190 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::velocity_error [private] |
Definition at line 186 of file JointTrajectoryController.hpp.
double youbot::JointTrajectoryController::velsetpoint [private] |
Definition at line 188 of file JointTrajectoryController.hpp.