Made adjustments, added motor control logic to the back.

Signed-off-by: Karl Oskar Lember <kolember@ut.ee>