Change first point in trajectory to commanded position#77

Open

pazeshun wants to merge 4 commits intoRethinkRobotics:developmentfrom pazeshun:first-point-commanded

+43-2

Commits on Jul 23, 2016

always add current poisition as the first point in trajectory points
k-okada
committed

Commits on Sep 26, 2016

it already retuned when num_points == 0
k-okada
committed

Commits on Dec 6, 2016

Subscribe gravity_compensation_torques topic and get commanded joint angle
pazeshun
committed
Change first point in trajectory to commanded position
pazeshun
committed