Update FSM.cpp

FiniteStateMachine (Sensor, Motor &amp; Latch) Object Oriented Programming for Minesense - Junior Developer Platform position code