Wrong order of code fixed
Wrong order of code fixed

The source file had dead code because code was behind return and therefore unreachable. Order was changed to have correct behaviour
andcor02/mbed-os,mbedmicro/mbed,mbedmicro/mbed,kjbracey-arm/mbed,kjbracey-arm/mbed,andcor02/mbed-os,andcor02/mbed-os,kjbracey-arm/mbed,mbedmicro/mbed,andcor02/mbed-os,kjbracey-arm/mbed,andcor02/mbed-os,andcor02/mbed-os,mbedmicro/mbed,mbedmicro/mbed