public SimulationState(SimulationRobotState robotState)
 {
     this.robotState = robotState;
 }
 public SimulationState(SimulationRobotState robotState)
 {
     this.robotState = robotState;
 }