source: mainline/uspace/drv/audio/sb16/main.c@ 3fafe5e0

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

Make ccheck-fix again and commit more good files.
  • Property mode set to 100644
File size: 6.8 KB
Line 
1/*
2 * Copyright (c) 2011 Jan Vesely
3 * Copyright (c) 2011 Vojtech Horky
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * - Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * - Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * - The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29/** @addtogroup drvaudiosb16
30 * @{
31 */
32/** @file
33 * Main routines of Creative Labs SoundBlaster 16 driver
34 */
35#include <ddf/driver.h>
36#include <ddf/interrupt.h>
37#include <ddf/log.h>
38#include <device/hw_res_parsed.h>
39#include <assert.h>
40#include <stdio.h>
41#include <errno.h>
42#include <str_error.h>
43
44#include "ddf_log.h"
45#include "sb16.h"
46
47#define NAME "sb16"
48
49static errno_t sb_add_device(ddf_dev_t *device);
50static errno_t sb_get_res(ddf_dev_t *device, addr_range_t **pp_sb_regs,
51 addr_range_t **pp_mpu_regs, int *irq, int *dma8, int *dma16);
52static errno_t sb_enable_interrupt(ddf_dev_t *device, int irq);
53
54static driver_ops_t sb_driver_ops = {
55 .dev_add = sb_add_device,
56};
57
58static driver_t sb_driver = {
59 .name = NAME,
60 .driver_ops = &sb_driver_ops
61};
62
63/** Initialize global driver structures (NONE).
64 *
65 * @param[in] argc Nmber of arguments in argv vector (ignored).
66 * @param[in] argv Cmdline argument vector (ignored).
67 * @return Error code.
68 *
69 * Driver debug level is set here.
70 */
71int main(int argc, char *argv[])
72{
73 printf(NAME ": HelenOS SB16 audio driver.\n");
74 ddf_log_init(NAME);
75 return ddf_driver_main(&sb_driver);
76}
77
78static void irq_handler(ipc_call_t *call, ddf_dev_t *dev)
79{
80 sb16_t *sb16_dev = ddf_dev_data_get(dev);
81 sb16_interrupt(sb16_dev);
82}
83
84/** Initialize new SB16 driver instance.
85 *
86 * @param[in] device DDF instance of the device to initialize.
87 * @return Error code.
88 */
89static errno_t sb_add_device(ddf_dev_t *device)
90{
91 bool handler_regd = false;
92 const size_t irq_cmd_count = sb16_irq_code_size();
93 irq_cmd_t irq_cmds[irq_cmd_count];
94 irq_pio_range_t irq_ranges[1];
95 cap_irq_handle_t irq_cap;
96
97 sb16_t *soft_state = ddf_dev_data_alloc(device, sizeof(sb16_t));
98 errno_t rc = soft_state ? EOK : ENOMEM;
99 if (rc != EOK) {
100 ddf_log_error("Failed to allocate sb16 structure.");
101 goto error;
102 }
103
104 addr_range_t sb_regs;
105 addr_range_t *p_sb_regs = &sb_regs;
106 addr_range_t mpu_regs;
107 addr_range_t *p_mpu_regs = &mpu_regs;
108 int irq = 0, dma8 = 0, dma16 = 0;
109
110 rc = sb_get_res(device, &p_sb_regs, &p_mpu_regs, &irq, &dma8, &dma16);
111 if (rc != EOK) {
112 ddf_log_error("Failed to get resources: %s.", str_error(rc));
113 goto error;
114 }
115
116 sb16_irq_code(p_sb_regs, dma8, dma16, irq_cmds, irq_ranges);
117
118 irq_code_t irq_code = {
119 .cmdcount = irq_cmd_count,
120 .cmds = irq_cmds,
121 .rangecount = 1,
122 .ranges = irq_ranges
123 };
124
125 rc = register_interrupt_handler(device, irq, irq_handler,
126 &irq_code, &irq_cap);
127 if (rc != EOK) {
128 ddf_log_error("Failed to register irq handler: %s.",
129 str_error(rc));
130 goto error;
131 }
132
133 handler_regd = true;
134
135 rc = sb_enable_interrupt(device, irq);
136 if (rc != EOK) {
137 ddf_log_error("Failed to enable interrupts: %s.",
138 str_error(rc));
139 goto error;
140 }
141
142 rc = sb16_init_sb16(soft_state, p_sb_regs, device, dma8, dma16);
143 if (rc != EOK) {
144 ddf_log_error("Failed to init sb16 driver: %s.",
145 str_error(rc));
146 goto error;
147 }
148
149 rc = sb16_init_mpu(soft_state, p_mpu_regs);
150 if (rc == EOK) {
151 ddf_fun_t *mpu_fun =
152 ddf_fun_create(device, fun_exposed, "midi");
153 if (mpu_fun) {
154 rc = ddf_fun_bind(mpu_fun);
155 if (rc != EOK)
156 ddf_log_error(
157 "Failed to bind midi function: %s.",
158 str_error(rc));
159 } else {
160 ddf_log_error("Failed to create midi function.");
161 }
162 } else {
163 ddf_log_warning("Failed to init mpu driver: %s.",
164 str_error(rc));
165 }
166
167 /* MPU state does not matter */
168 return EOK;
169error:
170 if (handler_regd)
171 unregister_interrupt_handler(device, irq_cap);
172 return rc;
173}
174
175static errno_t sb_get_res(ddf_dev_t *device, addr_range_t **pp_sb_regs,
176 addr_range_t **pp_mpu_regs, int *irq, int *dma8, int *dma16)
177{
178 assert(device);
179
180 async_sess_t *parent_sess = ddf_dev_parent_sess_get(device);
181 if (parent_sess == NULL)
182 return ENOMEM;
183
184 hw_res_list_parsed_t hw_res;
185 hw_res_list_parsed_init(&hw_res);
186 const errno_t ret = hw_res_get_list_parsed(parent_sess, &hw_res, 0);
187 if (ret != EOK) {
188 return ret;
189 }
190
191 /* 1x IRQ, 1-2x DMA(8,16), 1-2x IO (MPU is separate). */
192 if (hw_res.irqs.count != 1 ||
193 (hw_res.io_ranges.count != 1 && hw_res.io_ranges.count != 2) ||
194 (hw_res.dma_channels.count != 1 && hw_res.dma_channels.count != 2)) {
195 hw_res_list_parsed_clean(&hw_res);
196 return EINVAL;
197 }
198
199 if (irq)
200 *irq = hw_res.irqs.irqs[0];
201
202 if (dma8) {
203 if (hw_res.dma_channels.channels[0] < 4) {
204 *dma8 = hw_res.dma_channels.channels[0];
205 } else {
206 if (hw_res.dma_channels.count == 2 &&
207 hw_res.dma_channels.channels[1] < 4) {
208 *dma8 = hw_res.dma_channels.channels[1];
209 }
210 }
211 }
212
213 if (dma16) {
214 if (hw_res.dma_channels.channels[0] > 4) {
215 *dma16 = hw_res.dma_channels.channels[0];
216 } else {
217 if (hw_res.dma_channels.count == 2 &&
218 hw_res.dma_channels.channels[1] > 4) {
219 *dma16 = hw_res.dma_channels.channels[1];
220 }
221 }
222 }
223
224 if (hw_res.io_ranges.count == 1) {
225 if (pp_sb_regs && *pp_sb_regs)
226 **pp_sb_regs = hw_res.io_ranges.ranges[0];
227 if (pp_mpu_regs)
228 *pp_mpu_regs = NULL;
229 } else {
230 const int sb =
231 (hw_res.io_ranges.ranges[0].size >= sizeof(sb16_regs_t)) ?
232 0 : 1;
233 const int mpu = 1 - sb;
234 if (pp_sb_regs && *pp_sb_regs)
235 **pp_sb_regs = hw_res.io_ranges.ranges[sb];
236 if (pp_mpu_regs && *pp_mpu_regs)
237 **pp_mpu_regs = hw_res.io_ranges.ranges[mpu];
238 }
239
240 return EOK;
241}
242
243static errno_t sb_enable_interrupt(ddf_dev_t *device, int irq)
244{
245 async_sess_t *parent_sess = ddf_dev_parent_sess_get(device);
246 if (parent_sess == NULL)
247 return ENOMEM;
248
249 return hw_res_enable_interrupt(parent_sess, irq);
250}
251
252/**
253 * @}
254 */
Note: See TracBrowser for help on using the repository browser.