Add vector and matrix operations.
Add new build targets and link math.h.
Minor change.
Remove spicb callback.
Port orientation kinematics code over from Soo-Hyun's tricopter code.
Make things run.