fixed some robot control, should be ready to test once ports in cRIOPorts.java are updated