It is devoted to the development of an autonomous flight control system for small size unmanned helicopter based on dynamical model. At first, the mathematical model of a small size helicopter is described. After that simple but effective MTCV control algorithm was proposed. The whole flight control algorithm is composed of two parts: orientation controller based on the model for rotation dynamics and a robust position controller for a double integrator. The MTCV block is also used to achieve translation velocity control. To demonstrate the performance of the presented algorithm, simulation results and results achieved in real flight experiments were presented. It is devoted to the development of an autonomous flight control system for small size unmanned helicopter based on dynamical model. After that simple but effective MTCV control algorithm was proposed. The whole flight control algorithm is composed of two parts: orientation controller based on the model for rotation dynamics and a robust position controller for a double integrator. The MTCV block is also used to achieve translation rate control. and results achieved in real flight experiments were presented.