Added --C99 flag to project so it compiled
Workaround for MPU6050 reset issue

// Resetting the MPU6050 does not work for some reason.
// But it is already in default mode at power up, so there is no need to
reset it anyways
Stop motors when throttle is zero