Motors.h should set the data direction
Fix some warnings
Commit final version