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