Heading drive for motors

Emma van Velthoovenrequested to merge
c/motors into c/main

Include low level motor access functions *_motor and high level motor access functions drive_*.

Merge request reports