MoveIt setup for wpi_jaco package