Cleanup style

Add comments
Add motor disable to allStop for better stopping action.