Gear shift working, gear estimate take 1