Change first point in trajectory to commanded position#1

wkentaro merged 3 commits into

wkentaro:jsk_apcwkentaro/baxter_interface:jsk_apcfrom

pazeshun:first-point-commandedpazeshun/baxter_interface:first-point-commandedCopy head branch name to clipboard