Made turning relative to the current heading.
Fixed a bug in odometry (baseline was 4 times L, not 2)
Rotation implemented. It's working ok.