Changeset d2d5329 in mainline for uspace/drv/audio/hdaudio/hdactl.c

Timestamp:

2014-08-14T14:21:28Z (10 years ago)

Author:

Jiri Svoboda <jiri@…>

Branches:

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

Children:

65b09c1

Parents:

8d070710

Message:

Discover function groups and widgets.

File:

• uspace/drv/audio/hdaudio/hdactl.c (modified) (6 diffs)

uspace/drv/audio/hdaudio/hdactl.c

@@ -42 +42 @@
 #include <stdint.h>
 
+#include "codec.h"
 #include "hdactl.h"
 #include "regif.h"
@@ -49 +50 @@
         ctrl_init_wait_max = 10,
         codec_enum_wait_us = 512,
-        corb_wait_max = 10
+        corb_wait_max = 10,
+        rirb_wait_max = 100
 };
 
@@ -231 +233 @@
 
         /* Set RINTCNT - Qemu won't read from CORB if this is zero */
-        hda_reg16_write(&hda->regs->rintcnt, 2);
+        hda_reg16_write(&hda->regs->rintcnt, 128);
 
         hda->ctl->rirb_rp = 0;
@@ -336 +338 @@
 }
 
-static void hda_rirb_read(hda_t *hda)
+static int hda_rirb_read(hda_t *hda, hda_rirb_entry_t *data, size_t count)
 {
         size_t wp;
         hda_rirb_entry_t resp;
         hda_rirb_entry_t *rirb;
+        int wcnt;
 
         rirb = (hda_rirb_entry_t *)hda->ctl->rirb_virt;
 
-        wp = hda_get_rirbwp(hda);
-        ddf_msg(LVL_NOTE, "hda_rirb_read: wp=%d", wp);
-        while (hda->ctl->rirb_rp != wp) {
-                ++hda->ctl->rirb_rp;
-                resp = rirb[hda->ctl->rirb_rp];
-
-                ddf_msg(LVL_NOTE, "RESPONSE resp=0x%x respex=0x%x",
-                    resp.resp, resp.respex);
-        }
-}
-
-#include "spec/codec.h"
+        while (count > 0) {
+                wp = hda_get_rirbwp(hda);
+                ddf_msg(LVL_NOTE, "hda_rirb_read: wp=%d", wp);
+                while (count > 0 && hda->ctl->rirb_rp != wp) {
+                        ++hda->ctl->rirb_rp;
+                        resp = rirb[hda->ctl->rirb_rp];
+
+                        ddf_msg(LVL_NOTE, "RESPONSE resp=0x%x respex=0x%x",
+                            resp.resp, resp.respex);
+                        if ((resp.respex & BIT_V(uint32_t, respex_unsol)) == 0) {
+                                /* Solicited response */
+                                *data++ = resp;
+                                --count;
+                        }
+                }
+
+                if (count > 0) {
+                        wcnt = rirb_wait_max;
+                        while (wcnt > 0 && hda_get_rirbwp(hda) == hda->ctl->rirb_rp) {
+                                async_usleep(100);
+                                --wcnt;
+                        }
+
+                        if (hda_get_rirbwp(hda) == hda->ctl->rirb_rp)
+                                return ETIMEOUT;
+                }
+        }
+
+        return EOK;
+}
+
 hda_ctl_t *hda_ctl_init(hda_t *hda)
 {
@@ -426 +448 @@
                 goto error;
 
-        uint32_t verb;
-        verb = (0 << 28) | (0 << 20) | ((hda_get_param) << 8) | (hda_sub_nc);
-        rc = hda_corb_write(hda, &verb, 1);
-        ddf_msg(LVL_NOTE, "hda_corb_write -> %d", rc);
-        rc = hda_corb_write(hda, &verb, 1);
-        ddf_msg(LVL_NOTE, "hda_corb_write -> %d", rc);
-        rc = hda_corb_write(hda, &verb, 1);
-        ddf_msg(LVL_NOTE, "hda_corb_write -> %d", rc);
-        rc = hda_corb_write(hda, &verb, 1);
-        ddf_msg(LVL_NOTE, "hda_corb_write -> %d", rc);
-
-        async_usleep(100*1000);
-        hda_rirb_read(hda);
+        hda->ctl->codec = hda_codec_init(hda, 0);
+        if (hda->ctl->codec == NULL)
+                goto error;
 
         return ctl;
@@ -447 +459 @@
 }
 
+int hda_cmd(hda_t *hda, uint32_t verb, uint32_t *resp)
+{
+        int rc;
+        hda_rirb_entry_t rentry;
+
+        rc = hda_corb_write(hda, &verb, 1);
+        if (rc != EOK)
+                return rc;
+
+        if (resp != NULL) {
+                rc = hda_rirb_read(hda, &rentry, 1);
+                if (rc != EOK)
+                        return rc;
+
+                /* XXX Verify that response came from the correct codec */
+                *resp = rentry.resp;
+        }
+
+        return EOK;
+}
+
 void hda_ctl_fini(hda_ctl_t *ctl)
 {