2 * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
4 * This source file is released under GPL v2 license (no other versions).
5 * See the COPYING file included in the main directory of this source
6 * distribution for the license terms and conditions.
11 * This file contains the implementation of Digital Audio Input Output
12 * resource management object.
20 #include "cthardware.h"
22 #include <linux/slab.h>
23 #include <linux/kernel.h>
25 #define DAIO_RESOURCE_NUM NUM_DAIOTYP
26 #define DAIO_OUT_MAX SPDIFOO
30 unsigned short lineo1:1;
31 unsigned short lineo2:1;
32 unsigned short lineo3:1;
33 unsigned short lineo4:1;
34 unsigned short spdifoo:1;
35 unsigned short lineim:1;
36 unsigned short spdifio:1;
37 unsigned short spdifi1:1;
47 struct daio_rsc_idx idx_20k1[NUM_DAIOTYP] = {
48 [LINEO1] = {.left = 0x00, .right = 0x01},
49 [LINEO2] = {.left = 0x18, .right = 0x19},
50 [LINEO3] = {.left = 0x08, .right = 0x09},
51 [LINEO4] = {.left = 0x10, .right = 0x11},
52 [LINEIM] = {.left = 0x1b5, .right = 0x1bd},
53 [SPDIFOO] = {.left = 0x20, .right = 0x21},
54 [SPDIFIO] = {.left = 0x15, .right = 0x1d},
55 [SPDIFI1] = {.left = 0x95, .right = 0x9d},
58 struct daio_rsc_idx idx_20k2[NUM_DAIOTYP] = {
59 [LINEO1] = {.left = 0x40, .right = 0x41},
60 [LINEO2] = {.left = 0x60, .right = 0x61},
61 [LINEO3] = {.left = 0x50, .right = 0x51},
62 [LINEO4] = {.left = 0x70, .right = 0x71},
63 [LINEIM] = {.left = 0x45, .right = 0xc5},
64 [SPDIFOO] = {.left = 0x00, .right = 0x01},
65 [SPDIFIO] = {.left = 0x05, .right = 0x85},
68 static int daio_master(struct rsc *rsc)
70 /* Actually, this is not the resource index of DAIO.
71 * For DAO, it is the input mapper index. And, for DAI,
72 * it is the output time-slot index. */
73 return rsc->conj = rsc->idx;
76 static int daio_index(const struct rsc *rsc)
81 static int daio_out_next_conj(struct rsc *rsc)
83 return rsc->conj += 2;
86 static int daio_in_next_conj_20k1(struct rsc *rsc)
88 return rsc->conj += 0x200;
91 static int daio_in_next_conj_20k2(struct rsc *rsc)
93 return rsc->conj += 0x100;
96 static struct rsc_ops daio_out_rsc_ops = {
97 .master = daio_master,
98 .next_conj = daio_out_next_conj,
103 static struct rsc_ops daio_in_rsc_ops_20k1 = {
104 .master = daio_master,
105 .next_conj = daio_in_next_conj_20k1,
107 .output_slot = daio_index,
110 static struct rsc_ops daio_in_rsc_ops_20k2 = {
111 .master = daio_master,
112 .next_conj = daio_in_next_conj_20k2,
114 .output_slot = daio_index,
117 static unsigned int daio_device_index(enum DAIOTYP type, struct hw *hw)
119 switch (hw->chip_type) {
122 case SPDIFOO: return 0;
123 case SPDIFIO: return 0;
124 case SPDIFI1: return 1;
125 case LINEO1: return 4;
126 case LINEO2: return 7;
127 case LINEO3: return 5;
128 case LINEO4: return 6;
129 case LINEIM: return 7;
130 default: return -EINVAL;
134 case SPDIFOO: return 0;
135 case SPDIFIO: return 0;
136 case LINEO1: return 4;
137 case LINEO2: return 7;
138 case LINEO3: return 5;
139 case LINEO4: return 6;
140 case LINEIM: return 4;
141 default: return -EINVAL;
148 static int dao_rsc_reinit(struct dao *dao, const struct dao_desc *desc);
150 static int dao_spdif_get_spos(struct dao *dao, unsigned int *spos)
152 ((struct hw *)dao->hw)->dao_get_spos(dao->ctrl_blk, spos);
156 static int dao_spdif_set_spos(struct dao *dao, unsigned int spos)
158 ((struct hw *)dao->hw)->dao_set_spos(dao->ctrl_blk, spos);
162 static int dao_commit_write(struct dao *dao)
164 ((struct hw *)dao->hw)->dao_commit_write(dao->hw,
165 daio_device_index(dao->daio.type, dao->hw), dao->ctrl_blk);
169 static int dao_set_left_input(struct dao *dao, struct rsc *input)
171 struct imapper *entry;
172 struct daio *daio = &dao->daio;
175 entry = kzalloc((sizeof(*entry) * daio->rscl.msr), GFP_KERNEL);
179 dao->ops->clear_left_input(dao);
180 /* Program master and conjugate resources */
181 input->ops->master(input);
182 daio->rscl.ops->master(&daio->rscl);
183 for (i = 0; i < daio->rscl.msr; i++, entry++) {
184 entry->slot = input->ops->output_slot(input);
185 entry->user = entry->addr = daio->rscl.ops->index(&daio->rscl);
186 dao->mgr->imap_add(dao->mgr, entry);
187 dao->imappers[i] = entry;
189 input->ops->next_conj(input);
190 daio->rscl.ops->next_conj(&daio->rscl);
192 input->ops->master(input);
193 daio->rscl.ops->master(&daio->rscl);
198 static int dao_set_right_input(struct dao *dao, struct rsc *input)
200 struct imapper *entry;
201 struct daio *daio = &dao->daio;
204 entry = kzalloc((sizeof(*entry) * daio->rscr.msr), GFP_KERNEL);
208 dao->ops->clear_right_input(dao);
209 /* Program master and conjugate resources */
210 input->ops->master(input);
211 daio->rscr.ops->master(&daio->rscr);
212 for (i = 0; i < daio->rscr.msr; i++, entry++) {
213 entry->slot = input->ops->output_slot(input);
214 entry->user = entry->addr = daio->rscr.ops->index(&daio->rscr);
215 dao->mgr->imap_add(dao->mgr, entry);
216 dao->imappers[daio->rscl.msr + i] = entry;
218 input->ops->next_conj(input);
219 daio->rscr.ops->next_conj(&daio->rscr);
221 input->ops->master(input);
222 daio->rscr.ops->master(&daio->rscr);
227 static int dao_clear_left_input(struct dao *dao)
229 struct imapper *entry;
230 struct daio *daio = &dao->daio;
233 if (!dao->imappers[0])
236 entry = dao->imappers[0];
237 dao->mgr->imap_delete(dao->mgr, entry);
238 /* Program conjugate resources */
239 for (i = 1; i < daio->rscl.msr; i++) {
240 entry = dao->imappers[i];
241 dao->mgr->imap_delete(dao->mgr, entry);
242 dao->imappers[i] = NULL;
245 kfree(dao->imappers[0]);
246 dao->imappers[0] = NULL;
251 static int dao_clear_right_input(struct dao *dao)
253 struct imapper *entry;
254 struct daio *daio = &dao->daio;
257 if (!dao->imappers[daio->rscl.msr])
260 entry = dao->imappers[daio->rscl.msr];
261 dao->mgr->imap_delete(dao->mgr, entry);
262 /* Program conjugate resources */
263 for (i = 1; i < daio->rscr.msr; i++) {
264 entry = dao->imappers[daio->rscl.msr + i];
265 dao->mgr->imap_delete(dao->mgr, entry);
266 dao->imappers[daio->rscl.msr + i] = NULL;
269 kfree(dao->imappers[daio->rscl.msr]);
270 dao->imappers[daio->rscl.msr] = NULL;
275 static struct dao_rsc_ops dao_ops = {
276 .set_spos = dao_spdif_set_spos,
277 .commit_write = dao_commit_write,
278 .get_spos = dao_spdif_get_spos,
279 .reinit = dao_rsc_reinit,
280 .set_left_input = dao_set_left_input,
281 .set_right_input = dao_set_right_input,
282 .clear_left_input = dao_clear_left_input,
283 .clear_right_input = dao_clear_right_input,
286 static int dai_set_srt_srcl(struct dai *dai, struct rsc *src)
288 src->ops->master(src);
289 ((struct hw *)dai->hw)->dai_srt_set_srcm(dai->ctrl_blk,
290 src->ops->index(src));
294 static int dai_set_srt_srcr(struct dai *dai, struct rsc *src)
296 src->ops->master(src);
297 ((struct hw *)dai->hw)->dai_srt_set_srco(dai->ctrl_blk,
298 src->ops->index(src));
302 static int dai_set_srt_msr(struct dai *dai, unsigned int msr)
306 for (rsr = 0; msr > 1; msr >>= 1)
309 ((struct hw *)dai->hw)->dai_srt_set_rsr(dai->ctrl_blk, rsr);
313 static int dai_set_enb_src(struct dai *dai, unsigned int enb)
315 ((struct hw *)dai->hw)->dai_srt_set_ec(dai->ctrl_blk, enb);
319 static int dai_set_enb_srt(struct dai *dai, unsigned int enb)
321 ((struct hw *)dai->hw)->dai_srt_set_et(dai->ctrl_blk, enb);
325 static int dai_commit_write(struct dai *dai)
327 ((struct hw *)dai->hw)->dai_commit_write(dai->hw,
328 daio_device_index(dai->daio.type, dai->hw), dai->ctrl_blk);
332 static struct dai_rsc_ops dai_ops = {
333 .set_srt_srcl = dai_set_srt_srcl,
334 .set_srt_srcr = dai_set_srt_srcr,
335 .set_srt_msr = dai_set_srt_msr,
336 .set_enb_src = dai_set_enb_src,
337 .set_enb_srt = dai_set_enb_srt,
338 .commit_write = dai_commit_write,
341 static int daio_rsc_init(struct daio *daio,
342 const struct daio_desc *desc,
346 unsigned int idx_l, idx_r;
348 switch (((struct hw *)hw)->chip_type) {
350 idx_l = idx_20k1[desc->type].left;
351 idx_r = idx_20k1[desc->type].right;
354 idx_l = idx_20k2[desc->type].left;
355 idx_r = idx_20k2[desc->type].right;
360 err = rsc_init(&daio->rscl, idx_l, DAIO, desc->msr, hw);
364 err = rsc_init(&daio->rscr, idx_r, DAIO, desc->msr, hw);
368 /* Set daio->rscl/r->ops to daio specific ones */
369 if (desc->type <= DAIO_OUT_MAX) {
370 daio->rscl.ops = daio->rscr.ops = &daio_out_rsc_ops;
372 switch (((struct hw *)hw)->chip_type) {
374 daio->rscl.ops = daio->rscr.ops = &daio_in_rsc_ops_20k1;
377 daio->rscl.ops = daio->rscr.ops = &daio_in_rsc_ops_20k2;
383 daio->type = desc->type;
388 rsc_uninit(&daio->rscl);
392 static int daio_rsc_uninit(struct daio *daio)
394 rsc_uninit(&daio->rscl);
395 rsc_uninit(&daio->rscr);
400 static int dao_rsc_init(struct dao *dao,
401 const struct daio_desc *desc,
402 struct daio_mgr *mgr)
404 struct hw *hw = mgr->mgr.hw;
408 err = daio_rsc_init(&dao->daio, desc, mgr->mgr.hw);
412 dao->imappers = kzalloc(sizeof(void *)*desc->msr*2, GFP_KERNEL);
413 if (!dao->imappers) {
420 err = hw->dao_get_ctrl_blk(&dao->ctrl_blk);
424 hw->daio_mgr_dsb_dao(mgr->mgr.ctrl_blk,
425 daio_device_index(dao->daio.type, hw));
426 hw->daio_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
428 conf = (desc->msr & 0x7) | (desc->passthru << 3);
429 hw->daio_mgr_dao_init(mgr->mgr.ctrl_blk,
430 daio_device_index(dao->daio.type, hw), conf);
431 hw->daio_mgr_enb_dao(mgr->mgr.ctrl_blk,
432 daio_device_index(dao->daio.type, hw));
433 hw->daio_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
438 kfree(dao->imappers);
439 dao->imappers = NULL;
441 daio_rsc_uninit(&dao->daio);
445 static int dao_rsc_uninit(struct dao *dao)
448 if (dao->imappers[0])
449 dao_clear_left_input(dao);
451 if (dao->imappers[dao->daio.rscl.msr])
452 dao_clear_right_input(dao);
454 kfree(dao->imappers);
455 dao->imappers = NULL;
457 ((struct hw *)dao->hw)->dao_put_ctrl_blk(dao->ctrl_blk);
458 dao->hw = dao->ctrl_blk = NULL;
459 daio_rsc_uninit(&dao->daio);
464 static int dao_rsc_reinit(struct dao *dao, const struct dao_desc *desc)
466 struct daio_mgr *mgr = dao->mgr;
467 struct daio_desc dsc = {0};
469 dsc.type = dao->daio.type;
471 dsc.passthru = desc->passthru;
473 return dao_rsc_init(dao, &dsc, mgr);
476 static int dai_rsc_init(struct dai *dai,
477 const struct daio_desc *desc,
478 struct daio_mgr *mgr)
481 struct hw *hw = mgr->mgr.hw;
482 unsigned int rsr, msr;
484 err = daio_rsc_init(&dai->daio, desc, mgr->mgr.hw);
489 dai->hw = mgr->mgr.hw;
490 err = hw->dai_get_ctrl_blk(&dai->ctrl_blk);
494 for (rsr = 0, msr = desc->msr; msr > 1; msr >>= 1)
497 hw->dai_srt_set_rsr(dai->ctrl_blk, rsr);
498 hw->dai_srt_set_drat(dai->ctrl_blk, 0);
499 /* default to disabling control of a SRC */
500 hw->dai_srt_set_ec(dai->ctrl_blk, 0);
501 hw->dai_srt_set_et(dai->ctrl_blk, 0); /* default to disabling SRT */
502 hw->dai_commit_write(hw,
503 daio_device_index(dai->daio.type, dai->hw), dai->ctrl_blk);
508 daio_rsc_uninit(&dai->daio);
512 static int dai_rsc_uninit(struct dai *dai)
514 ((struct hw *)dai->hw)->dai_put_ctrl_blk(dai->ctrl_blk);
515 dai->hw = dai->ctrl_blk = NULL;
516 daio_rsc_uninit(&dai->daio);
520 static int daio_mgr_get_rsc(struct rsc_mgr *mgr, enum DAIOTYP type)
522 if (((union daio_usage *)mgr->rscs)->data & (0x1 << type))
525 ((union daio_usage *)mgr->rscs)->data |= (0x1 << type);
530 static int daio_mgr_put_rsc(struct rsc_mgr *mgr, enum DAIOTYP type)
532 ((union daio_usage *)mgr->rscs)->data &= ~(0x1 << type);
537 static int get_daio_rsc(struct daio_mgr *mgr,
538 const struct daio_desc *desc,
542 struct dai *dai = NULL;
543 struct dao *dao = NULL;
548 /* Check whether there are sufficient daio resources to meet request. */
549 spin_lock_irqsave(&mgr->mgr_lock, flags);
550 err = daio_mgr_get_rsc(&mgr->mgr, desc->type);
551 spin_unlock_irqrestore(&mgr->mgr_lock, flags);
553 printk(KERN_ERR "Can't meet DAIO resource request!\n");
557 /* Allocate mem for daio resource */
558 if (desc->type <= DAIO_OUT_MAX) {
559 dao = kzalloc(sizeof(*dao), GFP_KERNEL);
564 err = dao_rsc_init(dao, desc, mgr);
570 dai = kzalloc(sizeof(*dai), GFP_KERNEL);
575 err = dai_rsc_init(dai, desc, mgr);
582 mgr->daio_enable(mgr, *rdaio);
583 mgr->commit_write(mgr);
593 spin_lock_irqsave(&mgr->mgr_lock, flags);
594 daio_mgr_put_rsc(&mgr->mgr, desc->type);
595 spin_unlock_irqrestore(&mgr->mgr_lock, flags);
599 static int put_daio_rsc(struct daio_mgr *mgr, struct daio *daio)
603 mgr->daio_disable(mgr, daio);
604 mgr->commit_write(mgr);
606 spin_lock_irqsave(&mgr->mgr_lock, flags);
607 daio_mgr_put_rsc(&mgr->mgr, daio->type);
608 spin_unlock_irqrestore(&mgr->mgr_lock, flags);
610 if (daio->type <= DAIO_OUT_MAX) {
611 dao_rsc_uninit(container_of(daio, struct dao, daio));
612 kfree(container_of(daio, struct dao, daio));
614 dai_rsc_uninit(container_of(daio, struct dai, daio));
615 kfree(container_of(daio, struct dai, daio));
621 static int daio_mgr_enb_daio(struct daio_mgr *mgr, struct daio *daio)
623 struct hw *hw = mgr->mgr.hw;
625 if (DAIO_OUT_MAX >= daio->type) {
626 hw->daio_mgr_enb_dao(mgr->mgr.ctrl_blk,
627 daio_device_index(daio->type, hw));
629 hw->daio_mgr_enb_dai(mgr->mgr.ctrl_blk,
630 daio_device_index(daio->type, hw));
635 static int daio_mgr_dsb_daio(struct daio_mgr *mgr, struct daio *daio)
637 struct hw *hw = mgr->mgr.hw;
639 if (DAIO_OUT_MAX >= daio->type) {
640 hw->daio_mgr_dsb_dao(mgr->mgr.ctrl_blk,
641 daio_device_index(daio->type, hw));
643 hw->daio_mgr_dsb_dai(mgr->mgr.ctrl_blk,
644 daio_device_index(daio->type, hw));
649 static int daio_map_op(void *data, struct imapper *entry)
651 struct rsc_mgr *mgr = &((struct daio_mgr *)data)->mgr;
652 struct hw *hw = mgr->hw;
654 hw->daio_mgr_set_imaparc(mgr->ctrl_blk, entry->slot);
655 hw->daio_mgr_set_imapnxt(mgr->ctrl_blk, entry->next);
656 hw->daio_mgr_set_imapaddr(mgr->ctrl_blk, entry->addr);
657 hw->daio_mgr_commit_write(mgr->hw, mgr->ctrl_blk);
662 static int daio_imap_add(struct daio_mgr *mgr, struct imapper *entry)
667 spin_lock_irqsave(&mgr->imap_lock, flags);
668 if (!entry->addr && mgr->init_imap_added) {
669 input_mapper_delete(&mgr->imappers, mgr->init_imap,
671 mgr->init_imap_added = 0;
673 err = input_mapper_add(&mgr->imappers, entry, daio_map_op, mgr);
674 spin_unlock_irqrestore(&mgr->imap_lock, flags);
679 static int daio_imap_delete(struct daio_mgr *mgr, struct imapper *entry)
684 spin_lock_irqsave(&mgr->imap_lock, flags);
685 err = input_mapper_delete(&mgr->imappers, entry, daio_map_op, mgr);
686 if (list_empty(&mgr->imappers)) {
687 input_mapper_add(&mgr->imappers, mgr->init_imap,
689 mgr->init_imap_added = 1;
691 spin_unlock_irqrestore(&mgr->imap_lock, flags);
696 static int daio_mgr_commit_write(struct daio_mgr *mgr)
698 struct hw *hw = mgr->mgr.hw;
700 hw->daio_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
704 int daio_mgr_create(void *hw, struct daio_mgr **rdaio_mgr)
707 struct daio_mgr *daio_mgr;
708 struct imapper *entry;
711 daio_mgr = kzalloc(sizeof(*daio_mgr), GFP_KERNEL);
715 err = rsc_mgr_init(&daio_mgr->mgr, DAIO, DAIO_RESOURCE_NUM, hw);
719 spin_lock_init(&daio_mgr->mgr_lock);
720 spin_lock_init(&daio_mgr->imap_lock);
721 INIT_LIST_HEAD(&daio_mgr->imappers);
722 entry = kzalloc(sizeof(*entry), GFP_KERNEL);
727 entry->slot = entry->addr = entry->next = entry->user = 0;
728 list_add(&entry->list, &daio_mgr->imappers);
729 daio_mgr->init_imap = entry;
730 daio_mgr->init_imap_added = 1;
732 daio_mgr->get_daio = get_daio_rsc;
733 daio_mgr->put_daio = put_daio_rsc;
734 daio_mgr->daio_enable = daio_mgr_enb_daio;
735 daio_mgr->daio_disable = daio_mgr_dsb_daio;
736 daio_mgr->imap_add = daio_imap_add;
737 daio_mgr->imap_delete = daio_imap_delete;
738 daio_mgr->commit_write = daio_mgr_commit_write;
740 for (i = 0; i < 8; i++) {
741 ((struct hw *)hw)->daio_mgr_dsb_dao(daio_mgr->mgr.ctrl_blk, i);
742 ((struct hw *)hw)->daio_mgr_dsb_dai(daio_mgr->mgr.ctrl_blk, i);
744 ((struct hw *)hw)->daio_mgr_commit_write(hw, daio_mgr->mgr.ctrl_blk);
746 *rdaio_mgr = daio_mgr;
751 rsc_mgr_uninit(&daio_mgr->mgr);
757 int daio_mgr_destroy(struct daio_mgr *daio_mgr)
761 /* free daio input mapper list */
762 spin_lock_irqsave(&daio_mgr->imap_lock, flags);
763 free_input_mapper_list(&daio_mgr->imappers);
764 spin_unlock_irqrestore(&daio_mgr->imap_lock, flags);
766 rsc_mgr_uninit(&daio_mgr->mgr);