Since software and controls need to share a robot, it would be useful to combine their test mode code into the main code. That way there is no need to redeploy code when controls needs to use the robot.
Allocate data ports
Do last, and skip allocation if already allocated somewhere else
Since software and controls need to share a robot, it would be useful to combine their test mode code into the main code. That way there is no need to redeploy code when controls needs to use the robot.