Finished implementation of the full attitude controller. It is buggy, though, and does not work for the moment.