Fix a bug where conveyor 2 do not stop the motor
The motor was not stopped if the token get sorted out on the second
conveyor.
Add height values for FESTO 6