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(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(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(hlink->ml_addr + AZX_REG_ML_LCAP);
98 		hlink->lsdiid = readw(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(&hlink->list, &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(&bus->hlink_list)) {
121 		hlink = list_first_entry(&bus->hlink_list, struct hdac_ext_link, list);
122 		list_del(&hlink->list);
123 		kfree(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(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, 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, 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(&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(&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(&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(&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(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