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