WIP: Inertia.
WIP: Inertial movement for heading.
Inertial movement complete; Add SGN function.