autotest: wait for a higher altitude on takeoff

otherwise left circuit can crash
Plane: removed old speed/altitude control algorithms

Use TECS only. This makes the code a lot simpler and easier to
properly document