grasps are fully working now.
Need two different prep positions for side grasps vs. top-down grasps.
added a command to output the position of the robot
don't bother initializing the hand.
Also reset the hand position when going home.