Copter: added support for mavlink state correction (experimental)