]>
Commit | Line | Data |
---|---|---|
02bec490 TB |
1 | /* -*- linux-c -*- * |
2 | * | |
3 | * ALSA driver for the digigram lx6464es interface | |
4 | * | |
5 | * Copyright (c) 2008, 2009 Tim Blechmann <tim@klingt.org> | |
6 | * | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2 of the License, or | |
11 | * (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; see the file COPYING. If not, write to | |
20 | * the Free Software Foundation, Inc., 59 Temple Place - Suite 330, | |
21 | * Boston, MA 02111-1307, USA. | |
22 | * | |
23 | */ | |
24 | ||
25 | #include <linux/module.h> | |
26 | #include <linux/init.h> | |
27 | #include <linux/pci.h> | |
28 | #include <linux/delay.h> | |
5a0e3ad6 | 29 | #include <linux/slab.h> |
02bec490 TB |
30 | |
31 | #include <sound/initval.h> | |
32 | #include <sound/control.h> | |
33 | #include <sound/info.h> | |
34 | ||
35 | #include "lx6464es.h" | |
36 | ||
37 | MODULE_AUTHOR("Tim Blechmann"); | |
38 | MODULE_LICENSE("GPL"); | |
39 | MODULE_DESCRIPTION("digigram lx6464es"); | |
40 | MODULE_SUPPORTED_DEVICE("{digigram lx6464es{}}"); | |
41 | ||
42 | ||
43 | static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; | |
44 | static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; | |
a67ff6a5 | 45 | static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; |
02bec490 | 46 | |
de0525ca TB |
47 | module_param_array(index, int, NULL, 0444); |
48 | MODULE_PARM_DESC(index, "Index value for Digigram LX6464ES interface."); | |
49 | module_param_array(id, charp, NULL, 0444); | |
50 | MODULE_PARM_DESC(id, "ID string for Digigram LX6464ES interface."); | |
51 | module_param_array(enable, bool, NULL, 0444); | |
52 | MODULE_PARM_DESC(enable, "Enable/disable specific Digigram LX6464ES soundcards."); | |
53 | ||
02bec490 TB |
54 | static const char card_name[] = "LX6464ES"; |
55 | ||
56 | ||
57 | #define PCI_DEVICE_ID_PLX_LX6464ES PCI_DEVICE_ID_PLX_9056 | |
58 | ||
9baa3c34 | 59 | static const struct pci_device_id snd_lx6464es_ids[] = { |
02bec490 TB |
60 | { PCI_DEVICE(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES), |
61 | .subvendor = PCI_VENDOR_ID_DIGIGRAM, | |
62 | .subdevice = PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_SERIAL_SUBSYSTEM | |
63 | }, /* LX6464ES */ | |
64 | { PCI_DEVICE(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES), | |
65 | .subvendor = PCI_VENDOR_ID_DIGIGRAM, | |
66 | .subdevice = PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_CAE_SERIAL_SUBSYSTEM | |
67 | }, /* LX6464ES-CAE */ | |
68 | { 0, }, | |
69 | }; | |
70 | ||
71 | MODULE_DEVICE_TABLE(pci, snd_lx6464es_ids); | |
72 | ||
73 | ||
74 | ||
75 | /* PGO pour USERo dans le registre pci_0x06/loc_0xEC */ | |
76 | #define CHIPSC_RESET_XILINX (1L<<16) | |
77 | ||
78 | ||
79 | /* alsa callbacks */ | |
80 | static struct snd_pcm_hardware lx_caps = { | |
81 | .info = (SNDRV_PCM_INFO_MMAP | | |
82 | SNDRV_PCM_INFO_INTERLEAVED | | |
83 | SNDRV_PCM_INFO_MMAP_VALID | | |
84 | SNDRV_PCM_INFO_SYNC_START), | |
85 | .formats = (SNDRV_PCM_FMTBIT_S16_LE | | |
86 | SNDRV_PCM_FMTBIT_S16_BE | | |
87 | SNDRV_PCM_FMTBIT_S24_3LE | | |
88 | SNDRV_PCM_FMTBIT_S24_3BE), | |
89 | .rates = (SNDRV_PCM_RATE_CONTINUOUS | | |
90 | SNDRV_PCM_RATE_8000_192000), | |
91 | .rate_min = 8000, | |
92 | .rate_max = 192000, | |
93 | .channels_min = 2, | |
94 | .channels_max = 64, | |
95 | .buffer_bytes_max = 64*2*3*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER, | |
96 | .period_bytes_min = (2*2*MICROBLAZE_IBL_MIN*2), | |
97 | .period_bytes_max = (4*64*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER), | |
98 | .periods_min = 2, | |
99 | .periods_max = MAX_STREAM_BUFFER, | |
100 | }; | |
101 | ||
102 | static int lx_set_granularity(struct lx6464es *chip, u32 gran); | |
103 | ||
104 | ||
105 | static int lx_hardware_open(struct lx6464es *chip, | |
106 | struct snd_pcm_substream *substream) | |
107 | { | |
108 | int err = 0; | |
109 | struct snd_pcm_runtime *runtime = substream->runtime; | |
110 | int channels = runtime->channels; | |
111 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
112 | ||
113 | snd_pcm_uframes_t period_size = runtime->period_size; | |
114 | ||
be4e6d3c | 115 | dev_dbg(chip->card->dev, "allocating pipe for %d channels\n", channels); |
02bec490 TB |
116 | err = lx_pipe_allocate(chip, 0, is_capture, channels); |
117 | if (err < 0) { | |
be4e6d3c | 118 | dev_err(chip->card->dev, LXP "allocating pipe failed\n"); |
02bec490 TB |
119 | return err; |
120 | } | |
121 | ||
122 | err = lx_set_granularity(chip, period_size); | |
123 | if (err < 0) { | |
be4e6d3c | 124 | dev_err(chip->card->dev, "setting granularity to %ld failed\n", |
02bec490 TB |
125 | period_size); |
126 | return err; | |
127 | } | |
128 | ||
129 | return 0; | |
130 | } | |
131 | ||
132 | static int lx_hardware_start(struct lx6464es *chip, | |
133 | struct snd_pcm_substream *substream) | |
134 | { | |
135 | int err = 0; | |
136 | struct snd_pcm_runtime *runtime = substream->runtime; | |
137 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
138 | ||
be4e6d3c | 139 | dev_dbg(chip->card->dev, "setting stream format\n"); |
02bec490 TB |
140 | err = lx_stream_set_format(chip, runtime, 0, is_capture); |
141 | if (err < 0) { | |
be4e6d3c | 142 | dev_err(chip->card->dev, "setting stream format failed\n"); |
02bec490 TB |
143 | return err; |
144 | } | |
145 | ||
be4e6d3c | 146 | dev_dbg(chip->card->dev, "starting pipe\n"); |
02bec490 TB |
147 | err = lx_pipe_start(chip, 0, is_capture); |
148 | if (err < 0) { | |
be4e6d3c | 149 | dev_err(chip->card->dev, "starting pipe failed\n"); |
02bec490 TB |
150 | return err; |
151 | } | |
152 | ||
be4e6d3c | 153 | dev_dbg(chip->card->dev, "waiting for pipe to start\n"); |
02bec490 TB |
154 | err = lx_pipe_wait_for_start(chip, 0, is_capture); |
155 | if (err < 0) { | |
be4e6d3c | 156 | dev_err(chip->card->dev, "waiting for pipe failed\n"); |
02bec490 TB |
157 | return err; |
158 | } | |
159 | ||
160 | return err; | |
161 | } | |
162 | ||
163 | ||
164 | static int lx_hardware_stop(struct lx6464es *chip, | |
165 | struct snd_pcm_substream *substream) | |
166 | { | |
167 | int err = 0; | |
168 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
169 | ||
be4e6d3c | 170 | dev_dbg(chip->card->dev, "pausing pipe\n"); |
02bec490 TB |
171 | err = lx_pipe_pause(chip, 0, is_capture); |
172 | if (err < 0) { | |
be4e6d3c | 173 | dev_err(chip->card->dev, "pausing pipe failed\n"); |
02bec490 TB |
174 | return err; |
175 | } | |
176 | ||
be4e6d3c | 177 | dev_dbg(chip->card->dev, "waiting for pipe to become idle\n"); |
02bec490 TB |
178 | err = lx_pipe_wait_for_idle(chip, 0, is_capture); |
179 | if (err < 0) { | |
be4e6d3c | 180 | dev_err(chip->card->dev, "waiting for pipe failed\n"); |
02bec490 TB |
181 | return err; |
182 | } | |
183 | ||
be4e6d3c | 184 | dev_dbg(chip->card->dev, "stopping pipe\n"); |
02bec490 TB |
185 | err = lx_pipe_stop(chip, 0, is_capture); |
186 | if (err < 0) { | |
be4e6d3c | 187 | dev_err(chip->card->dev, "stopping pipe failed\n"); |
02bec490 TB |
188 | return err; |
189 | } | |
190 | ||
191 | return err; | |
192 | } | |
193 | ||
194 | ||
195 | static int lx_hardware_close(struct lx6464es *chip, | |
196 | struct snd_pcm_substream *substream) | |
197 | { | |
198 | int err = 0; | |
199 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
200 | ||
be4e6d3c | 201 | dev_dbg(chip->card->dev, "releasing pipe\n"); |
02bec490 TB |
202 | err = lx_pipe_release(chip, 0, is_capture); |
203 | if (err < 0) { | |
be4e6d3c | 204 | dev_err(chip->card->dev, "releasing pipe failed\n"); |
02bec490 TB |
205 | return err; |
206 | } | |
207 | ||
208 | return err; | |
209 | } | |
210 | ||
211 | ||
212 | static int lx_pcm_open(struct snd_pcm_substream *substream) | |
213 | { | |
214 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
215 | struct snd_pcm_runtime *runtime = substream->runtime; | |
216 | int err = 0; | |
217 | int board_rate; | |
218 | ||
be4e6d3c | 219 | dev_dbg(chip->card->dev, "->lx_pcm_open\n"); |
02bec490 TB |
220 | mutex_lock(&chip->setup_mutex); |
221 | ||
222 | /* copy the struct snd_pcm_hardware struct */ | |
223 | runtime->hw = lx_caps; | |
224 | ||
225 | #if 0 | |
226 | /* buffer-size should better be multiple of period-size */ | |
227 | err = snd_pcm_hw_constraint_integer(runtime, | |
228 | SNDRV_PCM_HW_PARAM_PERIODS); | |
229 | if (err < 0) { | |
be4e6d3c | 230 | dev_warn(chip->card->dev, "could not constrain periods\n"); |
02bec490 TB |
231 | goto exit; |
232 | } | |
233 | #endif | |
234 | ||
235 | /* the clock rate cannot be changed */ | |
236 | board_rate = chip->board_sample_rate; | |
237 | err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE, | |
238 | board_rate, board_rate); | |
239 | ||
240 | if (err < 0) { | |
be4e6d3c | 241 | dev_warn(chip->card->dev, "could not constrain periods\n"); |
02bec490 TB |
242 | goto exit; |
243 | } | |
244 | ||
245 | /* constrain period size */ | |
246 | err = snd_pcm_hw_constraint_minmax(runtime, | |
247 | SNDRV_PCM_HW_PARAM_PERIOD_SIZE, | |
248 | MICROBLAZE_IBL_MIN, | |
249 | MICROBLAZE_IBL_MAX); | |
250 | if (err < 0) { | |
be4e6d3c | 251 | dev_warn(chip->card->dev, |
02bec490 TB |
252 | "could not constrain period size\n"); |
253 | goto exit; | |
254 | } | |
255 | ||
256 | snd_pcm_hw_constraint_step(runtime, 0, | |
257 | SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 32); | |
258 | ||
259 | snd_pcm_set_sync(substream); | |
260 | err = 0; | |
261 | ||
262 | exit: | |
263 | runtime->private_data = chip; | |
264 | ||
265 | mutex_unlock(&chip->setup_mutex); | |
be4e6d3c | 266 | dev_dbg(chip->card->dev, "<-lx_pcm_open, %d\n", err); |
02bec490 TB |
267 | return err; |
268 | } | |
269 | ||
270 | static int lx_pcm_close(struct snd_pcm_substream *substream) | |
271 | { | |
272 | int err = 0; | |
be4e6d3c | 273 | dev_dbg(substream->pcm->card->dev, "->lx_pcm_close\n"); |
02bec490 TB |
274 | return err; |
275 | } | |
276 | ||
277 | static snd_pcm_uframes_t lx_pcm_stream_pointer(struct snd_pcm_substream | |
278 | *substream) | |
279 | { | |
280 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
281 | snd_pcm_uframes_t pos; | |
282 | unsigned long flags; | |
283 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
284 | ||
285 | struct lx_stream *lx_stream = is_capture ? &chip->capture_stream : | |
286 | &chip->playback_stream; | |
287 | ||
be4e6d3c | 288 | dev_dbg(chip->card->dev, "->lx_pcm_stream_pointer\n"); |
02bec490 TB |
289 | |
290 | spin_lock_irqsave(&chip->lock, flags); | |
291 | pos = lx_stream->frame_pos * substream->runtime->period_size; | |
292 | spin_unlock_irqrestore(&chip->lock, flags); | |
293 | ||
be4e6d3c | 294 | dev_dbg(chip->card->dev, "stream_pointer at %ld\n", pos); |
02bec490 TB |
295 | return pos; |
296 | } | |
297 | ||
298 | static int lx_pcm_prepare(struct snd_pcm_substream *substream) | |
299 | { | |
300 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
301 | int err = 0; | |
302 | const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
303 | ||
be4e6d3c | 304 | dev_dbg(chip->card->dev, "->lx_pcm_prepare\n"); |
02bec490 TB |
305 | |
306 | mutex_lock(&chip->setup_mutex); | |
307 | ||
308 | if (chip->hardware_running[is_capture]) { | |
309 | err = lx_hardware_stop(chip, substream); | |
310 | if (err < 0) { | |
be4e6d3c | 311 | dev_err(chip->card->dev, "failed to stop hardware. " |
02bec490 TB |
312 | "Error code %d\n", err); |
313 | goto exit; | |
314 | } | |
315 | ||
316 | err = lx_hardware_close(chip, substream); | |
317 | if (err < 0) { | |
be4e6d3c | 318 | dev_err(chip->card->dev, "failed to close hardware. " |
02bec490 TB |
319 | "Error code %d\n", err); |
320 | goto exit; | |
321 | } | |
322 | } | |
323 | ||
be4e6d3c | 324 | dev_dbg(chip->card->dev, "opening hardware\n"); |
02bec490 TB |
325 | err = lx_hardware_open(chip, substream); |
326 | if (err < 0) { | |
be4e6d3c | 327 | dev_err(chip->card->dev, "failed to open hardware. " |
02bec490 TB |
328 | "Error code %d\n", err); |
329 | goto exit; | |
330 | } | |
331 | ||
332 | err = lx_hardware_start(chip, substream); | |
333 | if (err < 0) { | |
be4e6d3c | 334 | dev_err(chip->card->dev, "failed to start hardware. " |
02bec490 TB |
335 | "Error code %d\n", err); |
336 | goto exit; | |
337 | } | |
338 | ||
339 | chip->hardware_running[is_capture] = 1; | |
340 | ||
341 | if (chip->board_sample_rate != substream->runtime->rate) { | |
342 | if (!err) | |
343 | chip->board_sample_rate = substream->runtime->rate; | |
344 | } | |
345 | ||
346 | exit: | |
347 | mutex_unlock(&chip->setup_mutex); | |
348 | return err; | |
349 | } | |
350 | ||
351 | static int lx_pcm_hw_params(struct snd_pcm_substream *substream, | |
352 | struct snd_pcm_hw_params *hw_params, int is_capture) | |
353 | { | |
354 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
355 | int err = 0; | |
356 | ||
be4e6d3c | 357 | dev_dbg(chip->card->dev, "->lx_pcm_hw_params\n"); |
02bec490 TB |
358 | |
359 | mutex_lock(&chip->setup_mutex); | |
360 | ||
361 | /* set dma buffer */ | |
362 | err = snd_pcm_lib_malloc_pages(substream, | |
363 | params_buffer_bytes(hw_params)); | |
364 | ||
365 | if (is_capture) | |
366 | chip->capture_stream.stream = substream; | |
367 | else | |
368 | chip->playback_stream.stream = substream; | |
369 | ||
370 | mutex_unlock(&chip->setup_mutex); | |
371 | return err; | |
372 | } | |
373 | ||
374 | static int lx_pcm_hw_params_playback(struct snd_pcm_substream *substream, | |
375 | struct snd_pcm_hw_params *hw_params) | |
376 | { | |
377 | return lx_pcm_hw_params(substream, hw_params, 0); | |
378 | } | |
379 | ||
380 | static int lx_pcm_hw_params_capture(struct snd_pcm_substream *substream, | |
381 | struct snd_pcm_hw_params *hw_params) | |
382 | { | |
383 | return lx_pcm_hw_params(substream, hw_params, 1); | |
384 | } | |
385 | ||
386 | static int lx_pcm_hw_free(struct snd_pcm_substream *substream) | |
387 | { | |
388 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
389 | int err = 0; | |
390 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
391 | ||
be4e6d3c | 392 | dev_dbg(chip->card->dev, "->lx_pcm_hw_free\n"); |
02bec490 TB |
393 | mutex_lock(&chip->setup_mutex); |
394 | ||
395 | if (chip->hardware_running[is_capture]) { | |
396 | err = lx_hardware_stop(chip, substream); | |
397 | if (err < 0) { | |
be4e6d3c | 398 | dev_err(chip->card->dev, "failed to stop hardware. " |
02bec490 TB |
399 | "Error code %d\n", err); |
400 | goto exit; | |
401 | } | |
402 | ||
403 | err = lx_hardware_close(chip, substream); | |
404 | if (err < 0) { | |
be4e6d3c | 405 | dev_err(chip->card->dev, "failed to close hardware. " |
02bec490 TB |
406 | "Error code %d\n", err); |
407 | goto exit; | |
408 | } | |
409 | ||
410 | chip->hardware_running[is_capture] = 0; | |
411 | } | |
412 | ||
413 | err = snd_pcm_lib_free_pages(substream); | |
414 | ||
415 | if (is_capture) | |
416 | chip->capture_stream.stream = 0; | |
417 | else | |
418 | chip->playback_stream.stream = 0; | |
419 | ||
420 | exit: | |
421 | mutex_unlock(&chip->setup_mutex); | |
422 | return err; | |
423 | } | |
424 | ||
425 | static void lx_trigger_start(struct lx6464es *chip, struct lx_stream *lx_stream) | |
426 | { | |
427 | struct snd_pcm_substream *substream = lx_stream->stream; | |
f7467452 | 428 | const unsigned int is_capture = lx_stream->is_capture; |
02bec490 TB |
429 | |
430 | int err; | |
431 | ||
432 | const u32 channels = substream->runtime->channels; | |
433 | const u32 bytes_per_frame = channels * 3; | |
434 | const u32 period_size = substream->runtime->period_size; | |
435 | const u32 periods = substream->runtime->periods; | |
436 | const u32 period_bytes = period_size * bytes_per_frame; | |
437 | ||
438 | dma_addr_t buf = substream->dma_buffer.addr; | |
439 | int i; | |
440 | ||
441 | u32 needed, freed; | |
442 | u32 size_array[5]; | |
443 | ||
444 | for (i = 0; i != periods; ++i) { | |
445 | u32 buffer_index = 0; | |
446 | ||
447 | err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed, | |
448 | size_array); | |
be4e6d3c | 449 | dev_dbg(chip->card->dev, "starting: needed %d, freed %d\n", |
02bec490 TB |
450 | needed, freed); |
451 | ||
452 | err = lx_buffer_give(chip, 0, is_capture, period_bytes, | |
453 | lower_32_bits(buf), upper_32_bits(buf), | |
454 | &buffer_index); | |
455 | ||
be4e6d3c | 456 | dev_dbg(chip->card->dev, "starting: buffer index %x on 0x%lx (%d bytes)\n", |
293db842 | 457 | buffer_index, (unsigned long)buf, period_bytes); |
02bec490 TB |
458 | buf += period_bytes; |
459 | } | |
460 | ||
461 | err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed, size_array); | |
be4e6d3c | 462 | dev_dbg(chip->card->dev, "starting: needed %d, freed %d\n", needed, freed); |
02bec490 | 463 | |
be4e6d3c | 464 | dev_dbg(chip->card->dev, "starting: starting stream\n"); |
02bec490 TB |
465 | err = lx_stream_start(chip, 0, is_capture); |
466 | if (err < 0) | |
be4e6d3c | 467 | dev_err(chip->card->dev, "couldn't start stream\n"); |
02bec490 TB |
468 | else |
469 | lx_stream->status = LX_STREAM_STATUS_RUNNING; | |
470 | ||
471 | lx_stream->frame_pos = 0; | |
472 | } | |
473 | ||
474 | static void lx_trigger_stop(struct lx6464es *chip, struct lx_stream *lx_stream) | |
475 | { | |
f7467452 | 476 | const unsigned int is_capture = lx_stream->is_capture; |
02bec490 TB |
477 | int err; |
478 | ||
be4e6d3c | 479 | dev_dbg(chip->card->dev, "stopping: stopping stream\n"); |
02bec490 TB |
480 | err = lx_stream_stop(chip, 0, is_capture); |
481 | if (err < 0) | |
be4e6d3c | 482 | dev_err(chip->card->dev, "couldn't stop stream\n"); |
02bec490 TB |
483 | else |
484 | lx_stream->status = LX_STREAM_STATUS_FREE; | |
485 | ||
486 | } | |
487 | ||
488 | static void lx_trigger_tasklet_dispatch_stream(struct lx6464es *chip, | |
489 | struct lx_stream *lx_stream) | |
490 | { | |
491 | switch (lx_stream->status) { | |
492 | case LX_STREAM_STATUS_SCHEDULE_RUN: | |
493 | lx_trigger_start(chip, lx_stream); | |
494 | break; | |
495 | ||
496 | case LX_STREAM_STATUS_SCHEDULE_STOP: | |
497 | lx_trigger_stop(chip, lx_stream); | |
498 | break; | |
499 | ||
500 | default: | |
501 | break; | |
502 | } | |
503 | } | |
504 | ||
505 | static void lx_trigger_tasklet(unsigned long data) | |
506 | { | |
507 | struct lx6464es *chip = (struct lx6464es *)data; | |
508 | unsigned long flags; | |
509 | ||
be4e6d3c | 510 | dev_dbg(chip->card->dev, "->lx_trigger_tasklet\n"); |
02bec490 TB |
511 | |
512 | spin_lock_irqsave(&chip->lock, flags); | |
513 | lx_trigger_tasklet_dispatch_stream(chip, &chip->capture_stream); | |
514 | lx_trigger_tasklet_dispatch_stream(chip, &chip->playback_stream); | |
515 | spin_unlock_irqrestore(&chip->lock, flags); | |
516 | } | |
517 | ||
518 | static int lx_pcm_trigger_dispatch(struct lx6464es *chip, | |
519 | struct lx_stream *lx_stream, int cmd) | |
520 | { | |
521 | int err = 0; | |
522 | ||
523 | switch (cmd) { | |
524 | case SNDRV_PCM_TRIGGER_START: | |
525 | lx_stream->status = LX_STREAM_STATUS_SCHEDULE_RUN; | |
526 | break; | |
527 | ||
528 | case SNDRV_PCM_TRIGGER_STOP: | |
529 | lx_stream->status = LX_STREAM_STATUS_SCHEDULE_STOP; | |
530 | break; | |
531 | ||
532 | default: | |
533 | err = -EINVAL; | |
534 | goto exit; | |
535 | } | |
536 | tasklet_schedule(&chip->trigger_tasklet); | |
537 | ||
538 | exit: | |
539 | return err; | |
540 | } | |
541 | ||
542 | ||
543 | static int lx_pcm_trigger(struct snd_pcm_substream *substream, int cmd) | |
544 | { | |
545 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
546 | const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
547 | struct lx_stream *stream = is_capture ? &chip->capture_stream : | |
548 | &chip->playback_stream; | |
549 | ||
be4e6d3c | 550 | dev_dbg(chip->card->dev, "->lx_pcm_trigger\n"); |
02bec490 TB |
551 | |
552 | return lx_pcm_trigger_dispatch(chip, stream, cmd); | |
553 | } | |
554 | ||
555 | static int snd_lx6464es_free(struct lx6464es *chip) | |
556 | { | |
be4e6d3c | 557 | dev_dbg(chip->card->dev, "->snd_lx6464es_free\n"); |
02bec490 TB |
558 | |
559 | lx_irq_disable(chip); | |
560 | ||
561 | if (chip->irq >= 0) | |
562 | free_irq(chip->irq, chip); | |
563 | ||
564 | iounmap(chip->port_dsp_bar); | |
565 | ioport_unmap(chip->port_plx_remapped); | |
566 | ||
567 | pci_release_regions(chip->pci); | |
568 | pci_disable_device(chip->pci); | |
569 | ||
570 | kfree(chip); | |
571 | ||
572 | return 0; | |
573 | } | |
574 | ||
575 | static int snd_lx6464es_dev_free(struct snd_device *device) | |
576 | { | |
577 | return snd_lx6464es_free(device->device_data); | |
578 | } | |
579 | ||
580 | /* reset the dsp during initialization */ | |
e23e7a14 | 581 | static int lx_init_xilinx_reset(struct lx6464es *chip) |
02bec490 TB |
582 | { |
583 | int i; | |
584 | u32 plx_reg = lx_plx_reg_read(chip, ePLX_CHIPSC); | |
585 | ||
be4e6d3c | 586 | dev_dbg(chip->card->dev, "->lx_init_xilinx_reset\n"); |
02bec490 TB |
587 | |
588 | /* activate reset of xilinx */ | |
589 | plx_reg &= ~CHIPSC_RESET_XILINX; | |
590 | ||
591 | lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg); | |
592 | msleep(1); | |
593 | ||
594 | lx_plx_reg_write(chip, ePLX_MBOX3, 0); | |
595 | msleep(1); | |
596 | ||
597 | plx_reg |= CHIPSC_RESET_XILINX; | |
598 | lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg); | |
599 | ||
600 | /* deactivate reset of xilinx */ | |
601 | for (i = 0; i != 100; ++i) { | |
602 | u32 reg_mbox3; | |
603 | msleep(10); | |
604 | reg_mbox3 = lx_plx_reg_read(chip, ePLX_MBOX3); | |
605 | if (reg_mbox3) { | |
be4e6d3c TI |
606 | dev_dbg(chip->card->dev, "xilinx reset done\n"); |
607 | dev_dbg(chip->card->dev, "xilinx took %d loops\n", i); | |
02bec490 TB |
608 | break; |
609 | } | |
610 | } | |
611 | ||
612 | /* todo: add some error handling? */ | |
613 | ||
614 | /* clear mr */ | |
615 | lx_dsp_reg_write(chip, eReg_CSM, 0); | |
616 | ||
617 | /* le xilinx ES peut ne pas etre encore pret, on attend. */ | |
618 | msleep(600); | |
619 | ||
620 | return 0; | |
621 | } | |
622 | ||
e23e7a14 | 623 | static int lx_init_xilinx_test(struct lx6464es *chip) |
02bec490 TB |
624 | { |
625 | u32 reg; | |
626 | ||
be4e6d3c | 627 | dev_dbg(chip->card->dev, "->lx_init_xilinx_test\n"); |
02bec490 TB |
628 | |
629 | /* TEST if we have access to Xilinx/MicroBlaze */ | |
630 | lx_dsp_reg_write(chip, eReg_CSM, 0); | |
631 | ||
632 | reg = lx_dsp_reg_read(chip, eReg_CSM); | |
633 | ||
634 | if (reg) { | |
be4e6d3c | 635 | dev_err(chip->card->dev, "Problem: Reg_CSM %x.\n", reg); |
02bec490 TB |
636 | |
637 | /* PCI9056_SPACE0_REMAP */ | |
638 | lx_plx_reg_write(chip, ePLX_PCICR, 1); | |
639 | ||
640 | reg = lx_dsp_reg_read(chip, eReg_CSM); | |
641 | if (reg) { | |
be4e6d3c | 642 | dev_err(chip->card->dev, "Error: Reg_CSM %x.\n", reg); |
02bec490 TB |
643 | return -EAGAIN; /* seems to be appropriate */ |
644 | } | |
645 | } | |
646 | ||
be4e6d3c | 647 | dev_dbg(chip->card->dev, "Xilinx/MicroBlaze access test successful\n"); |
02bec490 TB |
648 | |
649 | return 0; | |
650 | } | |
651 | ||
652 | /* initialize ethersound */ | |
e23e7a14 | 653 | static int lx_init_ethersound_config(struct lx6464es *chip) |
02bec490 TB |
654 | { |
655 | int i; | |
656 | u32 orig_conf_es = lx_dsp_reg_read(chip, eReg_CONFES); | |
657 | ||
7e895cfa TB |
658 | /* configure 64 io channels */ |
659 | u32 conf_es = (orig_conf_es & CONFES_READ_PART_MASK) | | |
02bec490 | 660 | (64 << IOCR_INPUTS_OFFSET) | |
7e895cfa | 661 | (64 << IOCR_OUTPUTS_OFFSET) | |
02bec490 TB |
662 | (FREQ_RATIO_SINGLE_MODE << FREQ_RATIO_OFFSET); |
663 | ||
be4e6d3c | 664 | dev_dbg(chip->card->dev, "->lx_init_ethersound\n"); |
02bec490 TB |
665 | |
666 | chip->freq_ratio = FREQ_RATIO_SINGLE_MODE; | |
667 | ||
668 | /* | |
669 | * write it to the card ! | |
670 | * this actually kicks the ES xilinx, the first time since poweron. | |
671 | * the MAC address in the Reg_ADMACESMSB Reg_ADMACESLSB registers | |
672 | * is not ready before this is done, and the bit 2 in Reg_CSES is set. | |
673 | * */ | |
674 | lx_dsp_reg_write(chip, eReg_CONFES, conf_es); | |
675 | ||
676 | for (i = 0; i != 1000; ++i) { | |
677 | if (lx_dsp_reg_read(chip, eReg_CSES) & 4) { | |
be4e6d3c | 678 | dev_dbg(chip->card->dev, "ethersound initialized after %dms\n", |
02bec490 TB |
679 | i); |
680 | goto ethersound_initialized; | |
681 | } | |
682 | msleep(1); | |
683 | } | |
be4e6d3c | 684 | dev_warn(chip->card->dev, |
02bec490 TB |
685 | "ethersound could not be initialized after %dms\n", i); |
686 | return -ETIMEDOUT; | |
687 | ||
688 | ethersound_initialized: | |
be4e6d3c | 689 | dev_dbg(chip->card->dev, "ethersound initialized\n"); |
02bec490 TB |
690 | return 0; |
691 | } | |
692 | ||
e23e7a14 | 693 | static int lx_init_get_version_features(struct lx6464es *chip) |
02bec490 TB |
694 | { |
695 | u32 dsp_version; | |
696 | ||
697 | int err; | |
698 | ||
be4e6d3c | 699 | dev_dbg(chip->card->dev, "->lx_init_get_version_features\n"); |
02bec490 TB |
700 | |
701 | err = lx_dsp_get_version(chip, &dsp_version); | |
702 | ||
703 | if (err == 0) { | |
704 | u32 freq; | |
705 | ||
be4e6d3c | 706 | dev_info(chip->card->dev, "DSP version: V%02d.%02d #%d\n", |
02bec490 TB |
707 | (dsp_version>>16) & 0xff, (dsp_version>>8) & 0xff, |
708 | dsp_version & 0xff); | |
709 | ||
710 | /* later: what firmware version do we expect? */ | |
711 | ||
712 | /* retrieve Play/Rec features */ | |
713 | /* done here because we may have to handle alternate | |
714 | * DSP files. */ | |
715 | /* later */ | |
716 | ||
717 | /* init the EtherSound sample rate */ | |
718 | err = lx_dsp_get_clock_frequency(chip, &freq); | |
719 | if (err == 0) | |
720 | chip->board_sample_rate = freq; | |
be4e6d3c | 721 | dev_dbg(chip->card->dev, "actual clock frequency %d\n", freq); |
02bec490 | 722 | } else { |
be4e6d3c | 723 | dev_err(chip->card->dev, "DSP corrupted \n"); |
02bec490 TB |
724 | err = -EAGAIN; |
725 | } | |
726 | ||
727 | return err; | |
728 | } | |
729 | ||
730 | static int lx_set_granularity(struct lx6464es *chip, u32 gran) | |
731 | { | |
732 | int err = 0; | |
733 | u32 snapped_gran = MICROBLAZE_IBL_MIN; | |
734 | ||
be4e6d3c | 735 | dev_dbg(chip->card->dev, "->lx_set_granularity\n"); |
02bec490 TB |
736 | |
737 | /* blocksize is a power of 2 */ | |
738 | while ((snapped_gran < gran) && | |
739 | (snapped_gran < MICROBLAZE_IBL_MAX)) { | |
740 | snapped_gran *= 2; | |
741 | } | |
742 | ||
743 | if (snapped_gran == chip->pcm_granularity) | |
744 | return 0; | |
745 | ||
746 | err = lx_dsp_set_granularity(chip, snapped_gran); | |
747 | if (err < 0) { | |
be4e6d3c | 748 | dev_warn(chip->card->dev, "could not set granularity\n"); |
02bec490 TB |
749 | err = -EAGAIN; |
750 | } | |
751 | ||
752 | if (snapped_gran != gran) | |
be4e6d3c | 753 | dev_err(chip->card->dev, "snapped blocksize to %d\n", snapped_gran); |
02bec490 | 754 | |
be4e6d3c | 755 | dev_dbg(chip->card->dev, "set blocksize on board %d\n", snapped_gran); |
02bec490 TB |
756 | chip->pcm_granularity = snapped_gran; |
757 | ||
758 | return err; | |
759 | } | |
760 | ||
761 | /* initialize and test the xilinx dsp chip */ | |
e23e7a14 | 762 | static int lx_init_dsp(struct lx6464es *chip) |
02bec490 TB |
763 | { |
764 | int err; | |
02bec490 TB |
765 | int i; |
766 | ||
be4e6d3c | 767 | dev_dbg(chip->card->dev, "->lx_init_dsp\n"); |
02bec490 | 768 | |
be4e6d3c | 769 | dev_dbg(chip->card->dev, "initialize board\n"); |
02bec490 TB |
770 | err = lx_init_xilinx_reset(chip); |
771 | if (err) | |
772 | return err; | |
773 | ||
be4e6d3c | 774 | dev_dbg(chip->card->dev, "testing board\n"); |
02bec490 TB |
775 | err = lx_init_xilinx_test(chip); |
776 | if (err) | |
777 | return err; | |
778 | ||
be4e6d3c | 779 | dev_dbg(chip->card->dev, "initialize ethersound configuration\n"); |
02bec490 TB |
780 | err = lx_init_ethersound_config(chip); |
781 | if (err) | |
782 | return err; | |
783 | ||
784 | lx_irq_enable(chip); | |
785 | ||
786 | /** \todo the mac address should be ready by not, but it isn't, | |
787 | * so we wait for it */ | |
788 | for (i = 0; i != 1000; ++i) { | |
80b52490 | 789 | err = lx_dsp_get_mac(chip); |
02bec490 TB |
790 | if (err) |
791 | return err; | |
80b52490 TB |
792 | if (chip->mac_address[0] || chip->mac_address[1] || chip->mac_address[2] || |
793 | chip->mac_address[3] || chip->mac_address[4] || chip->mac_address[5]) | |
02bec490 TB |
794 | goto mac_ready; |
795 | msleep(1); | |
796 | } | |
797 | return -ETIMEDOUT; | |
798 | ||
799 | mac_ready: | |
be4e6d3c TI |
800 | dev_dbg(chip->card->dev, "mac address ready read after: %dms\n", i); |
801 | dev_info(chip->card->dev, | |
802 | "mac address: %02X.%02X.%02X.%02X.%02X.%02X\n", | |
80b52490 TB |
803 | chip->mac_address[0], chip->mac_address[1], chip->mac_address[2], |
804 | chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]); | |
02bec490 TB |
805 | |
806 | err = lx_init_get_version_features(chip); | |
807 | if (err) | |
808 | return err; | |
809 | ||
810 | lx_set_granularity(chip, MICROBLAZE_IBL_DEFAULT); | |
811 | ||
812 | chip->playback_mute = 0; | |
813 | ||
814 | return err; | |
815 | } | |
816 | ||
817 | static struct snd_pcm_ops lx_ops_playback = { | |
818 | .open = lx_pcm_open, | |
819 | .close = lx_pcm_close, | |
820 | .ioctl = snd_pcm_lib_ioctl, | |
821 | .prepare = lx_pcm_prepare, | |
822 | .hw_params = lx_pcm_hw_params_playback, | |
823 | .hw_free = lx_pcm_hw_free, | |
824 | .trigger = lx_pcm_trigger, | |
825 | .pointer = lx_pcm_stream_pointer, | |
826 | }; | |
827 | ||
828 | static struct snd_pcm_ops lx_ops_capture = { | |
829 | .open = lx_pcm_open, | |
830 | .close = lx_pcm_close, | |
831 | .ioctl = snd_pcm_lib_ioctl, | |
832 | .prepare = lx_pcm_prepare, | |
833 | .hw_params = lx_pcm_hw_params_capture, | |
834 | .hw_free = lx_pcm_hw_free, | |
835 | .trigger = lx_pcm_trigger, | |
836 | .pointer = lx_pcm_stream_pointer, | |
837 | }; | |
838 | ||
e23e7a14 | 839 | static int lx_pcm_create(struct lx6464es *chip) |
02bec490 TB |
840 | { |
841 | int err; | |
842 | struct snd_pcm *pcm; | |
843 | ||
844 | u32 size = 64 * /* channels */ | |
845 | 3 * /* 24 bit samples */ | |
846 | MAX_STREAM_BUFFER * /* periods */ | |
847 | MICROBLAZE_IBL_MAX * /* frames per period */ | |
848 | 2; /* duplex */ | |
849 | ||
850 | size = PAGE_ALIGN(size); | |
851 | ||
852 | /* hardcoded device name & channel count */ | |
853 | err = snd_pcm_new(chip->card, (char *)card_name, 0, | |
854 | 1, 1, &pcm); | |
3bdcff70 TI |
855 | if (err < 0) |
856 | return err; | |
02bec490 TB |
857 | |
858 | pcm->private_data = chip; | |
859 | ||
860 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &lx_ops_playback); | |
861 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &lx_ops_capture); | |
862 | ||
863 | pcm->info_flags = 0; | |
864 | strcpy(pcm->name, card_name); | |
865 | ||
866 | err = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, | |
867 | snd_dma_pci_data(chip->pci), | |
868 | size, size); | |
869 | if (err < 0) | |
870 | return err; | |
871 | ||
872 | chip->pcm = pcm; | |
873 | chip->capture_stream.is_capture = 1; | |
874 | ||
875 | return 0; | |
876 | } | |
877 | ||
878 | static int lx_control_playback_info(struct snd_kcontrol *kcontrol, | |
879 | struct snd_ctl_elem_info *uinfo) | |
880 | { | |
881 | uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; | |
882 | uinfo->count = 1; | |
883 | uinfo->value.integer.min = 0; | |
884 | uinfo->value.integer.max = 1; | |
885 | return 0; | |
886 | } | |
887 | ||
888 | static int lx_control_playback_get(struct snd_kcontrol *kcontrol, | |
889 | struct snd_ctl_elem_value *ucontrol) | |
890 | { | |
891 | struct lx6464es *chip = snd_kcontrol_chip(kcontrol); | |
892 | ucontrol->value.integer.value[0] = chip->playback_mute; | |
893 | return 0; | |
894 | } | |
895 | ||
896 | static int lx_control_playback_put(struct snd_kcontrol *kcontrol, | |
897 | struct snd_ctl_elem_value *ucontrol) | |
898 | { | |
899 | struct lx6464es *chip = snd_kcontrol_chip(kcontrol); | |
900 | int changed = 0; | |
901 | int current_value = chip->playback_mute; | |
902 | ||
903 | if (current_value != ucontrol->value.integer.value[0]) { | |
904 | lx_level_unmute(chip, 0, !current_value); | |
905 | chip->playback_mute = !current_value; | |
906 | changed = 1; | |
907 | } | |
908 | return changed; | |
909 | } | |
910 | ||
e23e7a14 | 911 | static struct snd_kcontrol_new lx_control_playback_switch = { |
02bec490 TB |
912 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
913 | .name = "PCM Playback Switch", | |
914 | .index = 0, | |
915 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | |
916 | .private_value = 0, | |
917 | .info = lx_control_playback_info, | |
918 | .get = lx_control_playback_get, | |
919 | .put = lx_control_playback_put | |
920 | }; | |
921 | ||
922 | ||
923 | ||
924 | static void lx_proc_levels_read(struct snd_info_entry *entry, | |
925 | struct snd_info_buffer *buffer) | |
926 | { | |
927 | u32 levels[64]; | |
928 | int err; | |
929 | int i, j; | |
930 | struct lx6464es *chip = entry->private_data; | |
931 | ||
932 | snd_iprintf(buffer, "capture levels:\n"); | |
933 | err = lx_level_peaks(chip, 1, 64, levels); | |
934 | if (err < 0) | |
935 | return; | |
936 | ||
937 | for (i = 0; i != 8; ++i) { | |
938 | for (j = 0; j != 8; ++j) | |
939 | snd_iprintf(buffer, "%08x ", levels[i*8+j]); | |
940 | snd_iprintf(buffer, "\n"); | |
941 | } | |
942 | ||
943 | snd_iprintf(buffer, "\nplayback levels:\n"); | |
944 | ||
945 | err = lx_level_peaks(chip, 0, 64, levels); | |
946 | if (err < 0) | |
947 | return; | |
948 | ||
949 | for (i = 0; i != 8; ++i) { | |
950 | for (j = 0; j != 8; ++j) | |
951 | snd_iprintf(buffer, "%08x ", levels[i*8+j]); | |
952 | snd_iprintf(buffer, "\n"); | |
953 | } | |
954 | ||
955 | snd_iprintf(buffer, "\n"); | |
956 | } | |
957 | ||
e23e7a14 | 958 | static int lx_proc_create(struct snd_card *card, struct lx6464es *chip) |
02bec490 TB |
959 | { |
960 | struct snd_info_entry *entry; | |
961 | int err = snd_card_proc_new(card, "levels", &entry); | |
962 | if (err < 0) | |
963 | return err; | |
964 | ||
965 | snd_info_set_text_ops(entry, chip, lx_proc_levels_read); | |
966 | return 0; | |
967 | } | |
968 | ||
969 | ||
e23e7a14 BP |
970 | static int snd_lx6464es_create(struct snd_card *card, |
971 | struct pci_dev *pci, | |
972 | struct lx6464es **rchip) | |
02bec490 TB |
973 | { |
974 | struct lx6464es *chip; | |
975 | int err; | |
976 | ||
977 | static struct snd_device_ops ops = { | |
978 | .dev_free = snd_lx6464es_dev_free, | |
979 | }; | |
980 | ||
be4e6d3c | 981 | dev_dbg(card->dev, "->snd_lx6464es_create\n"); |
02bec490 TB |
982 | |
983 | *rchip = NULL; | |
984 | ||
985 | /* enable PCI device */ | |
986 | err = pci_enable_device(pci); | |
987 | if (err < 0) | |
988 | return err; | |
989 | ||
990 | pci_set_master(pci); | |
991 | ||
992 | /* check if we can restrict PCI DMA transfers to 32 bits */ | |
8e20ce94 | 993 | err = pci_set_dma_mask(pci, DMA_BIT_MASK(32)); |
02bec490 | 994 | if (err < 0) { |
be4e6d3c TI |
995 | dev_err(card->dev, |
996 | "architecture does not support 32bit PCI busmaster DMA\n"); | |
02bec490 TB |
997 | pci_disable_device(pci); |
998 | return -ENXIO; | |
999 | } | |
1000 | ||
1001 | chip = kzalloc(sizeof(*chip), GFP_KERNEL); | |
1002 | if (chip == NULL) { | |
1003 | err = -ENOMEM; | |
1004 | goto alloc_failed; | |
1005 | } | |
1006 | ||
1007 | chip->card = card; | |
1008 | chip->pci = pci; | |
1009 | chip->irq = -1; | |
1010 | ||
1011 | /* initialize synchronization structs */ | |
1012 | spin_lock_init(&chip->lock); | |
1013 | spin_lock_init(&chip->msg_lock); | |
1014 | mutex_init(&chip->setup_mutex); | |
1015 | tasklet_init(&chip->trigger_tasklet, lx_trigger_tasklet, | |
1016 | (unsigned long)chip); | |
1017 | tasklet_init(&chip->tasklet_capture, lx_tasklet_capture, | |
1018 | (unsigned long)chip); | |
1019 | tasklet_init(&chip->tasklet_playback, lx_tasklet_playback, | |
1020 | (unsigned long)chip); | |
1021 | ||
1022 | /* request resources */ | |
1023 | err = pci_request_regions(pci, card_name); | |
1024 | if (err < 0) | |
1025 | goto request_regions_failed; | |
1026 | ||
1027 | /* plx port */ | |
1028 | chip->port_plx = pci_resource_start(pci, 1); | |
1029 | chip->port_plx_remapped = ioport_map(chip->port_plx, | |
1030 | pci_resource_len(pci, 1)); | |
1031 | ||
1032 | /* dsp port */ | |
1033 | chip->port_dsp_bar = pci_ioremap_bar(pci, 2); | |
1034 | ||
1035 | err = request_irq(pci->irq, lx_interrupt, IRQF_SHARED, | |
934c2b6d | 1036 | KBUILD_MODNAME, chip); |
02bec490 | 1037 | if (err) { |
be4e6d3c | 1038 | dev_err(card->dev, "unable to grab IRQ %d\n", pci->irq); |
02bec490 TB |
1039 | goto request_irq_failed; |
1040 | } | |
1041 | chip->irq = pci->irq; | |
1042 | ||
1043 | err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops); | |
1044 | if (err < 0) | |
1045 | goto device_new_failed; | |
1046 | ||
1047 | err = lx_init_dsp(chip); | |
1048 | if (err < 0) { | |
be4e6d3c | 1049 | dev_err(card->dev, "error during DSP initialization\n"); |
02bec490 TB |
1050 | return err; |
1051 | } | |
1052 | ||
1053 | err = lx_pcm_create(chip); | |
1054 | if (err < 0) | |
1055 | return err; | |
1056 | ||
1057 | err = lx_proc_create(card, chip); | |
1058 | if (err < 0) | |
1059 | return err; | |
1060 | ||
1061 | err = snd_ctl_add(card, snd_ctl_new1(&lx_control_playback_switch, | |
1062 | chip)); | |
1063 | if (err < 0) | |
1064 | return err; | |
1065 | ||
02bec490 TB |
1066 | *rchip = chip; |
1067 | return 0; | |
1068 | ||
1069 | device_new_failed: | |
1070 | free_irq(pci->irq, chip); | |
1071 | ||
1072 | request_irq_failed: | |
1073 | pci_release_regions(pci); | |
1074 | ||
1075 | request_regions_failed: | |
1076 | kfree(chip); | |
1077 | ||
1078 | alloc_failed: | |
1079 | pci_disable_device(pci); | |
1080 | ||
1081 | return err; | |
1082 | } | |
1083 | ||
e23e7a14 BP |
1084 | static int snd_lx6464es_probe(struct pci_dev *pci, |
1085 | const struct pci_device_id *pci_id) | |
02bec490 TB |
1086 | { |
1087 | static int dev; | |
1088 | struct snd_card *card; | |
1089 | struct lx6464es *chip; | |
1090 | int err; | |
1091 | ||
be4e6d3c | 1092 | dev_dbg(&pci->dev, "->snd_lx6464es_probe\n"); |
02bec490 TB |
1093 | |
1094 | if (dev >= SNDRV_CARDS) | |
1095 | return -ENODEV; | |
1096 | if (!enable[dev]) { | |
1097 | dev++; | |
1098 | return -ENOENT; | |
1099 | } | |
1100 | ||
60c5772b TI |
1101 | err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE, |
1102 | 0, &card); | |
7852fd08 TI |
1103 | if (err < 0) |
1104 | return err; | |
02bec490 TB |
1105 | |
1106 | err = snd_lx6464es_create(card, pci, &chip); | |
1107 | if (err < 0) { | |
be4e6d3c | 1108 | dev_err(card->dev, "error during snd_lx6464es_create\n"); |
02bec490 TB |
1109 | goto out_free; |
1110 | } | |
1111 | ||
80b52490 TB |
1112 | strcpy(card->driver, "LX6464ES"); |
1113 | sprintf(card->id, "LX6464ES_%02X%02X%02X", | |
1114 | chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]); | |
1115 | ||
1116 | sprintf(card->shortname, "LX6464ES %02X.%02X.%02X.%02X.%02X.%02X", | |
1117 | chip->mac_address[0], chip->mac_address[1], chip->mac_address[2], | |
1118 | chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]); | |
1119 | ||
02bec490 TB |
1120 | sprintf(card->longname, "%s at 0x%lx, 0x%p, irq %i", |
1121 | card->shortname, chip->port_plx, | |
1122 | chip->port_dsp_bar, chip->irq); | |
1123 | ||
1124 | err = snd_card_register(card); | |
1125 | if (err < 0) | |
1126 | goto out_free; | |
1127 | ||
be4e6d3c | 1128 | dev_dbg(chip->card->dev, "initialization successful\n"); |
02bec490 TB |
1129 | pci_set_drvdata(pci, card); |
1130 | dev++; | |
1131 | return 0; | |
1132 | ||
1133 | out_free: | |
1134 | snd_card_free(card); | |
1135 | return err; | |
1136 | ||
1137 | } | |
1138 | ||
e23e7a14 | 1139 | static void snd_lx6464es_remove(struct pci_dev *pci) |
02bec490 TB |
1140 | { |
1141 | snd_card_free(pci_get_drvdata(pci)); | |
02bec490 TB |
1142 | } |
1143 | ||
1144 | ||
e9f66d9b | 1145 | static struct pci_driver lx6464es_driver = { |
3733e424 | 1146 | .name = KBUILD_MODNAME, |
02bec490 TB |
1147 | .id_table = snd_lx6464es_ids, |
1148 | .probe = snd_lx6464es_probe, | |
e23e7a14 | 1149 | .remove = snd_lx6464es_remove, |
02bec490 TB |
1150 | }; |
1151 | ||
e9f66d9b | 1152 | module_pci_driver(lx6464es_driver); |