Firmware: Move PWM stuff around a bit