separated Default_Handler code from etmc0.c plus tweaks