blob: f05a09ed42b8da25eb80e7610aaa8c82bea0eff6 [file] [log] [blame]
Wai Yew CHAY8cc72362009-05-14 08:05:58 +02001/**
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 */
26static int
27get_resource(u8 *rscs, unsigned int amount,
28 unsigned int multi, unsigned int *ridx)
29{
Takashi Iwai514eef92009-06-08 14:57:57 +020030 int i, j, k, n;
Wai Yew CHAY8cc72362009-05-14 08:05:58 +020031
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
62static int put_resource(u8 *rscs, unsigned int multi, unsigned int idx)
63{
Takashi Iwai514eef92009-06-08 14:57:57 +020064 unsigned int i, j, k, n;
Wai Yew CHAY8cc72362009-05-14 08:05:58 +020065
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
77int mgr_get_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int *ridx)
78{
Takashi Iwai514eef92009-06-08 14:57:57 +020079 int err;
Wai Yew CHAY8cc72362009-05-14 08:05:58 +020080
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
91int 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
99static 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
106static int rsc_index(const struct rsc *rsc)
107{
108 return rsc->conj;
109}
110
111static int audio_ring_slot(const struct rsc *rsc)
112{
113 return (rsc->conj << 4) + offset_in_audio_slot_block[rsc->type];
114}
115
Takashi Iwaifcf9e1d2021-11-18 22:57:29 +0100116static void rsc_next_conj(struct rsc *rsc)
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200117{
118 unsigned int i;
119 for (i = 0; (i < 8) && (!(rsc->msr & (0x1 << i))); )
120 i++;
121 rsc->conj += (AUDIO_SLOT_BLOCK_NUM >> i);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200122}
123
Takashi Iwaifcf9e1d2021-11-18 22:57:29 +0100124static void rsc_master(struct rsc *rsc)
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200125{
Takashi Iwaifcf9e1d2021-11-18 22:57:29 +0100126 rsc->conj = rsc->idx;
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200127}
128
Julia Lawall43f2cde2015-11-08 23:40:41 +0100129static const struct rsc_ops rsc_generic_ops = {
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200130 .index = rsc_index,
131 .output_slot = audio_ring_slot,
132 .master = rsc_master,
133 .next_conj = rsc_next_conj,
134};
135
Sudip Mukherjee66640892014-09-29 14:33:21 +0530136int
137rsc_init(struct rsc *rsc, u32 idx, enum RSCTYP type, u32 msr, struct hw *hw)
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200138{
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;
Takashi Iwai35ebf6e2009-07-22 17:12:34 +0200147 if (!hw) {
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200148 rsc->ctrl_blk = NULL;
149 return 0;
150 }
151
152 switch (type) {
153 case SRC:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530154 err = hw->src_rsc_get_ctrl_blk(&rsc->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200155 break;
156 case AMIXER:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530157 err = hw->amixer_rsc_get_ctrl_blk(&rsc->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200158 break;
159 case SRCIMP:
160 case SUM:
161 case DAIO:
162 break;
163 default:
Sudip Mukherjee0cae90a2014-09-29 14:33:26 +0530164 dev_err(((struct hw *)hw)->card->dev,
165 "Invalid resource type value %d!\n", type);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200166 return -EINVAL;
167 }
168
169 if (err) {
Sudip Mukherjee0cae90a2014-09-29 14:33:26 +0530170 dev_err(((struct hw *)hw)->card->dev,
171 "Failed to get resource control block!\n");
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200172 return err;
173 }
174
175 return 0;
176}
177
178int rsc_uninit(struct rsc *rsc)
179{
180 if ((NULL != rsc->hw) && (NULL != rsc->ctrl_blk)) {
181 switch (rsc->type) {
182 case SRC:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530183 rsc->hw->src_rsc_put_ctrl_blk(rsc->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200184 break;
185 case AMIXER:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530186 rsc->hw->amixer_rsc_put_ctrl_blk(rsc->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200187 break;
188 case SUM:
189 case DAIO:
190 break;
191 default:
Sudip Mukherjee0cae90a2014-09-29 14:33:26 +0530192 dev_err(((struct hw *)rsc->hw)->card->dev,
193 "Invalid resource type value %d!\n",
Sudip Mukherjee62afa852014-08-26 19:01:43 +0530194 rsc->type);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200195 break;
196 }
197
198 rsc->hw = rsc->ctrl_blk = NULL;
199 }
200
201 rsc->idx = rsc->conj = 0;
202 rsc->type = NUM_RSCTYP;
203 rsc->msr = 0;
204
205 return 0;
206}
207
208int rsc_mgr_init(struct rsc_mgr *mgr, enum RSCTYP type,
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530209 unsigned int amount, struct hw *hw)
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200210{
211 int err = 0;
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200212
213 mgr->type = NUM_RSCTYP;
214
215 mgr->rscs = kzalloc(((amount + 8 - 1) / 8), GFP_KERNEL);
Takashi Iwai35ebf6e2009-07-22 17:12:34 +0200216 if (!mgr->rscs)
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200217 return -ENOMEM;
218
219 switch (type) {
220 case SRC:
221 err = hw->src_mgr_get_ctrl_blk(&mgr->ctrl_blk);
222 break;
223 case SRCIMP:
224 err = hw->srcimp_mgr_get_ctrl_blk(&mgr->ctrl_blk);
225 break;
226 case AMIXER:
227 err = hw->amixer_mgr_get_ctrl_blk(&mgr->ctrl_blk);
228 break;
229 case DAIO:
230 err = hw->daio_mgr_get_ctrl_blk(hw, &mgr->ctrl_blk);
231 break;
232 case SUM:
233 break;
234 default:
Sudip Mukherjee0cae90a2014-09-29 14:33:26 +0530235 dev_err(hw->card->dev,
236 "Invalid resource type value %d!\n", type);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200237 err = -EINVAL;
238 goto error;
239 }
240
241 if (err) {
Sudip Mukherjee0cae90a2014-09-29 14:33:26 +0530242 dev_err(hw->card->dev,
243 "Failed to get manager control block!\n");
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200244 goto error;
245 }
246
247 mgr->type = type;
248 mgr->avail = mgr->amount = amount;
249 mgr->hw = hw;
250
251 return 0;
252
253error:
254 kfree(mgr->rscs);
255 return err;
256}
257
258int rsc_mgr_uninit(struct rsc_mgr *mgr)
259{
Himanshu Jha39cdc622017-08-31 20:36:42 +0530260 kfree(mgr->rscs);
261 mgr->rscs = NULL;
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200262
263 if ((NULL != mgr->hw) && (NULL != mgr->ctrl_blk)) {
264 switch (mgr->type) {
265 case SRC:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530266 mgr->hw->src_mgr_put_ctrl_blk(mgr->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200267 break;
268 case SRCIMP:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530269 mgr->hw->srcimp_mgr_put_ctrl_blk(mgr->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200270 break;
271 case AMIXER:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530272 mgr->hw->amixer_mgr_put_ctrl_blk(mgr->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200273 break;
274 case DAIO:
Sudip Mukherjeeb6bfe862014-09-29 14:33:22 +0530275 mgr->hw->daio_mgr_put_ctrl_blk(mgr->ctrl_blk);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200276 break;
277 case SUM:
278 break;
279 default:
Sudip Mukherjee0cae90a2014-09-29 14:33:26 +0530280 dev_err(((struct hw *)mgr->hw)->card->dev,
281 "Invalid resource type value %d!\n",
Sudip Mukherjee62afa852014-08-26 19:01:43 +0530282 mgr->type);
Wai Yew CHAY8cc72362009-05-14 08:05:58 +0200283 break;
284 }
285
286 mgr->hw = mgr->ctrl_blk = NULL;
287 }
288
289 mgr->type = NUM_RSCTYP;
290 mgr->avail = mgr->amount = 0;
291
292 return 0;
293}