Firmware: Clean comments up, remove debugging printlns