The mcu_phase_offset should be added not subtracted. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>