Crashpilot1000 harakiri8c code changes from http://www.multiwii.com/forum/