1 #ifndef ROBOT_INTERPOLATE_H 2 #define ROBOT_INTERPOLATE_H 14 void Interpolate(RobotModel& robot,
const Config& x,
const Config& y,Real u,Config& out);
29 void Integrate(RobotModel& robot,
const Config& q,
const Vector& dq,Config& b);
38 Real
Distance(
const RobotModel& robot,
const Config& a,
const Config& b,Real norm,Real floatingRotationWeight=1.0);
47 Real
Distance(
const RobotModel& robot,
const Config& a,
const Config& b,Real norm,
const vector<Real>& weights,Real floatingRotationWeight=1.0);
void Integrate(RobotModel &robot, const Config &q, const Vector &dq, Config &b)
Integrates a velocity vector dq from q to obtain the configuration b.
void InterpolateDerivative(RobotModel &robot, const Config &a, const Config &b, Real u, Vector &dq)
Returns the velocity vector that will move the robot from the configuration that is u fraction of the...
Real Distance(const RobotModel &robot, const Config &a, const Config &b, Real norm, const vector< Real > &weights, Real floatingRotationWeight=1.0)
Returns the geodesic distance between a and b. Combines individual joint distances together via the w...
Definition: ContactDistance.h:6
void Interpolate(RobotModel &robot, const Config &x, const Config &y, Real u, Config &out)
Interpolates between the two configurations in geodesic fashion on the robot's underlying configurati...