Moved firmware to a separate header. Changed quaternion to float after determining the fixed point format to be Q1.30.