Initial steps to attitude reporting

Added initial code to report attitude reporting
Commented the code and removed some old comments
Some Mavlink messages added but inactive.