Adding Doxygen comments

Began adding Doxygen comments and added a Doxyfile. Changed some
existing text but did not change filter or sensor fusion functionality.