void Update()
{
float waitTime = _mode == 1 || _mode == 3 ? 0.5f : 3;
if (Time.time - _lastToggleTime > waitTime)
{
if (_mode == 0)
{
// Right side running
_right1.Stop();
_right2.Stop();
_mode++;
}
else if (_mode == 1)
{
// All Stopped
_left1.TurnCW();
_left2.TurnCW();
_mode++;
}
else if (_mode == 2)
{
// Left side running
_left1.Stop();
_left2.Stop();
_mode++;
}
else if (_mode == 3)
{
// All Stopped
_right1.TurnCCW();
_right2.TurnCCW();
_mode = 0;
}
_lastToggleTime = Time.time;
}
}
