First version testable with real motors... (but not yet tested).