Removed deprecated debug code from attitude controller
Cleaned up comments and old debug code in spiri motion primitives server