extras: mavteleop: Dirty implementation of position control mode.

Issue #133.