Merge changes I7dda8dd1,I50ad8f53

* changes:
  Small fix of parsing head tracker sensors
  Remove drift compensator