can now send setpoints to robot, does not update pid