Add Control algorithm. test stage.