Tried using switch

Dependencies:   FastPWM MODSERIAL QEI mbed