add checks and prints for MCUSR handling
Merge branch 'vitto_merge' of https://github.com/aleksay/quadr_ino_copter into vitto_merge