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