Changeset 9dd79bc7 in mainline for uspace/drv/audio/sb16/sb16.c

Timestamp:

2011-09-24T16:32:12Z (14 years ago)

Author:

Jan Vesely <jano.vesely@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

61013bd

Parents:

b956810

Message:

sb16: Add hw DSP initialization.

File:

• uspace/drv/audio/sb16/sb16.c (modified) (2 diffs)

uspace/drv/audio/sb16/sb16.c

@@ -28 +28 @@
 
 #include <errno.h>
+#include <libarch/ddi.h>
 
+#include "ddf_log.h"
+#include "dsp_commands.h"
 #include "sb16.h"
+
+
+static inline void sb16_dsp_command(sb16_drv_t *drv, dsp_command_t command)
+{
+        assert(drv);
+        uint8_t status;
+        do {
+                status = pio_read_8(&drv->regs->dsp_write);
+        } while ((status & DSP_WRITE_READY) == 0);
+
+        pio_write_8(&drv->regs->dsp_write, command);
+}
+
+static inline uint8_t sb16_dsp_read(sb16_drv_t *drv)
+{
+        assert(drv);
+        uint8_t status;
+        do {
+                status = pio_read_8(&drv->regs->dsp_read_status);
+        } while ((status & DSP_READ_READY) == 0);
+        return pio_read_8(&drv->regs->dsp_data_read);
+}
+
 
 /* ISA interrupts should be edge-triggered so there should be no need for
@@ -45 +71 @@
 int sb16_init_sb16(sb16_drv_t *drv, void *regs, size_t size)
 {
-        // TODO Setup registers
-        // TODO Initialize dsp: get version number
-        // TODO Initialize dsp: reset DSP
+        assert(drv);
+        /* Setup registers */
+        int ret = pio_enable(regs, size, (void**)&drv->regs);
+        if (ret != EOK)
+                return ret;
+        ddf_log_debug("PIO registers at %p accessible.\n", drv->regs);
+
+        /* Reset DSP, see Chapter 2 of Sound Blaster HW programming guide */
+        pio_write_16(&drv->regs->dsp_reset, 1);
+        udelay(3);
+        pio_write_16(&drv->regs->dsp_reset, 0);
+        udelay(100);
+
+        unsigned attempts = 100;
+        uint8_t status;
+        do {
+                status = pio_read_8(&drv->regs->dsp_read_status);
+                udelay(10);
+        } while (--attempts && ((status & DSP_READ_READY) == 0));
+
+        if (status & DSP_READ_READY) {
+                const uint8_t response = sb16_dsp_read(drv);
+                if (response != 0xaa) {
+                        ddf_log_error("Invalid DSP reset response: %x.\n",
+                            response);
+                        return EIO;
+                }
+        } else {
+                ddf_log_error("Failed to reset Sound Blaster DSP.\n");
+                return EIO;
+        }
+        ddf_log_note("Sound blaster reset!\n");
+
+
+        /* Get DSP version number */
+        sb16_dsp_command(drv, DSP_VERSION);
+        const uint8_t major = sb16_dsp_read(drv);
+        const uint8_t minor = sb16_dsp_read(drv);
+        ddf_log_note("Sound blaster DSP version: %x.%x.\n", major, minor);
+
+
         // TODO Initialize mixer
         return EOK;