Drift compensation command implemented, need to be tested in the morning.