Improvments

Something is wrong with the gyro!