1 files changed, 63 insertions, 0 deletions
diff --git a/common/fmplayer_work_opna.c b/common/fmplayer_work_opna.c
new file mode 100644
index 0000000..b3b0c69
--- /dev/null
+++ b/common/fmplayer_work_opna.c
@@ -0,0 +1,63 @@
+#include "fmplayer_common.h"
+#include "fmdriver/fmdriver.h"
+#include "fmdriver/ppz8.h"
+#include "libopna/opna.h"
+#include "libopna/opnatimer.h"
+#include <string.h>
+
+enum {
+  SRATE = 55467,
+  PPZ8MIX = 0xa000,
+};
+
+static void opna_writereg_libopna(struct fmdriver_work *work, unsigned addr, unsigned data) {
+  struct opna_timer *timer = (struct opna_timer *)work->opna;
+  opna_timer_writereg(timer, addr, data);
+}
+
+static unsigned opna_readreg_libopna(struct fmdriver_work *work, unsigned addr) {
+  struct opna_timer *timer = (struct opna_timer *)work->opna;
+  return opna_readreg(timer->opna, addr);
+}
+
+static uint8_t opna_status_libopna(struct fmdriver_work *work, bool a1) {
+  struct opna_timer *timer = (struct opna_timer *)work->opna;
+  uint8_t status = opna_timer_status(timer);
+  if (!a1) {
+    status &= 0x83;
+  }
+  return status;
+}
+
+static void opna_int_cb(void *userptr) {
+  struct fmdriver_work *work = (struct fmdriver_work *)userptr;
+  work->driver_opna_interrupt(work);
+}
+
+static void opna_mix_cb(void *userptr, int16_t *buf, unsigned samples) {
+  struct ppz8 *ppz8 = (struct ppz8 *)userptr;
+  ppz8_mix(ppz8, buf, samples);
+}
+
+void fmplayer_init_work_opna(
+  struct fmdriver_work *work,
+  struct ppz8 *ppz8,
+  struct opna *opna,
+  struct opna_timer *timer,
+  void *adpcm_ram
+) {
+  opna_reset(opna);
+  fmplayer_drum_rom_load(&opna->drum);
+  opna_adpcm_set_ram_256k(&opna->adpcm, adpcm_ram);
+  opna_timer_reset(timer, opna);
+  ppz8_init(ppz8, SRATE, PPZ8MIX);
+  memset(work, 0, sizeof(*work));
+  work->opna_writereg = opna_writereg_libopna;
+  work->opna_readreg = opna_readreg_libopna;
+  work->opna_status = opna_status_libopna;
+  work->opna = timer;
+  work->ppz8 = ppz8;
+  work->ppz8_functbl = &ppz8_functbl;
+  opna_timer_set_int_callback(timer, opna_int_cb, work);
+  opna_timer_set_mix_callback(timer, opna_mix_cb, ppz8);
+}