Rewritten motorcontrol module with cleaner interface

"if you want something internal, put it in a .c file, if has to be
used externally, document it well, use clean interface in .h, and be
DRY !!!"