Please test these and let me know if they work, these currently just move the robot around. Path Planner doesn't let me input and output stuff (lame).