Grasp message changes
Got pick and place pipeline mostly working