Rearrange somecode

Moved buzzer define up to the rest and moved printMenu() down to the bottom of setup()
Reset MPU-6050 in setup

Inspired by: https://github.com/Lauszus/multiwii-firmware/blob/master/Sensors.cpp