Always add first point development#79

Open

k-okada wants to merge 2 commits intoRethinkRobotics:developmentfrom

k-okada:always_add_first_point_development

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