35 #ifndef DART_PLANNING_PATHFOLLOWINGTRAJECTORY_HPP_
36 #define DART_PLANNING_PATHFOLLOWINGTRAJECTORY_HPP_
78 double& beforeAcceleration,
79 double& afterAcceleration);
83 double& beforeAcceleration,
84 double& afterAcceleration);
88 double& beforeAcceleration,
89 double& afterAcceleration);
94 std::list<TrajectoryStep>& startTrajectory,
97 double pathPosition,
double pathVelocity,
bool max);
99 double pathPosition,
double pathVelocity,
bool max);
112 inline double getSlope(std::list<TrajectoryStep>::const_iterator lineEnd);
Eigen::VectorXd acceleration
Definition: SkelParser.cpp:110
Definition: PathFollowingTrajectory.hpp:46
Path path
Definition: PathFollowingTrajectory.hpp:117
void integrateBackward(std::list< TrajectoryStep > &trajectory, std::list< TrajectoryStep > &startTrajectory, double acceleration)
Definition: PathFollowingTrajectory.cpp:455
Eigen::VectorXd maxVelocity
Definition: PathFollowingTrajectory.hpp:118
unsigned int n
Definition: PathFollowingTrajectory.hpp:120
double getSlope(const TrajectoryStep &point1, const TrajectoryStep &point2)
Definition: PathFollowingTrajectory.cpp:588
Eigen::VectorXd getVelocity(double time) const
Definition: PathFollowingTrajectory.cpp:803
bool valid
Definition: PathFollowingTrajectory.hpp:121
bool getNextSwitchingPoint(double pathPos, TrajectoryStep &nextSwitchingPoint, double &beforeAcceleration, double &afterAcceleration)
Definition: PathFollowingTrajectory.cpp:137
~PathFollowingTrajectory(void)
Definition: PathFollowingTrajectory.cpp:132
double getVelocityMaxPathVelocity(double pathPos)
Definition: PathFollowingTrajectory.cpp:709
double getMinMaxPhaseSlope(double pathPosition, double pathVelocity, bool max)
Definition: PathFollowingTrajectory.cpp:666
std::list< TrajectoryStep > trajectory
Definition: PathFollowingTrajectory.hpp:122
bool isValid() const
Definition: PathFollowingTrajectory.cpp:748
double getMaxAccelerationError()
Definition: PathFollowingTrajectory.cpp:825
std::list< TrajectoryStep >::const_iterator cachedTrajectorySegment
Definition: PathFollowingTrajectory.hpp:128
Eigen::VectorXd getPosition(double time) const
Definition: PathFollowingTrajectory.cpp:782
double cachedTime
Definition: PathFollowingTrajectory.hpp:127
double getSlope(std::list< TrajectoryStep >::const_iterator lineEnd)
PathFollowingTrajectory(const Path &path, const Eigen::VectorXd &maxVelocity, const Eigen::VectorXd &maxAcceleration)
Definition: PathFollowingTrajectory.cpp:54
bool integrateForward(std::list< TrajectoryStep > &trajectory, double acceleration)
Definition: PathFollowingTrajectory.cpp:323
double getAccelerationMaxPathVelocity(double pathPos)
Definition: PathFollowingTrajectory.cpp:672
double getMinMaxPathAcceleration(double pathPosition, double pathVelocity, bool max)
Definition: PathFollowingTrajectory.cpp:646
Eigen::VectorXd maxAcceleration
Definition: PathFollowingTrajectory.hpp:119
bool getNextAccelerationSwitchingPoint(double pathPos, TrajectoryStep &nextSwitchingPoint, double &beforeAcceleration, double &afterAcceleration)
Definition: PathFollowingTrajectory.cpp:204
double getVelocityMaxPathVelocityDeriv(double pathPos)
Definition: PathFollowingTrajectory.cpp:729
TrajectoryStep getIntersection(const std::list< TrajectoryStep > &trajectory, std::list< TrajectoryStep >::iterator &it, const TrajectoryStep &linePoint1, const TrajectoryStep &linePoint2)
Definition: PathFollowingTrajectory.cpp:603
bool getNextVelocitySwitchingPoint(double pathPos, TrajectoryStep &nextSwitchingPoint, double &beforeAcceleration, double &afterAcceleration)
Definition: PathFollowingTrajectory.cpp:267
std::list< TrajectoryStep >::const_iterator getTrajectorySegment(double time) const
Definition: PathFollowingTrajectory.cpp:759
static const double eps
Definition: PathFollowingTrajectory.hpp:124
static const double timeStep
Definition: PathFollowingTrajectory.hpp:125
double getDuration() const
Definition: PathFollowingTrajectory.cpp:753
double getAccelerationMaxPathVelocityDeriv(double pathPos)
Definition: PathFollowingTrajectory.cpp:721
Definition: Trajectory.hpp:44
std::multimap< dart::dynamics::Shape *, SimpleFrameShapeDnD * >::iterator iterator
Definition: Viewer.cpp:620
Definition: BulletCollisionDetector.cpp:65
Definition: PathFollowingTrajectory.hpp:62
double pathPos
Definition: PathFollowingTrajectory.hpp:70
TrajectoryStep(double pathPos, double pathVel)
Definition: PathFollowingTrajectory.hpp:66
TrajectoryStep()
Definition: PathFollowingTrajectory.hpp:63
double time
Definition: PathFollowingTrajectory.hpp:72
double pathVel
Definition: PathFollowingTrajectory.hpp:71