Reduce max gain of integrative controller of PID
Increase minumum power of motor
Add back gyro calibration