Clean Up Round 2
Removed Useless/Unused Comments
Merged Drive and Pivot code into one if block
Fixed Pivot direction if/else block
Removed Unused variables
Added mJoyRight and implemented