Revised code

Added initial support for frame angles reporting and error reporting
from Mavlink. Some housecleaning….