added I2C on driveTrain; not sure if it works correctly.
Fixed issue of init in Command Base and delted unused files
Fixing AutoDist branch issue
Functional TrapezoidFilter