ALSA: ctxfi: More constifications
[muen/linux.git] / sound / pci / ctxfi / ctdaio.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /**
3  * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
4  *
5  * @File        ctdaio.c
6  *
7  * @Brief
8  * This file contains the implementation of Digital Audio Input Output
9  * resource management object.
10  *
11  * @Author      Liu Chun
12  * @Date        May 23 2008
13  */
14
15 #include "ctdaio.h"
16 #include "cthardware.h"
17 #include "ctimap.h"
18 #include <linux/slab.h>
19 #include <linux/kernel.h>
20
21 #define DAIO_OUT_MAX            SPDIFOO
22
23 struct daio_usage {
24         unsigned short data;
25 };
26
27 struct daio_rsc_idx {
28         unsigned short left;
29         unsigned short right;
30 };
31
32 static const struct daio_rsc_idx idx_20k1[NUM_DAIOTYP] = {
33         [LINEO1] = {.left = 0x00, .right = 0x01},
34         [LINEO2] = {.left = 0x18, .right = 0x19},
35         [LINEO3] = {.left = 0x08, .right = 0x09},
36         [LINEO4] = {.left = 0x10, .right = 0x11},
37         [LINEIM] = {.left = 0x1b5, .right = 0x1bd},
38         [SPDIFOO] = {.left = 0x20, .right = 0x21},
39         [SPDIFIO] = {.left = 0x15, .right = 0x1d},
40         [SPDIFI1] = {.left = 0x95, .right = 0x9d},
41 };
42
43 static const struct daio_rsc_idx idx_20k2[NUM_DAIOTYP] = {
44         [LINEO1] = {.left = 0x40, .right = 0x41},
45         [LINEO2] = {.left = 0x60, .right = 0x61},
46         [LINEO3] = {.left = 0x50, .right = 0x51},
47         [LINEO4] = {.left = 0x70, .right = 0x71},
48         [LINEIM] = {.left = 0x45, .right = 0xc5},
49         [MIC]    = {.left = 0x55, .right = 0xd5},
50         [SPDIFOO] = {.left = 0x00, .right = 0x01},
51         [SPDIFIO] = {.left = 0x05, .right = 0x85},
52 };
53
54 static int daio_master(struct rsc *rsc)
55 {
56         /* Actually, this is not the resource index of DAIO.
57          * For DAO, it is the input mapper index. And, for DAI,
58          * it is the output time-slot index. */
59         return rsc->conj = rsc->idx;
60 }
61
62 static int daio_index(const struct rsc *rsc)
63 {
64         return rsc->conj;
65 }
66
67 static int daio_out_next_conj(struct rsc *rsc)
68 {
69         return rsc->conj += 2;
70 }
71
72 static int daio_in_next_conj_20k1(struct rsc *rsc)
73 {
74         return rsc->conj += 0x200;
75 }
76
77 static int daio_in_next_conj_20k2(struct rsc *rsc)
78 {
79         return rsc->conj += 0x100;
80 }
81
82 static const struct rsc_ops daio_out_rsc_ops = {
83         .master         = daio_master,
84         .next_conj      = daio_out_next_conj,
85         .index          = daio_index,
86         .output_slot    = NULL,
87 };
88
89 static const struct rsc_ops daio_in_rsc_ops_20k1 = {
90         .master         = daio_master,
91         .next_conj      = daio_in_next_conj_20k1,
92         .index          = NULL,
93         .output_slot    = daio_index,
94 };
95
96 static const struct rsc_ops daio_in_rsc_ops_20k2 = {
97         .master         = daio_master,
98         .next_conj      = daio_in_next_conj_20k2,
99         .index          = NULL,
100         .output_slot    = daio_index,
101 };
102
103 static unsigned int daio_device_index(enum DAIOTYP type, struct hw *hw)
104 {
105         switch (hw->chip_type) {
106         case ATC20K1:
107                 switch (type) {
108                 case SPDIFOO:   return 0;
109                 case SPDIFIO:   return 0;
110                 case SPDIFI1:   return 1;
111                 case LINEO1:    return 4;
112                 case LINEO2:    return 7;
113                 case LINEO3:    return 5;
114                 case LINEO4:    return 6;
115                 case LINEIM:    return 7;
116                 default:        return -EINVAL;
117                 }
118         case ATC20K2:
119                 switch (type) {
120                 case SPDIFOO:   return 0;
121                 case SPDIFIO:   return 0;
122                 case LINEO1:    return 4;
123                 case LINEO2:    return 7;
124                 case LINEO3:    return 5;
125                 case LINEO4:    return 6;
126                 case LINEIM:    return 4;
127                 case MIC:       return 5;
128                 default:        return -EINVAL;
129                 }
130         default:
131                 return -EINVAL;
132         }
133 }
134
135 static int dao_rsc_reinit(struct dao *dao, const struct dao_desc *desc);
136
137 static int dao_spdif_get_spos(struct dao *dao, unsigned int *spos)
138 {
139         dao->hw->dao_get_spos(dao->ctrl_blk, spos);
140         return 0;
141 }
142
143 static int dao_spdif_set_spos(struct dao *dao, unsigned int spos)
144 {
145         dao->hw->dao_set_spos(dao->ctrl_blk, spos);
146         return 0;
147 }
148
149 static int dao_commit_write(struct dao *dao)
150 {
151         dao->hw->dao_commit_write(dao->hw,
152                 daio_device_index(dao->daio.type, dao->hw), dao->ctrl_blk);
153         return 0;
154 }
155
156 static int dao_set_left_input(struct dao *dao, struct rsc *input)
157 {
158         struct imapper *entry;
159         struct daio *daio = &dao->daio;
160         int i;
161
162         entry = kzalloc((sizeof(*entry) * daio->rscl.msr), GFP_KERNEL);
163         if (!entry)
164                 return -ENOMEM;
165
166         dao->ops->clear_left_input(dao);
167         /* Program master and conjugate resources */
168         input->ops->master(input);
169         daio->rscl.ops->master(&daio->rscl);
170         for (i = 0; i < daio->rscl.msr; i++, entry++) {
171                 entry->slot = input->ops->output_slot(input);
172                 entry->user = entry->addr = daio->rscl.ops->index(&daio->rscl);
173                 dao->mgr->imap_add(dao->mgr, entry);
174                 dao->imappers[i] = entry;
175
176                 input->ops->next_conj(input);
177                 daio->rscl.ops->next_conj(&daio->rscl);
178         }
179         input->ops->master(input);
180         daio->rscl.ops->master(&daio->rscl);
181
182         return 0;
183 }
184
185 static int dao_set_right_input(struct dao *dao, struct rsc *input)
186 {
187         struct imapper *entry;
188         struct daio *daio = &dao->daio;
189         int i;
190
191         entry = kzalloc((sizeof(*entry) * daio->rscr.msr), GFP_KERNEL);
192         if (!entry)
193                 return -ENOMEM;
194
195         dao->ops->clear_right_input(dao);
196         /* Program master and conjugate resources */
197         input->ops->master(input);
198         daio->rscr.ops->master(&daio->rscr);
199         for (i = 0; i < daio->rscr.msr; i++, entry++) {
200                 entry->slot = input->ops->output_slot(input);
201                 entry->user = entry->addr = daio->rscr.ops->index(&daio->rscr);
202                 dao->mgr->imap_add(dao->mgr, entry);
203                 dao->imappers[daio->rscl.msr + i] = entry;
204
205                 input->ops->next_conj(input);
206                 daio->rscr.ops->next_conj(&daio->rscr);
207         }
208         input->ops->master(input);
209         daio->rscr.ops->master(&daio->rscr);
210
211         return 0;
212 }
213
214 static int dao_clear_left_input(struct dao *dao)
215 {
216         struct imapper *entry;
217         struct daio *daio = &dao->daio;
218         int i;
219
220         if (!dao->imappers[0])
221                 return 0;
222
223         entry = dao->imappers[0];
224         dao->mgr->imap_delete(dao->mgr, entry);
225         /* Program conjugate resources */
226         for (i = 1; i < daio->rscl.msr; i++) {
227                 entry = dao->imappers[i];
228                 dao->mgr->imap_delete(dao->mgr, entry);
229                 dao->imappers[i] = NULL;
230         }
231
232         kfree(dao->imappers[0]);
233         dao->imappers[0] = NULL;
234
235         return 0;
236 }
237
238 static int dao_clear_right_input(struct dao *dao)
239 {
240         struct imapper *entry;
241         struct daio *daio = &dao->daio;
242         int i;
243
244         if (!dao->imappers[daio->rscl.msr])
245                 return 0;
246
247         entry = dao->imappers[daio->rscl.msr];
248         dao->mgr->imap_delete(dao->mgr, entry);
249         /* Program conjugate resources */
250         for (i = 1; i < daio->rscr.msr; i++) {
251                 entry = dao->imappers[daio->rscl.msr + i];
252                 dao->mgr->imap_delete(dao->mgr, entry);
253                 dao->imappers[daio->rscl.msr + i] = NULL;
254         }
255
256         kfree(dao->imappers[daio->rscl.msr]);
257         dao->imappers[daio->rscl.msr] = NULL;
258
259         return 0;
260 }
261
262 static const struct dao_rsc_ops dao_ops = {
263         .set_spos               = dao_spdif_set_spos,
264         .commit_write           = dao_commit_write,
265         .get_spos               = dao_spdif_get_spos,
266         .reinit                 = dao_rsc_reinit,
267         .set_left_input         = dao_set_left_input,
268         .set_right_input        = dao_set_right_input,
269         .clear_left_input       = dao_clear_left_input,
270         .clear_right_input      = dao_clear_right_input,
271 };
272
273 static int dai_set_srt_srcl(struct dai *dai, struct rsc *src)
274 {
275         src->ops->master(src);
276         dai->hw->dai_srt_set_srcm(dai->ctrl_blk, src->ops->index(src));
277         return 0;
278 }
279
280 static int dai_set_srt_srcr(struct dai *dai, struct rsc *src)
281 {
282         src->ops->master(src);
283         dai->hw->dai_srt_set_srco(dai->ctrl_blk, src->ops->index(src));
284         return 0;
285 }
286
287 static int dai_set_srt_msr(struct dai *dai, unsigned int msr)
288 {
289         unsigned int rsr;
290
291         for (rsr = 0; msr > 1; msr >>= 1)
292                 rsr++;
293
294         dai->hw->dai_srt_set_rsr(dai->ctrl_blk, rsr);
295         return 0;
296 }
297
298 static int dai_set_enb_src(struct dai *dai, unsigned int enb)
299 {
300         dai->hw->dai_srt_set_ec(dai->ctrl_blk, enb);
301         return 0;
302 }
303
304 static int dai_set_enb_srt(struct dai *dai, unsigned int enb)
305 {
306         dai->hw->dai_srt_set_et(dai->ctrl_blk, enb);
307         return 0;
308 }
309
310 static int dai_commit_write(struct dai *dai)
311 {
312         dai->hw->dai_commit_write(dai->hw,
313                 daio_device_index(dai->daio.type, dai->hw), dai->ctrl_blk);
314         return 0;
315 }
316
317 static const struct dai_rsc_ops dai_ops = {
318         .set_srt_srcl           = dai_set_srt_srcl,
319         .set_srt_srcr           = dai_set_srt_srcr,
320         .set_srt_msr            = dai_set_srt_msr,
321         .set_enb_src            = dai_set_enb_src,
322         .set_enb_srt            = dai_set_enb_srt,
323         .commit_write           = dai_commit_write,
324 };
325
326 static int daio_rsc_init(struct daio *daio,
327                          const struct daio_desc *desc,
328                          struct hw *hw)
329 {
330         int err;
331         unsigned int idx_l, idx_r;
332
333         switch (hw->chip_type) {
334         case ATC20K1:
335                 idx_l = idx_20k1[desc->type].left;
336                 idx_r = idx_20k1[desc->type].right;
337                 break;
338         case ATC20K2:
339                 idx_l = idx_20k2[desc->type].left;
340                 idx_r = idx_20k2[desc->type].right;
341                 break;
342         default:
343                 return -EINVAL;
344         }
345         err = rsc_init(&daio->rscl, idx_l, DAIO, desc->msr, hw);
346         if (err)
347                 return err;
348
349         err = rsc_init(&daio->rscr, idx_r, DAIO, desc->msr, hw);
350         if (err)
351                 goto error1;
352
353         /* Set daio->rscl/r->ops to daio specific ones */
354         if (desc->type <= DAIO_OUT_MAX) {
355                 daio->rscl.ops = daio->rscr.ops = &daio_out_rsc_ops;
356         } else {
357                 switch (hw->chip_type) {
358                 case ATC20K1:
359                         daio->rscl.ops = daio->rscr.ops = &daio_in_rsc_ops_20k1;
360                         break;
361                 case ATC20K2:
362                         daio->rscl.ops = daio->rscr.ops = &daio_in_rsc_ops_20k2;
363                         break;
364                 default:
365                         break;
366                 }
367         }
368         daio->type = desc->type;
369
370         return 0;
371
372 error1:
373         rsc_uninit(&daio->rscl);
374         return err;
375 }
376
377 static int daio_rsc_uninit(struct daio *daio)
378 {
379         rsc_uninit(&daio->rscl);
380         rsc_uninit(&daio->rscr);
381
382         return 0;
383 }
384
385 static int dao_rsc_init(struct dao *dao,
386                         const struct daio_desc *desc,
387                         struct daio_mgr *mgr)
388 {
389         struct hw *hw = mgr->mgr.hw;
390         unsigned int conf;
391         int err;
392
393         err = daio_rsc_init(&dao->daio, desc, mgr->mgr.hw);
394         if (err)
395                 return err;
396
397         dao->imappers = kzalloc(array3_size(sizeof(void *), desc->msr, 2),
398                                 GFP_KERNEL);
399         if (!dao->imappers) {
400                 err = -ENOMEM;
401                 goto error1;
402         }
403         dao->ops = &dao_ops;
404         dao->mgr = mgr;
405         dao->hw = hw;
406         err = hw->dao_get_ctrl_blk(&dao->ctrl_blk);
407         if (err)
408                 goto error2;
409
410         hw->daio_mgr_dsb_dao(mgr->mgr.ctrl_blk,
411                         daio_device_index(dao->daio.type, hw));
412         hw->daio_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
413
414         conf = (desc->msr & 0x7) | (desc->passthru << 3);
415         hw->daio_mgr_dao_init(mgr->mgr.ctrl_blk,
416                         daio_device_index(dao->daio.type, hw), conf);
417         hw->daio_mgr_enb_dao(mgr->mgr.ctrl_blk,
418                         daio_device_index(dao->daio.type, hw));
419         hw->daio_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
420
421         return 0;
422
423 error2:
424         kfree(dao->imappers);
425         dao->imappers = NULL;
426 error1:
427         daio_rsc_uninit(&dao->daio);
428         return err;
429 }
430
431 static int dao_rsc_uninit(struct dao *dao)
432 {
433         if (dao->imappers) {
434                 if (dao->imappers[0])
435                         dao_clear_left_input(dao);
436
437                 if (dao->imappers[dao->daio.rscl.msr])
438                         dao_clear_right_input(dao);
439
440                 kfree(dao->imappers);
441                 dao->imappers = NULL;
442         }
443         dao->hw->dao_put_ctrl_blk(dao->ctrl_blk);
444         dao->hw = dao->ctrl_blk = NULL;
445         daio_rsc_uninit(&dao->daio);
446
447         return 0;
448 }
449
450 static int dao_rsc_reinit(struct dao *dao, const struct dao_desc *desc)
451 {
452         struct daio_mgr *mgr = dao->mgr;
453         struct daio_desc dsc = {0};
454
455         dsc.type = dao->daio.type;
456         dsc.msr = desc->msr;
457         dsc.passthru = desc->passthru;
458         dao_rsc_uninit(dao);
459         return dao_rsc_init(dao, &dsc, mgr);
460 }
461
462 static int dai_rsc_init(struct dai *dai,
463                         const struct daio_desc *desc,
464                         struct daio_mgr *mgr)
465 {
466         int err;
467         struct hw *hw = mgr->mgr.hw;
468         unsigned int rsr, msr;
469
470         err = daio_rsc_init(&dai->daio, desc, mgr->mgr.hw);
471         if (err)
472                 return err;
473
474         dai->ops = &dai_ops;
475         dai->hw = mgr->mgr.hw;
476         err = hw->dai_get_ctrl_blk(&dai->ctrl_blk);
477         if (err)
478                 goto error1;
479
480         for (rsr = 0, msr = desc->msr; msr > 1; msr >>= 1)
481                 rsr++;
482
483         hw->dai_srt_set_rsr(dai->ctrl_blk, rsr);
484         hw->dai_srt_set_drat(dai->ctrl_blk, 0);
485         /* default to disabling control of a SRC */
486         hw->dai_srt_set_ec(dai->ctrl_blk, 0);
487         hw->dai_srt_set_et(dai->ctrl_blk, 0); /* default to disabling SRT */
488         hw->dai_commit_write(hw,
489                 daio_device_index(dai->daio.type, dai->hw), dai->ctrl_blk);
490
491         return 0;
492
493 error1:
494         daio_rsc_uninit(&dai->daio);
495         return err;
496 }
497
498 static int dai_rsc_uninit(struct dai *dai)
499 {
500         dai->hw->dai_put_ctrl_blk(dai->ctrl_blk);
501         dai->hw = dai->ctrl_blk = NULL;
502         daio_rsc_uninit(&dai->daio);
503         return 0;
504 }
505
506 static int daio_mgr_get_rsc(struct rsc_mgr *mgr, enum DAIOTYP type)
507 {
508         if (((struct daio_usage *)mgr->rscs)->data & (0x1 << type))
509                 return -ENOENT;
510
511         ((struct daio_usage *)mgr->rscs)->data |= (0x1 << type);
512
513         return 0;
514 }
515
516 static int daio_mgr_put_rsc(struct rsc_mgr *mgr, enum DAIOTYP type)
517 {
518         ((struct daio_usage *)mgr->rscs)->data &= ~(0x1 << type);
519
520         return 0;
521 }
522
523 static int get_daio_rsc(struct daio_mgr *mgr,
524                         const struct daio_desc *desc,
525                         struct daio **rdaio)
526 {
527         int err;
528         unsigned long flags;
529
530         *rdaio = NULL;
531
532         /* Check whether there are sufficient daio resources to meet request. */
533         spin_lock_irqsave(&mgr->mgr_lock, flags);
534         err = daio_mgr_get_rsc(&mgr->mgr, desc->type);
535         spin_unlock_irqrestore(&mgr->mgr_lock, flags);
536         if (err) {
537                 dev_err(mgr->card->dev,
538                         "Can't meet DAIO resource request!\n");
539                 return err;
540         }
541
542         err = -ENOMEM;
543         /* Allocate mem for daio resource */
544         if (desc->type <= DAIO_OUT_MAX) {
545                 struct dao *dao = kzalloc(sizeof(*dao), GFP_KERNEL);
546                 if (!dao)
547                         goto error;
548
549                 err = dao_rsc_init(dao, desc, mgr);
550                 if (err) {
551                         kfree(dao);
552                         goto error;
553                 }
554
555                 *rdaio = &dao->daio;
556         } else {
557                 struct dai *dai = kzalloc(sizeof(*dai), GFP_KERNEL);
558                 if (!dai)
559                         goto error;
560
561                 err = dai_rsc_init(dai, desc, mgr);
562                 if (err) {
563                         kfree(dai);
564                         goto error;
565                 }
566
567                 *rdaio = &dai->daio;
568         }
569
570         mgr->daio_enable(mgr, *rdaio);
571         mgr->commit_write(mgr);
572
573         return 0;
574
575 error:
576         spin_lock_irqsave(&mgr->mgr_lock, flags);
577         daio_mgr_put_rsc(&mgr->mgr, desc->type);
578         spin_unlock_irqrestore(&mgr->mgr_lock, flags);
579         return err;
580 }
581
582 static int put_daio_rsc(struct daio_mgr *mgr, struct daio *daio)
583 {
584         unsigned long flags;
585
586         mgr->daio_disable(mgr, daio);
587         mgr->commit_write(mgr);
588
589         spin_lock_irqsave(&mgr->mgr_lock, flags);
590         daio_mgr_put_rsc(&mgr->mgr, daio->type);
591         spin_unlock_irqrestore(&mgr->mgr_lock, flags);
592
593         if (daio->type <= DAIO_OUT_MAX) {
594                 dao_rsc_uninit(container_of(daio, struct dao, daio));
595                 kfree(container_of(daio, struct dao, daio));
596         } else {
597                 dai_rsc_uninit(container_of(daio, struct dai, daio));
598                 kfree(container_of(daio, struct dai, daio));
599         }
600
601         return 0;
602 }
603
604 static int daio_mgr_enb_daio(struct daio_mgr *mgr, struct daio *daio)
605 {
606         struct hw *hw = mgr->mgr.hw;
607
608         if (DAIO_OUT_MAX >= daio->type) {
609                 hw->daio_mgr_enb_dao(mgr->mgr.ctrl_blk,
610                                 daio_device_index(daio->type, hw));
611         } else {
612                 hw->daio_mgr_enb_dai(mgr->mgr.ctrl_blk,
613                                 daio_device_index(daio->type, hw));
614         }
615         return 0;
616 }
617
618 static int daio_mgr_dsb_daio(struct daio_mgr *mgr, struct daio *daio)
619 {
620         struct hw *hw = mgr->mgr.hw;
621
622         if (DAIO_OUT_MAX >= daio->type) {
623                 hw->daio_mgr_dsb_dao(mgr->mgr.ctrl_blk,
624                                 daio_device_index(daio->type, hw));
625         } else {
626                 hw->daio_mgr_dsb_dai(mgr->mgr.ctrl_blk,
627                                 daio_device_index(daio->type, hw));
628         }
629         return 0;
630 }
631
632 static int daio_map_op(void *data, struct imapper *entry)
633 {
634         struct rsc_mgr *mgr = &((struct daio_mgr *)data)->mgr;
635         struct hw *hw = mgr->hw;
636
637         hw->daio_mgr_set_imaparc(mgr->ctrl_blk, entry->slot);
638         hw->daio_mgr_set_imapnxt(mgr->ctrl_blk, entry->next);
639         hw->daio_mgr_set_imapaddr(mgr->ctrl_blk, entry->addr);
640         hw->daio_mgr_commit_write(mgr->hw, mgr->ctrl_blk);
641
642         return 0;
643 }
644
645 static int daio_imap_add(struct daio_mgr *mgr, struct imapper *entry)
646 {
647         unsigned long flags;
648         int err;
649
650         spin_lock_irqsave(&mgr->imap_lock, flags);
651         if (!entry->addr && mgr->init_imap_added) {
652                 input_mapper_delete(&mgr->imappers, mgr->init_imap,
653                                                         daio_map_op, mgr);
654                 mgr->init_imap_added = 0;
655         }
656         err = input_mapper_add(&mgr->imappers, entry, daio_map_op, mgr);
657         spin_unlock_irqrestore(&mgr->imap_lock, flags);
658
659         return err;
660 }
661
662 static int daio_imap_delete(struct daio_mgr *mgr, struct imapper *entry)
663 {
664         unsigned long flags;
665         int err;
666
667         spin_lock_irqsave(&mgr->imap_lock, flags);
668         err = input_mapper_delete(&mgr->imappers, entry, daio_map_op, mgr);
669         if (list_empty(&mgr->imappers)) {
670                 input_mapper_add(&mgr->imappers, mgr->init_imap,
671                                                         daio_map_op, mgr);
672                 mgr->init_imap_added = 1;
673         }
674         spin_unlock_irqrestore(&mgr->imap_lock, flags);
675
676         return err;
677 }
678
679 static int daio_mgr_commit_write(struct daio_mgr *mgr)
680 {
681         struct hw *hw = mgr->mgr.hw;
682
683         hw->daio_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
684         return 0;
685 }
686
687 int daio_mgr_create(struct hw *hw, struct daio_mgr **rdaio_mgr)
688 {
689         int err, i;
690         struct daio_mgr *daio_mgr;
691         struct imapper *entry;
692
693         *rdaio_mgr = NULL;
694         daio_mgr = kzalloc(sizeof(*daio_mgr), GFP_KERNEL);
695         if (!daio_mgr)
696                 return -ENOMEM;
697
698         err = rsc_mgr_init(&daio_mgr->mgr, DAIO, NUM_DAIOTYP, hw);
699         if (err)
700                 goto error1;
701
702         spin_lock_init(&daio_mgr->mgr_lock);
703         spin_lock_init(&daio_mgr->imap_lock);
704         INIT_LIST_HEAD(&daio_mgr->imappers);
705         entry = kzalloc(sizeof(*entry), GFP_KERNEL);
706         if (!entry) {
707                 err = -ENOMEM;
708                 goto error2;
709         }
710         entry->slot = entry->addr = entry->next = entry->user = 0;
711         list_add(&entry->list, &daio_mgr->imappers);
712         daio_mgr->init_imap = entry;
713         daio_mgr->init_imap_added = 1;
714
715         daio_mgr->get_daio = get_daio_rsc;
716         daio_mgr->put_daio = put_daio_rsc;
717         daio_mgr->daio_enable = daio_mgr_enb_daio;
718         daio_mgr->daio_disable = daio_mgr_dsb_daio;
719         daio_mgr->imap_add = daio_imap_add;
720         daio_mgr->imap_delete = daio_imap_delete;
721         daio_mgr->commit_write = daio_mgr_commit_write;
722         daio_mgr->card = hw->card;
723
724         for (i = 0; i < 8; i++) {
725                 hw->daio_mgr_dsb_dao(daio_mgr->mgr.ctrl_blk, i);
726                 hw->daio_mgr_dsb_dai(daio_mgr->mgr.ctrl_blk, i);
727         }
728         hw->daio_mgr_commit_write(hw, daio_mgr->mgr.ctrl_blk);
729
730         *rdaio_mgr = daio_mgr;
731
732         return 0;
733
734 error2:
735         rsc_mgr_uninit(&daio_mgr->mgr);
736 error1:
737         kfree(daio_mgr);
738         return err;
739 }
740
741 int daio_mgr_destroy(struct daio_mgr *daio_mgr)
742 {
743         unsigned long flags;
744
745         /* free daio input mapper list */
746         spin_lock_irqsave(&daio_mgr->imap_lock, flags);
747         free_input_mapper_list(&daio_mgr->imappers);
748         spin_unlock_irqrestore(&daio_mgr->imap_lock, flags);
749
750         rsc_mgr_uninit(&daio_mgr->mgr);
751         kfree(daio_mgr);
752
753         return 0;
754 }
755