kernel/sound/pci/ctxfi/ctresource.c

   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        ctresource.c
   9  *
  10  * @Brief
  11  * This file contains the implementation of some generic helper functions.
  12  *
  13  * @Author      Liu Chun
  14  * @Date        May 15 2008
  15  *
  16  */
  17
  18 #include "ctresource.h"
  19 #include "cthardware.h"
  20 #include <linux/err.h>
  21 #include <linux/slab.h>
  22
  23 #define AUDIO_SLOT_BLOCK_NUM    256
  24
  25 /* Resource allocation based on bit-map management mechanism */
  26 static int
  27 get_resource(u8 *rscs, unsigned int amount,
  28              unsigned int multi, unsigned int *ridx)
  29 {
  30         int i, j, k, n;
  31
  32         /* Check whether there are sufficient resources to meet request. */
  33         for (i = 0, n = multi; i < amount; i++) {
  34                 j = i / 8;
  35                 k = i % 8;
  36                 if (rscs[j] & ((u8)1 << k)) {
  37                         n = multi;
  38                         continue;
  39                 }
  40                 if (!(--n))
  41                         break; /* found sufficient contiguous resources */
  42         }
  43
  44         if (i >= amount) {
  45                 /* Can not find sufficient contiguous resources */
  46                 return -ENOENT;
  47         }
  48
  49         /* Mark the contiguous bits in resource bit-map as used */
  50         for (n = multi; n > 0; n--) {
  51                 j = i / 8;
  52                 k = i % 8;
  53                 rscs[j] |= ((u8)1 << k);
  54                 i--;
  55         }
  56
  57         *ridx = i + 1;
  58
  59         return 0;
  60 }
  61
  62 static int put_resource(u8 *rscs, unsigned int multi, unsigned int idx)
  63 {
  64         unsigned int i, j, k, n;
  65
  66         /* Mark the contiguous bits in resource bit-map as used */
  67         for (n = multi, i = idx; n > 0; n--) {
  68                 j = i / 8;
  69                 k = i % 8;
  70                 rscs[j] &= ~((u8)1 << k);
  71                 i++;
  72         }
  73
  74         return 0;
  75 }
  76
  77 int mgr_get_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int *ridx)
  78 {
  79         int err;
  80
  81         if (n > mgr->avail)
  82                 return -ENOENT;
  83
  84         err = get_resource(mgr->rscs, mgr->amount, n, ridx);
  85         if (!err)
  86                 mgr->avail -= n;
  87
  88         return err;
  89 }
  90
  91 int mgr_put_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int idx)
  92 {
  93         put_resource(mgr->rscs, n, idx);
  94         mgr->avail += n;
  95
  96         return 0;
  97 }
  98
  99 static unsigned char offset_in_audio_slot_block[NUM_RSCTYP] = {
 100         /* SRC channel is at Audio Ring slot 1 every 16 slots. */
 101         [SRC]           = 0x1,
 102         [AMIXER]        = 0x4,
 103         [SUM]           = 0xc,
 104 };
 105
 106 static int rsc_index(const struct rsc *rsc)
 107 {
 108     return rsc->conj;
 109 }
 110
 111 static int audio_ring_slot(const struct rsc *rsc)
 112 {
 113     return (rsc->conj << 4) + offset_in_audio_slot_block[rsc->type];
 114 }
 115
 116 static int rsc_next_conj(struct rsc *rsc)
 117 {
 118         unsigned int i;
 119         for (i = 0; (i < 8) && (!(rsc->msr & (0x1 << i))); )
 120                 i++;
 121         rsc->conj += (AUDIO_SLOT_BLOCK_NUM >> i);
 122         return rsc->conj;
 123 }
 124
 125 static int rsc_master(struct rsc *rsc)
 126 {
 127         return rsc->conj = rsc->idx;
 128 }
 129
 130 static struct rsc_ops rsc_generic_ops = {
 131         .index          = rsc_index,
 132         .output_slot    = audio_ring_slot,
 133         .master         = rsc_master,
 134         .next_conj      = rsc_next_conj,
 135 };
 136
 137 int
 138 rsc_init(struct rsc *rsc, u32 idx, enum RSCTYP type, u32 msr, struct hw *hw)
 139 {
 140         int err = 0;
 141
 142         rsc->idx = idx;
 143         rsc->conj = idx;
 144         rsc->type = type;
 145         rsc->msr = msr;
 146         rsc->hw = hw;
 147         rsc->ops = &rsc_generic_ops;
 148         if (!hw) {
 149                 rsc->ctrl_blk = NULL;
 150                 return 0;
 151         }
 152
 153         switch (type) {
 154         case SRC:
 155                 err = hw->src_rsc_get_ctrl_blk(&rsc->ctrl_blk);
 156                 break;
 157         case AMIXER:
 158                 err = hw->amixer_rsc_get_ctrl_blk(&rsc->ctrl_blk);
 159                 break;
 160         case SRCIMP:
 161         case SUM:
 162         case DAIO:
 163                 break;
 164         default:
 165                 dev_err(((struct hw *)hw)->card->dev,
 166                         "Invalid resource type value %d!\n", type);
 167                 return -EINVAL;
 168         }
 169
 170         if (err) {
 171                 dev_err(((struct hw *)hw)->card->dev,
 172                         "Failed to get resource control block!\n");
 173                 return err;
 174         }
 175
 176         return 0;
 177 }
 178
 179 int rsc_uninit(struct rsc *rsc)
 180 {
 181         if ((NULL != rsc->hw) && (NULL != rsc->ctrl_blk)) {
 182                 switch (rsc->type) {
 183                 case SRC:
 184                         rsc->hw->src_rsc_put_ctrl_blk(rsc->ctrl_blk);
 185                         break;
 186                 case AMIXER:
 187                         rsc->hw->amixer_rsc_put_ctrl_blk(rsc->ctrl_blk);
 188                         break;
 189                 case SUM:
 190                 case DAIO:
 191                         break;
 192                 default:
 193                         dev_err(((struct hw *)rsc->hw)->card->dev,
 194                                 "Invalid resource type value %d!\n",
 195                                 rsc->type);
 196                         break;
 197                 }
 198
 199                 rsc->hw = rsc->ctrl_blk = NULL;
 200         }
 201
 202         rsc->idx = rsc->conj = 0;
 203         rsc->type = NUM_RSCTYP;
 204         rsc->msr = 0;
 205
 206         return 0;
 207 }
 208
 209 int rsc_mgr_init(struct rsc_mgr *mgr, enum RSCTYP type,
 210                  unsigned int amount, struct hw *hw)
 211 {
 212         int err = 0;
 213
 214         mgr->type = NUM_RSCTYP;
 215
 216         mgr->rscs = kzalloc(((amount + 8 - 1) / 8), GFP_KERNEL);
 217         if (!mgr->rscs)
 218                 return -ENOMEM;
 219
 220         switch (type) {
 221         case SRC:
 222                 err = hw->src_mgr_get_ctrl_blk(&mgr->ctrl_blk);
 223                 break;
 224         case SRCIMP:
 225                 err = hw->srcimp_mgr_get_ctrl_blk(&mgr->ctrl_blk);
 226                 break;
 227         case AMIXER:
 228                 err = hw->amixer_mgr_get_ctrl_blk(&mgr->ctrl_blk);
 229                 break;
 230         case DAIO:
 231                 err = hw->daio_mgr_get_ctrl_blk(hw, &mgr->ctrl_blk);
 232                 break;
 233         case SUM:
 234                 break;
 235         default:
 236                 dev_err(hw->card->dev,
 237                         "Invalid resource type value %d!\n", type);
 238                 err = -EINVAL;
 239                 goto error;
 240         }
 241
 242         if (err) {
 243                 dev_err(hw->card->dev,
 244                         "Failed to get manager control block!\n");
 245                 goto error;
 246         }
 247
 248         mgr->type = type;
 249         mgr->avail = mgr->amount = amount;
 250         mgr->hw = hw;
 251
 252         return 0;
 253
 254 error:
 255         kfree(mgr->rscs);
 256         return err;
 257 }
 258
 259 int rsc_mgr_uninit(struct rsc_mgr *mgr)
 260 {
 261         if (NULL != mgr->rscs) {
 262                 kfree(mgr->rscs);
 263                 mgr->rscs = NULL;
 264         }
 265
 266         if ((NULL != mgr->hw) && (NULL != mgr->ctrl_blk)) {
 267                 switch (mgr->type) {
 268                 case SRC:
 269                         mgr->hw->src_mgr_put_ctrl_blk(mgr->ctrl_blk);
 270                         break;
 271                 case SRCIMP:
 272                         mgr->hw->srcimp_mgr_put_ctrl_blk(mgr->ctrl_blk);
 273                         break;
 274                 case AMIXER:
 275                         mgr->hw->amixer_mgr_put_ctrl_blk(mgr->ctrl_blk);
 276                         break;
 277                 case DAIO:
 278                         mgr->hw->daio_mgr_put_ctrl_blk(mgr->ctrl_blk);
 279                         break;
 280                 case SUM:
 281                         break;
 282                 default:
 283                         dev_err(((struct hw *)mgr->hw)->card->dev,
 284                                 "Invalid resource type value %d!\n",
 285                                 mgr->type);
 286                         break;
 287                 }
 288
 289                 mgr->hw = mgr->ctrl_blk = NULL;
 290         }
 291
 292         mgr->type = NUM_RSCTYP;
 293         mgr->avail = mgr->amount = 0;
 294
 295         return 0;
 296 }