improving grasp pose placement, fixing some bugs in move helper
cleaning up