add Setpoint and Speed values to Robot.java