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 some generic helper functions.
18 #include "ctresource.h"
19 #include "cthardware.h"
20 #include <linux/err.h>
21 #include <linux/slab.h>
23 #define AUDIO_SLOT_BLOCK_NUM 256
25 /* Resource allocation based on bit-map management mechanism */
27 get_resource(u8 *rscs, unsigned int amount,
28 unsigned int multi, unsigned int *ridx)
32 /* Check whether there are sufficient resources to meet request. */
33 for (i = 0, n = multi; i < amount; i++) {
36 if (rscs[j] & ((u8)1 << k)) {
41 break; /* found sufficient contiguous resources */
45 /* Can not find sufficient contiguous resources */
49 /* Mark the contiguous bits in resource bit-map as used */
50 for (n = multi; n > 0; n--) {
53 rscs[j] |= ((u8)1 << k);
62 static int put_resource(u8 *rscs, unsigned int multi, unsigned int idx)
64 unsigned int i, j, k, n;
66 /* Mark the contiguous bits in resource bit-map as used */
67 for (n = multi, i = idx; n > 0; n--) {
70 rscs[j] &= ~((u8)1 << k);
77 int mgr_get_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int *ridx)
84 err = get_resource(mgr->rscs, mgr->amount, n, ridx);
91 int mgr_put_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int idx)
93 put_resource(mgr->rscs, n, idx);
99 static unsigned char offset_in_audio_slot_block[NUM_RSCTYP] = {
100 /* SRC channel is at Audio Ring slot 1 every 16 slots. */
106 static int rsc_index(const struct rsc *rsc)
111 static int audio_ring_slot(const struct rsc *rsc)
113 return (rsc->conj << 4) + offset_in_audio_slot_block[rsc->type];
116 static int rsc_next_conj(struct rsc *rsc)
119 for (i = 0; (i < 8) && (!(rsc->msr & (0x1 << i))); )
121 rsc->conj += (AUDIO_SLOT_BLOCK_NUM >> i);
125 static int rsc_master(struct rsc *rsc)
127 return rsc->conj = rsc->idx;
130 static struct rsc_ops rsc_generic_ops = {
132 .output_slot = audio_ring_slot,
133 .master = rsc_master,
134 .next_conj = rsc_next_conj,
138 rsc_init(struct rsc *rsc, u32 idx, enum RSCTYP type, u32 msr, struct hw *hw)
147 rsc->ops = &rsc_generic_ops;
149 rsc->ctrl_blk = NULL;
155 err = hw->src_rsc_get_ctrl_blk(&rsc->ctrl_blk);
158 err = hw->amixer_rsc_get_ctrl_blk(&rsc->ctrl_blk);
165 dev_err(((struct hw *)hw)->card->dev,
166 "Invalid resource type value %d!\n", type);
171 dev_err(((struct hw *)hw)->card->dev,
172 "Failed to get resource control block!\n");
179 int rsc_uninit(struct rsc *rsc)
181 if ((NULL != rsc->hw) && (NULL != rsc->ctrl_blk)) {
184 rsc->hw->src_rsc_put_ctrl_blk(rsc->ctrl_blk);
187 rsc->hw->amixer_rsc_put_ctrl_blk(rsc->ctrl_blk);
193 dev_err(((struct hw *)rsc->hw)->card->dev,
194 "Invalid resource type value %d!\n",
199 rsc->hw = rsc->ctrl_blk = NULL;
202 rsc->idx = rsc->conj = 0;
203 rsc->type = NUM_RSCTYP;
209 int rsc_mgr_init(struct rsc_mgr *mgr, enum RSCTYP type,
210 unsigned int amount, struct hw *hw)
214 mgr->type = NUM_RSCTYP;
216 mgr->rscs = kzalloc(((amount + 8 - 1) / 8), GFP_KERNEL);
222 err = hw->src_mgr_get_ctrl_blk(&mgr->ctrl_blk);
225 err = hw->srcimp_mgr_get_ctrl_blk(&mgr->ctrl_blk);
228 err = hw->amixer_mgr_get_ctrl_blk(&mgr->ctrl_blk);
231 err = hw->daio_mgr_get_ctrl_blk(hw, &mgr->ctrl_blk);
236 dev_err(hw->card->dev,
237 "Invalid resource type value %d!\n", type);
243 dev_err(hw->card->dev,
244 "Failed to get manager control block!\n");
249 mgr->avail = mgr->amount = amount;
259 int rsc_mgr_uninit(struct rsc_mgr *mgr)
261 if (NULL != mgr->rscs) {
266 if ((NULL != mgr->hw) && (NULL != mgr->ctrl_blk)) {
269 mgr->hw->src_mgr_put_ctrl_blk(mgr->ctrl_blk);
272 mgr->hw->srcimp_mgr_put_ctrl_blk(mgr->ctrl_blk);
275 mgr->hw->amixer_mgr_put_ctrl_blk(mgr->ctrl_blk);
278 mgr->hw->daio_mgr_put_ctrl_blk(mgr->ctrl_blk);
283 dev_err(((struct hw *)mgr->hw)->card->dev,
284 "Invalid resource type value %d!\n",
289 mgr->hw = mgr->ctrl_blk = NULL;
292 mgr->type = NUM_RSCTYP;
293 mgr->avail = mgr->amount = 0;