Declare some functions.
Add placeholder definitions for KVH functions.
Copy over Soo-Hyun's AHRS code.
Copy over Soo-Hyun's math code.