Renamed simple_pick_place
fix issue with mode switching between velociy and postion