finally fixed bearing drift (?)