Perform PID calculations in main loop.
This shortens the heater PWM interrupts, and should make baud rate
115200 work reliably. More testing will be done however until 115200 is
set as the default baud rate.