48 size_t append(uint8_t *buffer, T &val)
51 std::memcpy(buffer, &val, s);
55 bool execute(std::array<double, 6> &positions,
bool keep_alive);
56 double interpolate(
double t,
double T,
double p0_pos,
double p1_pos,
double p0_vel,
double p1_vel);
62 bool execute(std::array<double, 6> &positions);
63 bool execute(std::vector<TrajectoryPoint> &trajectory, std::atomic<bool> &interrupt);
bool execute(std::array< double, 6 > &positions, bool keep_alive)
double servoj_lookahead_time_
double interpolate(double t, double T, double p0_pos, double p1_pos, double p0_vel, double p1_vel)
size_t append(uint8_t *buffer, T &val)
std::atomic< bool > running_
std::array< double, 6 > last_positions_
TrajectoryFollower(URCommander &commander, std::string &reverse_ip, int reverse_port, bool version_3)
virtual ~TrajectoryFollower()