Fixed bug that was testing the wrong speed
Newer version of the docu
Made i2cdevice for motors const char*
Updated docu of the KalmanFilter class
Refactoring: Changed build system to CMAKE. Rearranged cluttered
directory structure