Moveit stuff works. In sort of a crazy way. Need to incorporate objects.