+#define consume_fifo(sh2, m68k_cycles) { \
+ int cycles_diff = ((m68k_cycles) * 3) - Pico32x.pwm_cycle_p; \
+ if (cycles_diff >= pwm_cycles) \
+ consume_fifo_do(sh2, m68k_cycles, cycles_diff); \
+}
+
+static void consume_fifo_do(SH2 *sh2, unsigned int m68k_cycles,
+ int sh2_cycles_diff)
+{
+ if (pwm_cycles == 0 || pwm_doing_fifo)
+ return;
+
+ elprintf(EL_PWM, "pwm: %u: consume %d/%d, %d,%d ptr %d",
+ m68k_cycles, sh2_cycles_diff, sh2_cycles_diff / pwm_cycles,
+ Pico32x.pwm_p[0], Pico32x.pwm_p[1], pwm_ptr);
+
+ // this is for recursion from dreq1 writes
+ pwm_doing_fifo = 1;
+
+ while (sh2_cycles_diff >= pwm_cycles) {
+ struct Pico32xMem *mem = Pico32xMem;
+ short *fifo_l = mem->pwm_fifo[0];
+ short *fifo_r = mem->pwm_fifo[1];
+
+ if (Pico32x.pwm_p[0] > 0) {
+ fifo_l[0] = fifo_l[1];
+ fifo_l[1] = fifo_l[2];
+ fifo_l[2] = fifo_l[3];
+ Pico32x.pwm_p[0]--;
+ }
+ if (Pico32x.pwm_p[1] > 0) {
+ fifo_r[0] = fifo_r[1];
+ fifo_r[1] = fifo_r[2];
+ fifo_r[2] = fifo_r[3];
+ Pico32x.pwm_p[1]--;
+ }
+
+ mem->pwm[pwm_ptr * 2 ] = fifo_l[0];
+ mem->pwm[pwm_ptr * 2 + 1] = fifo_r[0];
+ pwm_ptr = (pwm_ptr + 1) & (PWM_BUFF_LEN - 1);
+
+ sh2_cycles_diff -= pwm_cycles;
+
+ if (--Pico32x.pwm_irq_cnt == 0) {
+ Pico32x.pwm_irq_cnt = pwm_irq_reload;
+ do_pwm_irq(sh2, m68k_cycles);
+ }
+ }
+ Pico32x.pwm_cycle_p = m68k_cycles * 3 - sh2_cycles_diff;
+ pwm_doing_fifo = 0;
+}
+
+static int p32x_pwm_schedule_(SH2 *sh2, unsigned int m68k_now)
+{
+ unsigned int sh2_now = m68k_now * 3;
+ int cycles_diff_sh2;
+
+ if (pwm_cycles == 0)
+ return 0;
+
+ cycles_diff_sh2 = sh2_now - Pico32x.pwm_cycle_p;
+ if (cycles_diff_sh2 >= pwm_cycles)
+ consume_fifo_do(sh2, m68k_now, cycles_diff_sh2);
+
+ if (Pico32x.sh2irqs & P32XI_PWM)
+ return 0; // previous not acked
+ if (!((Pico32x.sh2irq_mask[0] | Pico32x.sh2irq_mask[1]) & 1))
+ return 0; // masked by everyone
+
+ cycles_diff_sh2 = sh2_now - Pico32x.pwm_cycle_p;
+ return (Pico32x.pwm_irq_cnt * pwm_cycles
+ - cycles_diff_sh2) / 3 + 1;
+}
+
+void p32x_pwm_schedule(unsigned int m68k_now)
+{
+ int after = p32x_pwm_schedule_(NULL, m68k_now);
+ if (after != 0)
+ p32x_event_schedule(m68k_now, P32X_EVENT_PWM, after);
+}
+
+void p32x_pwm_schedule_sh2(SH2 *sh2)
+{
+ int after = p32x_pwm_schedule_(sh2, sh2_cycles_done_m68k(sh2));
+ if (after != 0)
+ p32x_event_schedule_sh2(sh2, P32X_EVENT_PWM, after);
+}
+
+void p32x_pwm_irq_event(unsigned int m68k_now)
+{
+ p32x_pwm_schedule(m68k_now);
+}
+
+unsigned int p32x_pwm_read16(unsigned int a, SH2 *sh2,
+ unsigned int m68k_cycles)