Feature/101 drive encoder subsystem

Watch out project.xml and .bak are changed make sure not to merge those 2 files