Draft of controller part is finished. Described speed and attitude PID
and output signal (non-reduced + reduced)