Changes turning and driving functions to accomodate a four-wheel robot

Improves the readability of the comments

Reorders most of the code to improve scanability