Testing moveit stuff with cpp. Also try taking off the grippers.