Added new include -- xq_ctrl.h, which includes control system constants. IMU messages are now passed back, parsed, and filtered into current state, but it's currently returning NaN after a few cycles -- I suspect the clock() call might be doing it, but that needs to be double-checked. Debugging to be done tomorrow, hopefully~