public void SetSimulationState(SimulationCommand command)
{
switch (command)
{
case SimulationCommand.Stop:
StopSimulation();
break;
case SimulationCommand.Start:
StartSimulation();
break;
case SimulationCommand.Reset:
//StopSimulation();
VREPWrapper.simxStopSimulation(_clientId, simx_opmode.oneshot_wait);
Thread.Sleep(400);
//StartSimulation();
VREPWrapper.simxStartSimulation(_clientId, simx_opmode.oneshot_wait);
break;
}
}