If you are having that issue check here
AP_InertialNav: Always scale pos and vel to cm · 3drobotics/ardupilot-solo-rebase@a0c9e92 · GitHub
AP_InertialNav: Always scale pos and vel to cm · 3drobotics/ardupilot-solo-rebase@a0c9e92 · GitHub