Started implementation of the full attitude controller. Requires the definition of yet another interpolation function, and the complete definition of the damping matrix.