Finished motorcontroller

motorcontroller works properly without failures. movement has been
improved and can be used with easy commands. examples how to use in
main.c.