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 rsc_init(struct rsc *rsc, u32 idx, enum RSCTYP type, u32 msr, void *hw) 138 { 139 int err = 0; 140 141 rsc->idx = idx; 142 rsc->conj = idx; 143 rsc->type = type; 144 rsc->msr = msr; 145 rsc->hw = hw; 146 rsc->ops = &rsc_generic_ops; 147 if (!hw) { 148 rsc->ctrl_blk = NULL; 149 return 0; 150 } 151 152 switch (type) { 153 case SRC: 154 err = ((struct hw *)hw)->src_rsc_get_ctrl_blk(&rsc->ctrl_blk); 155 break; 156 case AMIXER: 157 err = ((struct hw *)hw)-> 158 amixer_rsc_get_ctrl_blk(&rsc->ctrl_blk); 159 break; 160 case SRCIMP: 161 case SUM: 162 case DAIO: 163 break; 164 default: 165 printk(KERN_ERR 166 "ctxfi: Invalid resource type value %d!\n", type); 167 return -EINVAL; 168 } 169 170 if (err) { 171 printk(KERN_ERR 172 "ctxfi: 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 ((struct hw *)rsc->hw)-> 185 src_rsc_put_ctrl_blk(rsc->ctrl_blk); 186 break; 187 case AMIXER: 188 ((struct hw *)rsc->hw)-> 189 amixer_rsc_put_ctrl_blk(rsc->ctrl_blk); 190 break; 191 case SUM: 192 case DAIO: 193 break; 194 default: 195 printk(KERN_ERR "ctxfi: " 196 "Invalid resource type value %d!\n", rsc->type); 197 break; 198 } 199 200 rsc->hw = rsc->ctrl_blk = NULL; 201 } 202 203 rsc->idx = rsc->conj = 0; 204 rsc->type = NUM_RSCTYP; 205 rsc->msr = 0; 206 207 return 0; 208 } 209 210 int rsc_mgr_init(struct rsc_mgr *mgr, enum RSCTYP type, 211 unsigned int amount, void *hw_obj) 212 { 213 int err = 0; 214 struct hw *hw = hw_obj; 215 216 mgr->type = NUM_RSCTYP; 217 218 mgr->rscs = kzalloc(((amount + 8 - 1) / 8), GFP_KERNEL); 219 if (!mgr->rscs) 220 return -ENOMEM; 221 222 switch (type) { 223 case SRC: 224 err = hw->src_mgr_get_ctrl_blk(&mgr->ctrl_blk); 225 break; 226 case SRCIMP: 227 err = hw->srcimp_mgr_get_ctrl_blk(&mgr->ctrl_blk); 228 break; 229 case AMIXER: 230 err = hw->amixer_mgr_get_ctrl_blk(&mgr->ctrl_blk); 231 break; 232 case DAIO: 233 err = hw->daio_mgr_get_ctrl_blk(hw, &mgr->ctrl_blk); 234 break; 235 case SUM: 236 break; 237 default: 238 printk(KERN_ERR 239 "ctxfi: Invalid resource type value %d!\n", type); 240 err = -EINVAL; 241 goto error; 242 } 243 244 if (err) { 245 printk(KERN_ERR 246 "ctxfi: Failed to get manager control block!\n"); 247 goto error; 248 } 249 250 mgr->type = type; 251 mgr->avail = mgr->amount = amount; 252 mgr->hw = hw; 253 254 return 0; 255 256 error: 257 kfree(mgr->rscs); 258 return err; 259 } 260 261 int rsc_mgr_uninit(struct rsc_mgr *mgr) 262 { 263 if (NULL != mgr->rscs) { 264 kfree(mgr->rscs); 265 mgr->rscs = NULL; 266 } 267 268 if ((NULL != mgr->hw) && (NULL != mgr->ctrl_blk)) { 269 switch (mgr->type) { 270 case SRC: 271 ((struct hw *)mgr->hw)-> 272 src_mgr_put_ctrl_blk(mgr->ctrl_blk); 273 break; 274 case SRCIMP: 275 ((struct hw *)mgr->hw)-> 276 srcimp_mgr_put_ctrl_blk(mgr->ctrl_blk); 277 break; 278 case AMIXER: 279 ((struct hw *)mgr->hw)-> 280 amixer_mgr_put_ctrl_blk(mgr->ctrl_blk); 281 break; 282 case DAIO: 283 ((struct hw *)mgr->hw)-> 284 daio_mgr_put_ctrl_blk(mgr->ctrl_blk); 285 break; 286 case SUM: 287 break; 288 default: 289 printk(KERN_ERR "ctxfi: " 290 "Invalid resource type value %d!\n", mgr->type); 291 break; 292 } 293 294 mgr->hw = mgr->ctrl_blk = NULL; 295 } 296 297 mgr->type = NUM_RSCTYP; 298 mgr->avail = mgr->amount = 0; 299 300 return 0; 301 } 302