Comment Blocks (see main for template)

Also did some formatting, but mostly added comments, all to MotorCtrl
and MotorPID files