Gyro controller added
Improve stability
README REVISED