source: mainline/uspace/drv/audio/hdaudio/hdaudio.c@ de16f89

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since de16f89 was de16f89, checked in by Jiri Svoboda <jiri@…>, 11 years ago

Add cleanup code to error paths.
  • Property mode set to 100644
File size: 9.3 KB
RevLine 
[b229062]1/*
2 * Copyright (c) 2014 Jiri Svoboda
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/** @addtogroup hdaudio
30 * @{
31 */
32/** @file High Definition Audio driver
33 */
34
35#include <assert.h>
[a333b7f]36#include <bitops.h>
[b229062]37#include <ddi.h>
38#include <device/hw_res_parsed.h>
[1e92bc3]39#include <irc.h>
[b229062]40#include <stdio.h>
41#include <errno.h>
42#include <str_error.h>
43#include <ddf/driver.h>
[a333b7f]44#include <ddf/interrupt.h>
[b229062]45#include <ddf/log.h>
46
47#include "hdactl.h"
48#include "hdaudio.h"
[93c3163]49#include "pcm_iface.h"
[7978d1e7]50#include "spec/regs.h"
[b229062]51
52#define NAME "hdaudio"
53
54static int hda_dev_add(ddf_dev_t *dev);
55static int hda_dev_remove(ddf_dev_t *dev);
56static int hda_dev_gone(ddf_dev_t *dev);
57static int hda_fun_online(ddf_fun_t *fun);
58static int hda_fun_offline(ddf_fun_t *fun);
59
[a333b7f]60static void hdaudio_interrupt(ddf_dev_t *, ipc_callid_t, ipc_call_t *);
61
[b229062]62static driver_ops_t driver_ops = {
63 .dev_add = &hda_dev_add,
64 .dev_remove = &hda_dev_remove,
65 .dev_gone = &hda_dev_gone,
66 .fun_online = &hda_fun_online,
67 .fun_offline = &hda_fun_offline
68};
69
70static driver_t hda_driver = {
71 .name = NAME,
72 .driver_ops = &driver_ops
73};
74
[93c3163]75ddf_dev_ops_t hda_pcm_ops = {
76 .interfaces[AUDIO_PCM_BUFFER_IFACE] = &hda_pcm_iface
77};
78
[a333b7f]79irq_pio_range_t hdaudio_irq_pio_ranges[] = {
80 {
81 .base = 0,
82 .size = 8192
83 }
84};
85
86irq_cmd_t hdaudio_irq_commands[] = {
[31ccd42a]87 /* 0 */
[a333b7f]88 {
89 .cmd = CMD_PIO_READ_8,
[903eff5]90 .addr = NULL, /* rirbsts */
[a333b7f]91 .dstarg = 2
92 },
[31ccd42a]93 /* 1 */
[a333b7f]94 {
95 .cmd = CMD_AND,
96 .value = BIT_V(uint8_t, rirbsts_intfl),
97 .srcarg = 2,
98 .dstarg = 3
99 },
[31ccd42a]100 /* 2 */
[a333b7f]101 {
102 .cmd = CMD_PREDICATE,
103 .value = 2,
104 .srcarg = 3
105 },
[31ccd42a]106 /* 3 */
[a333b7f]107 {
108 .cmd = CMD_PIO_WRITE_8,
[903eff5]109 .addr = NULL, /* rirbsts */
[31ccd42a]110 .value = BIT_V(uint8_t, rirbsts_intfl)
[a333b7f]111 },
[31ccd42a]112 /* 4 */
[a333b7f]113 {
114 .cmd = CMD_ACCEPT
115 }
116};
117
[31ccd42a]118irq_cmd_t hdaudio_irq_commands_sdesc[] = {
119 /* 0 */
120 {
121 .cmd = CMD_PIO_READ_32,
122 .addr = NULL, /* intsts */
123 .dstarg = 2
124 },
125 /* 1 */
126 {
127 .cmd = CMD_AND,
128 .value = 0, /* 1 << idx */
129 .srcarg = 2,
130 .dstarg = 3,
131 },
132 /* 2 */
133 {
134 .cmd = CMD_PREDICATE,
135 .value = 2,
136 .srcarg = 3
137 },
138 /* 3 */
139 {
140 .cmd = CMD_PIO_WRITE_8,
141 .addr = NULL, /* sdesc[x].sts */
142 .value = 0x4 /* XXX sdesc.sts.BCIS */
143 },
144 /* 4 */
145 {
146 .cmd = CMD_ACCEPT
147 }
[a333b7f]148};
149
[b229062]150static int hda_dev_add(ddf_dev_t *dev)
151{
[de16f89]152 ddf_fun_t *fun_pcm = NULL;
[b229062]153 hda_t *hda = NULL;
154 hw_res_list_parsed_t res;
[31ccd42a]155 irq_code_t irq_code;
[de16f89]156 irq_cmd_t *cmds = NULL;
[31ccd42a]157 size_t ncmds_base;
158 size_t ncmds_sdesc;
159 size_t ncmds;
160 int i;
[de16f89]161 void *regs = NULL;
[b229062]162 int rc;
163
164 ddf_msg(LVL_NOTE, "hda_dev_add()");
[de16f89]165 hw_res_list_parsed_init(&res);
[b229062]166
167 hda = ddf_dev_data_alloc(dev, sizeof(hda_t));
168 if (hda == NULL) {
169 ddf_msg(LVL_ERROR, "Failed allocating soft state.\n");
170 rc = ENOMEM;
171 goto error;
172 }
173
174 ddf_msg(LVL_NOTE, "create parent sess");
175 hda->parent_sess = ddf_dev_parent_sess_create(dev,
176 EXCHANGE_SERIALIZE);
177 if (hda->parent_sess == NULL) {
178 ddf_msg(LVL_ERROR, "Failed connecting parent driver.\n");
179 rc = ENOMEM;
180 goto error;
181 }
182
183 ddf_msg(LVL_NOTE, "get HW res list");
184 rc = hw_res_get_list_parsed(hda->parent_sess, &res, 0);
185 if (rc != EOK) {
186 ddf_msg(LVL_ERROR, "Failed getting resource list.\n");
187 goto error;
188 }
189
190 if (res.mem_ranges.count != 1) {
191 ddf_msg(LVL_ERROR, "Expected exactly one memory range.\n");
192 rc = EINVAL;
193 goto error;
194 }
195
196 hda->rwbase = RNGABS(res.mem_ranges.ranges[0]);
197 hda->rwsize = RNGSZ(res.mem_ranges.ranges[0]);
198
[a333b7f]199 ddf_msg(LVL_NOTE, "hda reg base: %" PRIx64,
200 RNGABS(res.mem_ranges.ranges[0]));
201
[b229062]202 if (hda->rwsize < sizeof(hda_regs_t)) {
203 ddf_msg(LVL_ERROR, "Memory range is too small.");
204 rc = EINVAL;
205 goto error;
206 }
207
208 ddf_msg(LVL_NOTE, "enable PIO");
209 rc = pio_enable((void *)(uintptr_t)hda->rwbase, hda->rwsize, &regs);
210 if (rc != EOK) {
211 ddf_msg(LVL_ERROR, "Error enabling PIO range.");
212 goto error;
213 }
214
215 hda->regs = (hda_regs_t *)regs;
216
[149dd52d]217 ddf_msg(LVL_NOTE, "IRQs: %zu", res.irqs.count);
[a333b7f]218 if (res.irqs.count != 1) {
[149dd52d]219 ddf_msg(LVL_ERROR, "Unexpected IRQ count %zu (!= 1)",
[a333b7f]220 res.irqs.count);
221 goto error;
222 }
223 ddf_msg(LVL_NOTE, "interrupt no: %d", res.irqs.irqs[0]);
224
[31ccd42a]225 ncmds_base = sizeof(hdaudio_irq_commands) / sizeof(irq_cmd_t);
226 ncmds_sdesc = sizeof(hdaudio_irq_commands_sdesc) / sizeof(irq_cmd_t);
227 ncmds = ncmds_base + 30 * ncmds_sdesc;
228
229 cmds = calloc(ncmds, sizeof(irq_cmd_t));
230 if (cmds == NULL) {
231 ddf_msg(LVL_ERROR, "Out of memory");
232 goto error;
233 }
234
235 irq_code.rangecount = sizeof(hdaudio_irq_pio_ranges) /
236 sizeof(irq_pio_range_t);
237 irq_code.ranges = hdaudio_irq_pio_ranges;
238 irq_code.cmdcount = ncmds;
239 irq_code.cmds = cmds;
240
[a333b7f]241 hda_regs_t *rphys = (hda_regs_t *)(uintptr_t)hda->rwbase;
242 hdaudio_irq_pio_ranges[0].base = (uintptr_t)hda->rwbase;
[31ccd42a]243
244 memcpy(cmds, hdaudio_irq_commands, sizeof(hdaudio_irq_commands));
245 cmds[0].addr = (void *)&rphys->rirbsts;
246 cmds[3].addr = (void *)&rphys->rirbsts;
247
248 for (i = 0; i < 30; i++) {
249 memcpy(&cmds[ncmds_base + i * ncmds_sdesc],
250 hdaudio_irq_commands_sdesc, sizeof(hdaudio_irq_commands_sdesc));
251 cmds[ncmds_base + i * ncmds_sdesc + 0].addr = (void *)&rphys->intsts;
252 cmds[ncmds_base + i * ncmds_sdesc + 1].value = BIT_V(uint32_t, i);
253 cmds[ncmds_base + i * ncmds_sdesc + 3].addr = (void *)&rphys->sdesc[i].sts;
254 }
255
[149dd52d]256 ddf_msg(LVL_NOTE, "range0.base=%zu", hdaudio_irq_pio_ranges[0].base);
[a333b7f]257
[1e92bc3]258 rc = irc_enable_interrupt(res.irqs.irqs[0]);
259 if (rc != EOK) {
260 ddf_msg(LVL_ERROR, "Failed enabling interrupt. (%d)", rc);
261 goto error;
262 }
263
[a333b7f]264 rc = register_interrupt_handler(dev, res.irqs.irqs[0],
[31ccd42a]265 hdaudio_interrupt, &irq_code);
[a333b7f]266 if (rc != EOK) {
267 ddf_msg(LVL_ERROR, "Failed registering interrupt handler. (%d)",
268 rc);
269 goto error;
270 }
271
[de16f89]272 free(cmds);
273 cmds = NULL;
274
[7978d1e7]275 if (hda_ctl_init(hda) == NULL) {
[b229062]276 rc = EIO;
277 goto error;
278 }
279
280 ddf_msg(LVL_NOTE, "create function");
[93c3163]281 fun_pcm = ddf_fun_create(dev, fun_exposed, "pcm");
282 if (fun_pcm == NULL) {
283 ddf_msg(LVL_ERROR, "Failed creating function 'pcm'.");
[b229062]284 rc = ENOMEM;
285 goto error;
286 }
287
[93c3163]288 hda->fun_pcm = fun_pcm;
289
290 ddf_fun_set_ops(fun_pcm, &hda_pcm_ops);
[b229062]291
[93c3163]292 rc = ddf_fun_bind(fun_pcm);
[b229062]293 if (rc != EOK) {
[93c3163]294 ddf_msg(LVL_ERROR, "Failed binding function 'pcm'.");
295 ddf_fun_destroy(fun_pcm);
[b229062]296 goto error;
297 }
298
[93c3163]299 ddf_fun_add_to_category(fun_pcm, "audio-pcm");
[de16f89]300
301 hw_res_list_parsed_clean(&res);
[b229062]302 return EOK;
303error:
[de16f89]304 if (fun_pcm != NULL)
305 ddf_fun_destroy(fun_pcm);
[b229062]306 if (hda != NULL) {
307 if (hda->ctl != NULL)
308 hda_ctl_fini(hda->ctl);
309 }
[de16f89]310 free(cmds);
311 // pio_disable(regs);
312 hw_res_list_parsed_clean(&res);
[b229062]313
[a333b7f]314 ddf_msg(LVL_NOTE, "Failing hda_dev_add() -> %d", rc);
[b229062]315 return rc;
316}
317
318static int hda_dev_remove(ddf_dev_t *dev)
319{
320 hda_t *hda = (hda_t *)ddf_dev_data_get(dev);
321 int rc;
322
323 ddf_msg(LVL_DEBUG, "hda_dev_remove(%p)", dev);
324
[93c3163]325 if (hda->fun_pcm != NULL) {
326 rc = ddf_fun_offline(hda->fun_pcm);
[b229062]327 if (rc != EOK)
328 return rc;
329
[93c3163]330 rc = ddf_fun_unbind(hda->fun_pcm);
[b229062]331 if (rc != EOK)
332 return rc;
333 }
334
[de16f89]335 hda_ctl_fini(hda->ctl);
336 // pio_disable(regs);
[b229062]337 return EOK;
338}
339
340static int hda_dev_gone(ddf_dev_t *dev)
341{
342 hda_t *hda = (hda_t *)ddf_dev_data_get(dev);
343 int rc;
344
345 ddf_msg(LVL_DEBUG, "hda_dev_remove(%p)", dev);
346
[93c3163]347 if (hda->fun_pcm != NULL) {
348 rc = ddf_fun_unbind(hda->fun_pcm);
[b229062]349 if (rc != EOK)
350 return rc;
351 }
352
353 return EOK;
354}
355
356static int hda_fun_online(ddf_fun_t *fun)
357{
358 ddf_msg(LVL_DEBUG, "hda_fun_online()");
359 return ddf_fun_online(fun);
360}
361
362static int hda_fun_offline(ddf_fun_t *fun)
363{
364 ddf_msg(LVL_DEBUG, "hda_fun_offline()");
365 return ddf_fun_offline(fun);
366}
367
[a333b7f]368static void hdaudio_interrupt(ddf_dev_t *dev, ipc_callid_t iid,
369 ipc_call_t *icall)
370{
371 hda_t *hda = (hda_t *)ddf_dev_data_get(dev);
372
[31ccd42a]373 if (0) ddf_msg(LVL_NOTE, "## interrupt ##");
[99cb9bf]374// ddf_msg(LVL_NOTE, "interrupt arg4=0x%x", (int)IPC_GET_ARG4(*icall));
[159c722d]375 if (IPC_GET_ARG3(*icall) != 0) {
376 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
377 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
378 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
379 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
380/* hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
381 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
382 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);
383 hda_pcm_event(hda, PCM_EVENT_FRAMES_PLAYED);*/
384 }
[a333b7f]385 hda_ctl_interrupt(hda->ctl);
386}
387
[b229062]388int main(int argc, char *argv[])
389{
390 printf(NAME ": High Definition Audio driver\n");
391 ddf_log_init(NAME);
392 return ddf_driver_main(&hda_driver);
393}
394
395/** @}
396 */
Note: See TracBrowser for help on using the repository browser.