extras: mavteleop: Implement attitude control mode.

Issue #133.