cleanup, fixes and comments
experiment with balancing motors speeds in order to make it walk straight