Feature request

Is your feature request related to a problem? Please describe.
When we raise an internal error it may be quite some time before we get something in the dataflash log or in the mavlink stream. This makes it harder to correlate internal errors with codepaths.

Describe the solution you'd like
Emit a statustext and/or log message when we detect an internal error has

There seems to be some issues with the landing function in ./software/px4_mavros_scripts/1_px4_mavros_offboard_controller/commander.py.

To do:

1. Test the land function and report if it works well.
2. Fix if there is an issue.