Throttle control added

Use W/S to increase and decrease throttle. T is takeoff/arm motors. P is
enable PID system, for stabilisation.