worked on new archetecture
finished finalizing the previous archetecture
Driving is broken some times it does not turn correctly
fixed problem with driver rotation angle i think, more test needed