reach_x/y/theta use dist_rot