Add bearing estimation to hybrid motion model = rock solid :D