Forgot to add comments

Code should be 100% readable now. Also rename initMotors() to InitializeBot(), since all sensors will be initialized there as well.