Tested with two mbed lpc1768, and all options work well now, some new commits is to ensure nothing left from my side. And fixed a bug introduced by my former patch.