Fixed kernel_menu bootstrap

Fixed robot project printf bug.
Fixed robot P2 ISR. Now it will disable interruptions before executing
task callback.
Fixed diag_sensor timer registration.