1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * hdac-ext-controller.c - HD-audio extended controller functions. |
4 | * |
5 | * Copyright (C) 2014-2015 Intel Corp |
6 | * Author: Jeeja KP <jeeja.kp@intel.com> |
7 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
8 | * |
9 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
10 | */ |
11 | |
12 | #include <linux/delay.h> |
13 | #include <linux/slab.h> |
14 | #include <sound/hda_register.h> |
15 | #include <sound/hdaudio_ext.h> |
16 | |
17 | /* |
18 | * processing pipe helpers - these helpers are useful for dealing with HDA |
19 | * new capability of processing pipelines |
20 | */ |
21 | |
22 | /** |
23 | * snd_hdac_ext_bus_ppcap_enable - enable/disable processing pipe capability |
24 | * @bus: the pointer to HDAC bus object |
25 | * @enable: flag to turn on/off the capability |
26 | */ |
27 | void snd_hdac_ext_bus_ppcap_enable(struct hdac_bus *bus, bool enable) |
28 | { |
29 | |
30 | if (!bus->ppcap) { |
31 | dev_err(bus->dev, "Address of PP capability is NULL" ); |
32 | return; |
33 | } |
34 | |
35 | if (enable) |
36 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, |
37 | AZX_PPCTL_GPROCEN, AZX_PPCTL_GPROCEN); |
38 | else |
39 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, |
40 | AZX_PPCTL_GPROCEN, 0); |
41 | } |
42 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_ppcap_enable); |
43 | |
44 | /** |
45 | * snd_hdac_ext_bus_ppcap_int_enable - ppcap interrupt enable/disable |
46 | * @bus: the pointer to HDAC bus object |
47 | * @enable: flag to enable/disable interrupt |
48 | */ |
49 | void snd_hdac_ext_bus_ppcap_int_enable(struct hdac_bus *bus, bool enable) |
50 | { |
51 | |
52 | if (!bus->ppcap) { |
53 | dev_err(bus->dev, "Address of PP capability is NULL\n" ); |
54 | return; |
55 | } |
56 | |
57 | if (enable) |
58 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, |
59 | AZX_PPCTL_PIE, AZX_PPCTL_PIE); |
60 | else |
61 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, |
62 | AZX_PPCTL_PIE, 0); |
63 | } |
64 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_ppcap_int_enable); |
65 | |
66 | /* |
67 | * Multilink helpers - these helpers are useful for dealing with HDA |
68 | * new multilink capability |
69 | */ |
70 | |
71 | /** |
72 | * snd_hdac_ext_bus_get_ml_capabilities - get multilink capability |
73 | * @bus: the pointer to HDAC bus object |
74 | * |
75 | * This will parse all links and read the mlink capabilities and add them |
76 | * in hlink_list of extended hdac bus |
77 | * Note: this will be freed on bus exit by driver |
78 | */ |
79 | int snd_hdac_ext_bus_get_ml_capabilities(struct hdac_bus *bus) |
80 | { |
81 | int idx; |
82 | u32 link_count; |
83 | struct hdac_ext_link *hlink; |
84 | |
85 | link_count = readl(addr: bus->mlcap + AZX_REG_ML_MLCD) + 1; |
86 | |
87 | dev_dbg(bus->dev, "In %s Link count: %d\n" , __func__, link_count); |
88 | |
89 | for (idx = 0; idx < link_count; idx++) { |
90 | hlink = kzalloc(size: sizeof(*hlink), GFP_KERNEL); |
91 | if (!hlink) |
92 | return -ENOMEM; |
93 | hlink->index = idx; |
94 | hlink->bus = bus; |
95 | hlink->ml_addr = bus->mlcap + AZX_ML_BASE + |
96 | (AZX_ML_INTERVAL * idx); |
97 | hlink->lcaps = readl(addr: hlink->ml_addr + AZX_REG_ML_LCAP); |
98 | hlink->lsdiid = readw(addr: hlink->ml_addr + AZX_REG_ML_LSDIID); |
99 | |
100 | /* since link in On, update the ref */ |
101 | hlink->ref_count = 1; |
102 | |
103 | list_add_tail(new: &hlink->list, head: &bus->hlink_list); |
104 | } |
105 | |
106 | return 0; |
107 | } |
108 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_ml_capabilities); |
109 | |
110 | /** |
111 | * snd_hdac_ext_link_free_all- free hdac extended link objects |
112 | * |
113 | * @bus: the pointer to HDAC bus object |
114 | */ |
115 | |
116 | void snd_hdac_ext_link_free_all(struct hdac_bus *bus) |
117 | { |
118 | struct hdac_ext_link *hlink; |
119 | |
120 | while (!list_empty(head: &bus->hlink_list)) { |
121 | hlink = list_first_entry(&bus->hlink_list, struct hdac_ext_link, list); |
122 | list_del(entry: &hlink->list); |
123 | kfree(objp: hlink); |
124 | } |
125 | } |
126 | EXPORT_SYMBOL_GPL(snd_hdac_ext_link_free_all); |
127 | |
128 | /** |
129 | * snd_hdac_ext_bus_get_hlink_by_addr - get hlink at specified address |
130 | * @bus: hlink's parent bus device |
131 | * @addr: codec device address |
132 | * |
133 | * Returns hlink object or NULL if matching hlink is not found. |
134 | */ |
135 | struct hdac_ext_link *snd_hdac_ext_bus_get_hlink_by_addr(struct hdac_bus *bus, int addr) |
136 | { |
137 | struct hdac_ext_link *hlink; |
138 | |
139 | list_for_each_entry(hlink, &bus->hlink_list, list) |
140 | if (hlink->lsdiid & (0x1 << addr)) |
141 | return hlink; |
142 | return NULL; |
143 | } |
144 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_hlink_by_addr); |
145 | |
146 | /** |
147 | * snd_hdac_ext_bus_get_hlink_by_name - get hlink based on codec name |
148 | * @bus: the pointer to HDAC bus object |
149 | * @codec_name: codec name |
150 | */ |
151 | struct hdac_ext_link *snd_hdac_ext_bus_get_hlink_by_name(struct hdac_bus *bus, |
152 | const char *codec_name) |
153 | { |
154 | int bus_idx, addr; |
155 | |
156 | if (sscanf(codec_name, "ehdaudio%dD%d" , &bus_idx, &addr) != 2) |
157 | return NULL; |
158 | if (bus->idx != bus_idx) |
159 | return NULL; |
160 | if (addr < 0 || addr > 31) |
161 | return NULL; |
162 | |
163 | return snd_hdac_ext_bus_get_hlink_by_addr(bus, addr); |
164 | } |
165 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_hlink_by_name); |
166 | |
167 | static int check_hdac_link_power_active(struct hdac_ext_link *hlink, bool enable) |
168 | { |
169 | int timeout; |
170 | u32 val; |
171 | int mask = (1 << AZX_ML_LCTL_CPA_SHIFT); |
172 | |
173 | udelay(3); |
174 | timeout = 150; |
175 | |
176 | do { |
177 | val = readl(addr: hlink->ml_addr + AZX_REG_ML_LCTL); |
178 | if (enable) { |
179 | if (((val & mask) >> AZX_ML_LCTL_CPA_SHIFT)) |
180 | return 0; |
181 | } else { |
182 | if (!((val & mask) >> AZX_ML_LCTL_CPA_SHIFT)) |
183 | return 0; |
184 | } |
185 | udelay(3); |
186 | } while (--timeout); |
187 | |
188 | return -EIO; |
189 | } |
190 | |
191 | /** |
192 | * snd_hdac_ext_bus_link_power_up -power up hda link |
193 | * @hlink: HD-audio extended link |
194 | */ |
195 | int snd_hdac_ext_bus_link_power_up(struct hdac_ext_link *hlink) |
196 | { |
197 | snd_hdac_updatel(hlink->ml_addr, AZX_REG_ML_LCTL, |
198 | AZX_ML_LCTL_SPA, AZX_ML_LCTL_SPA); |
199 | |
200 | return check_hdac_link_power_active(hlink, enable: true); |
201 | } |
202 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_up); |
203 | |
204 | /** |
205 | * snd_hdac_ext_bus_link_power_down -power down hda link |
206 | * @hlink: HD-audio extended link |
207 | */ |
208 | int snd_hdac_ext_bus_link_power_down(struct hdac_ext_link *hlink) |
209 | { |
210 | snd_hdac_updatel(hlink->ml_addr, AZX_REG_ML_LCTL, AZX_ML_LCTL_SPA, 0); |
211 | |
212 | return check_hdac_link_power_active(hlink, enable: false); |
213 | } |
214 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_down); |
215 | |
216 | /** |
217 | * snd_hdac_ext_bus_link_power_up_all -power up all hda link |
218 | * @bus: the pointer to HDAC bus object |
219 | */ |
220 | int snd_hdac_ext_bus_link_power_up_all(struct hdac_bus *bus) |
221 | { |
222 | struct hdac_ext_link *hlink = NULL; |
223 | int ret; |
224 | |
225 | list_for_each_entry(hlink, &bus->hlink_list, list) { |
226 | ret = snd_hdac_ext_bus_link_power_up(hlink); |
227 | if (ret < 0) |
228 | return ret; |
229 | } |
230 | |
231 | return 0; |
232 | } |
233 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_up_all); |
234 | |
235 | /** |
236 | * snd_hdac_ext_bus_link_power_down_all -power down all hda link |
237 | * @bus: the pointer to HDAC bus object |
238 | */ |
239 | int snd_hdac_ext_bus_link_power_down_all(struct hdac_bus *bus) |
240 | { |
241 | struct hdac_ext_link *hlink = NULL; |
242 | int ret; |
243 | |
244 | list_for_each_entry(hlink, &bus->hlink_list, list) { |
245 | ret = snd_hdac_ext_bus_link_power_down(hlink); |
246 | if (ret < 0) |
247 | return ret; |
248 | } |
249 | |
250 | return 0; |
251 | } |
252 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_down_all); |
253 | |
254 | /** |
255 | * snd_hdac_ext_bus_link_set_stream_id - maps stream id to link output |
256 | * @link: HD-audio ext link to set up |
257 | * @stream: stream id |
258 | */ |
259 | void snd_hdac_ext_bus_link_set_stream_id(struct hdac_ext_link *link, |
260 | int stream) |
261 | { |
262 | snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 1 << stream); |
263 | } |
264 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_set_stream_id); |
265 | |
266 | /** |
267 | * snd_hdac_ext_bus_link_clear_stream_id - maps stream id to link output |
268 | * @link: HD-audio ext link to set up |
269 | * @stream: stream id |
270 | */ |
271 | void snd_hdac_ext_bus_link_clear_stream_id(struct hdac_ext_link *link, |
272 | int stream) |
273 | { |
274 | snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 0); |
275 | } |
276 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_clear_stream_id); |
277 | |
278 | int snd_hdac_ext_bus_link_get(struct hdac_bus *bus, |
279 | struct hdac_ext_link *hlink) |
280 | { |
281 | unsigned long codec_mask; |
282 | int ret = 0; |
283 | |
284 | mutex_lock(&bus->lock); |
285 | |
286 | /* |
287 | * if we move from 0 to 1, count will be 1 so power up this link |
288 | * as well, also check the dma status and trigger that |
289 | */ |
290 | if (++hlink->ref_count == 1) { |
291 | if (!bus->cmd_dma_state) { |
292 | snd_hdac_bus_init_cmd_io(bus); |
293 | bus->cmd_dma_state = true; |
294 | } |
295 | |
296 | ret = snd_hdac_ext_bus_link_power_up(hlink); |
297 | |
298 | /* |
299 | * clear the register to invalidate all the output streams |
300 | */ |
301 | snd_hdac_updatew(hlink->ml_addr, AZX_REG_ML_LOSIDV, |
302 | AZX_ML_LOSIDV_STREAM_MASK, 0); |
303 | /* |
304 | * wait for 521usec for codec to report status |
305 | * HDA spec section 4.3 - Codec Discovery |
306 | */ |
307 | udelay(521); |
308 | codec_mask = snd_hdac_chip_readw(bus, STATESTS); |
309 | dev_dbg(bus->dev, "codec_mask = 0x%lx\n" , codec_mask); |
310 | snd_hdac_chip_writew(bus, STATESTS, codec_mask); |
311 | if (!bus->codec_mask) |
312 | bus->codec_mask = codec_mask; |
313 | } |
314 | |
315 | mutex_unlock(lock: &bus->lock); |
316 | return ret; |
317 | } |
318 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_get); |
319 | |
320 | int snd_hdac_ext_bus_link_put(struct hdac_bus *bus, |
321 | struct hdac_ext_link *hlink) |
322 | { |
323 | int ret = 0; |
324 | struct hdac_ext_link *hlink_tmp; |
325 | bool link_up = false; |
326 | |
327 | mutex_lock(&bus->lock); |
328 | |
329 | /* |
330 | * if we move from 1 to 0, count will be 0 |
331 | * so power down this link as well |
332 | */ |
333 | if (--hlink->ref_count == 0) { |
334 | ret = snd_hdac_ext_bus_link_power_down(hlink); |
335 | |
336 | /* |
337 | * now check if all links are off, if so turn off |
338 | * cmd dma as well |
339 | */ |
340 | list_for_each_entry(hlink_tmp, &bus->hlink_list, list) { |
341 | if (hlink_tmp->ref_count) { |
342 | link_up = true; |
343 | break; |
344 | } |
345 | } |
346 | |
347 | if (!link_up) { |
348 | snd_hdac_bus_stop_cmd_io(bus); |
349 | bus->cmd_dma_state = false; |
350 | } |
351 | } |
352 | |
353 | mutex_unlock(lock: &bus->lock); |
354 | return ret; |
355 | } |
356 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_put); |
357 | |
358 | static void hdac_ext_codec_link_up(struct hdac_device *codec) |
359 | { |
360 | const char *devname = dev_name(dev: &codec->dev); |
361 | struct hdac_ext_link *hlink = |
362 | snd_hdac_ext_bus_get_hlink_by_name(codec->bus, devname); |
363 | |
364 | if (hlink) |
365 | snd_hdac_ext_bus_link_get(codec->bus, hlink); |
366 | } |
367 | |
368 | static void hdac_ext_codec_link_down(struct hdac_device *codec) |
369 | { |
370 | const char *devname = dev_name(dev: &codec->dev); |
371 | struct hdac_ext_link *hlink = |
372 | snd_hdac_ext_bus_get_hlink_by_name(codec->bus, devname); |
373 | |
374 | if (hlink) |
375 | snd_hdac_ext_bus_link_put(codec->bus, hlink); |
376 | } |
377 | |
378 | void snd_hdac_ext_bus_link_power(struct hdac_device *codec, bool enable) |
379 | { |
380 | struct hdac_bus *bus = codec->bus; |
381 | bool oldstate = test_bit(codec->addr, &bus->codec_powered); |
382 | |
383 | if (enable == oldstate) |
384 | return; |
385 | |
386 | snd_hdac_bus_link_power(hdev: codec, enable); |
387 | |
388 | if (enable) |
389 | hdac_ext_codec_link_up(codec); |
390 | else |
391 | hdac_ext_codec_link_down(codec); |
392 | } |
393 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power); |
394 | |