1 // SPDX-License-Identifier: GPL-2.0 OR MIT
2 
3 /*
4  * Xen para-virtual sound device
5  *
6  * Copyright (C) 2016-2018 EPAM Systems Inc.
7  *
8  * Author: Oleksandr Andrushchenko <oleksandr_andrushchenko@epam.com>
9  */
10 
11 #include <xen/events.h>
12 #include <xen/grant_table.h>
13 #include <xen/xen.h>
14 #include <xen/xenbus.h>
15 
16 #include "xen_snd_front.h"
17 #include "xen_snd_front_alsa.h"
18 #include "xen_snd_front_cfg.h"
19 #include "xen_snd_front_evtchnl.h"
20 
evtchnl_interrupt_req(int irq,void * dev_id)21 static irqreturn_t evtchnl_interrupt_req(int irq, void *dev_id)
22 {
23 	struct xen_snd_front_evtchnl *channel = dev_id;
24 	struct xen_snd_front_info *front_info = channel->front_info;
25 	struct xensnd_resp *resp;
26 	RING_IDX i, rp;
27 
28 	if (unlikely(channel->state != EVTCHNL_STATE_CONNECTED))
29 		return IRQ_HANDLED;
30 
31 	mutex_lock(&channel->ring_io_lock);
32 
33 again:
34 	rp = channel->u.req.ring.sring->rsp_prod;
35 	/* Ensure we see queued responses up to rp. */
36 	rmb();
37 
38 	/*
39 	 * Assume that the backend is trusted to always write sane values
40 	 * to the ring counters, so no overflow checks on frontend side
41 	 * are required.
42 	 */
43 	for (i = channel->u.req.ring.rsp_cons; i != rp; i++) {
44 		resp = RING_GET_RESPONSE(&channel->u.req.ring, i);
45 		if (resp->id != channel->evt_id)
46 			continue;
47 		switch (resp->operation) {
48 		case XENSND_OP_OPEN:
49 		case XENSND_OP_CLOSE:
50 		case XENSND_OP_READ:
51 		case XENSND_OP_WRITE:
52 		case XENSND_OP_TRIGGER:
53 			channel->u.req.resp_status = resp->status;
54 			complete(&channel->u.req.completion);
55 			break;
56 		case XENSND_OP_HW_PARAM_QUERY:
57 			channel->u.req.resp_status = resp->status;
58 			channel->u.req.resp.hw_param =
59 					resp->resp.hw_param;
60 			complete(&channel->u.req.completion);
61 			break;
62 
63 		default:
64 			dev_err(&front_info->xb_dev->dev,
65 				"Operation %d is not supported\n",
66 				resp->operation);
67 			break;
68 		}
69 	}
70 
71 	channel->u.req.ring.rsp_cons = i;
72 	if (i != channel->u.req.ring.req_prod_pvt) {
73 		int more_to_do;
74 
75 		RING_FINAL_CHECK_FOR_RESPONSES(&channel->u.req.ring,
76 					       more_to_do);
77 		if (more_to_do)
78 			goto again;
79 	} else {
80 		channel->u.req.ring.sring->rsp_event = i + 1;
81 	}
82 
83 	mutex_unlock(&channel->ring_io_lock);
84 	return IRQ_HANDLED;
85 }
86 
evtchnl_interrupt_evt(int irq,void * dev_id)87 static irqreturn_t evtchnl_interrupt_evt(int irq, void *dev_id)
88 {
89 	struct xen_snd_front_evtchnl *channel = dev_id;
90 	struct xensnd_event_page *page = channel->u.evt.page;
91 	u32 cons, prod;
92 
93 	if (unlikely(channel->state != EVTCHNL_STATE_CONNECTED))
94 		return IRQ_HANDLED;
95 
96 	mutex_lock(&channel->ring_io_lock);
97 
98 	prod = page->in_prod;
99 	/* Ensure we see ring contents up to prod. */
100 	virt_rmb();
101 	if (prod == page->in_cons)
102 		goto out;
103 
104 	/*
105 	 * Assume that the backend is trusted to always write sane values
106 	 * to the ring counters, so no overflow checks on frontend side
107 	 * are required.
108 	 */
109 	for (cons = page->in_cons; cons != prod; cons++) {
110 		struct xensnd_evt *event;
111 
112 		event = &XENSND_IN_RING_REF(page, cons);
113 		if (unlikely(event->id != channel->evt_id++))
114 			continue;
115 
116 		switch (event->type) {
117 		case XENSND_EVT_CUR_POS:
118 			xen_snd_front_alsa_handle_cur_pos(channel,
119 							  event->op.cur_pos.position);
120 			break;
121 		}
122 	}
123 
124 	page->in_cons = cons;
125 	/* Ensure ring contents. */
126 	virt_wmb();
127 
128 out:
129 	mutex_unlock(&channel->ring_io_lock);
130 	return IRQ_HANDLED;
131 }
132 
xen_snd_front_evtchnl_flush(struct xen_snd_front_evtchnl * channel)133 void xen_snd_front_evtchnl_flush(struct xen_snd_front_evtchnl *channel)
134 {
135 	int notify;
136 
137 	channel->u.req.ring.req_prod_pvt++;
138 	RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&channel->u.req.ring, notify);
139 	if (notify)
140 		notify_remote_via_irq(channel->irq);
141 }
142 
evtchnl_free(struct xen_snd_front_info * front_info,struct xen_snd_front_evtchnl * channel)143 static void evtchnl_free(struct xen_snd_front_info *front_info,
144 			 struct xen_snd_front_evtchnl *channel)
145 {
146 	void *page = NULL;
147 
148 	if (channel->type == EVTCHNL_TYPE_REQ)
149 		page = channel->u.req.ring.sring;
150 	else if (channel->type == EVTCHNL_TYPE_EVT)
151 		page = channel->u.evt.page;
152 
153 	if (!page)
154 		return;
155 
156 	channel->state = EVTCHNL_STATE_DISCONNECTED;
157 	if (channel->type == EVTCHNL_TYPE_REQ) {
158 		/* Release all who still waits for response if any. */
159 		channel->u.req.resp_status = -EIO;
160 		complete_all(&channel->u.req.completion);
161 	}
162 
163 	if (channel->irq)
164 		unbind_from_irqhandler(channel->irq, channel);
165 
166 	if (channel->port)
167 		xenbus_free_evtchn(front_info->xb_dev, channel->port);
168 
169 	/* End access and free the page. */
170 	xenbus_teardown_ring(&page, 1, &channel->gref);
171 
172 	memset(channel, 0, sizeof(*channel));
173 }
174 
xen_snd_front_evtchnl_free_all(struct xen_snd_front_info * front_info)175 void xen_snd_front_evtchnl_free_all(struct xen_snd_front_info *front_info)
176 {
177 	int i;
178 
179 	if (!front_info->evt_pairs)
180 		return;
181 
182 	for (i = 0; i < front_info->num_evt_pairs; i++) {
183 		evtchnl_free(front_info, &front_info->evt_pairs[i].req);
184 		evtchnl_free(front_info, &front_info->evt_pairs[i].evt);
185 	}
186 
187 	kfree(front_info->evt_pairs);
188 	front_info->evt_pairs = NULL;
189 }
190 
evtchnl_alloc(struct xen_snd_front_info * front_info,int index,struct xen_snd_front_evtchnl * channel,enum xen_snd_front_evtchnl_type type)191 static int evtchnl_alloc(struct xen_snd_front_info *front_info, int index,
192 			 struct xen_snd_front_evtchnl *channel,
193 			 enum xen_snd_front_evtchnl_type type)
194 {
195 	struct xenbus_device *xb_dev = front_info->xb_dev;
196 	void *page;
197 	irq_handler_t handler;
198 	char *handler_name = NULL;
199 	int ret;
200 
201 	memset(channel, 0, sizeof(*channel));
202 	channel->type = type;
203 	channel->index = index;
204 	channel->front_info = front_info;
205 	channel->state = EVTCHNL_STATE_DISCONNECTED;
206 	ret = xenbus_setup_ring(xb_dev, GFP_KERNEL, &page, 1, &channel->gref);
207 	if (ret)
208 		goto fail;
209 
210 	handler_name = kasprintf(GFP_KERNEL, "%s-%s", XENSND_DRIVER_NAME,
211 				 type == EVTCHNL_TYPE_REQ ?
212 				 XENSND_FIELD_RING_REF :
213 				 XENSND_FIELD_EVT_RING_REF);
214 	if (!handler_name) {
215 		ret = -ENOMEM;
216 		goto fail;
217 	}
218 
219 	mutex_init(&channel->ring_io_lock);
220 
221 	if (type == EVTCHNL_TYPE_REQ) {
222 		struct xen_sndif_sring *sring = page;
223 
224 		init_completion(&channel->u.req.completion);
225 		mutex_init(&channel->u.req.req_io_lock);
226 		XEN_FRONT_RING_INIT(&channel->u.req.ring, sring, XEN_PAGE_SIZE);
227 
228 		handler = evtchnl_interrupt_req;
229 	} else {
230 		channel->u.evt.page = page;
231 		handler = evtchnl_interrupt_evt;
232 	}
233 
234 	ret = xenbus_alloc_evtchn(xb_dev, &channel->port);
235 	if (ret < 0)
236 		goto fail;
237 
238 	ret = bind_evtchn_to_irq(channel->port);
239 	if (ret < 0) {
240 		dev_err(&xb_dev->dev,
241 			"Failed to bind IRQ for domid %d port %d: %d\n",
242 			front_info->xb_dev->otherend_id, channel->port, ret);
243 		goto fail;
244 	}
245 
246 	channel->irq = ret;
247 
248 	ret = request_threaded_irq(channel->irq, NULL, handler,
249 				   IRQF_ONESHOT, handler_name, channel);
250 	if (ret < 0) {
251 		dev_err(&xb_dev->dev, "Failed to request IRQ %d: %d\n",
252 			channel->irq, ret);
253 		goto fail;
254 	}
255 
256 	kfree(handler_name);
257 	return 0;
258 
259 fail:
260 	kfree(handler_name);
261 	dev_err(&xb_dev->dev, "Failed to allocate ring: %d\n", ret);
262 	return ret;
263 }
264 
xen_snd_front_evtchnl_create_all(struct xen_snd_front_info * front_info,int num_streams)265 int xen_snd_front_evtchnl_create_all(struct xen_snd_front_info *front_info,
266 				     int num_streams)
267 {
268 	struct xen_front_cfg_card *cfg = &front_info->cfg;
269 	struct device *dev = &front_info->xb_dev->dev;
270 	int d, ret = 0;
271 
272 	front_info->evt_pairs =
273 			kcalloc(num_streams,
274 				sizeof(struct xen_snd_front_evtchnl_pair),
275 				GFP_KERNEL);
276 	if (!front_info->evt_pairs)
277 		return -ENOMEM;
278 
279 	/* Iterate over devices and their streams and create event channels. */
280 	for (d = 0; d < cfg->num_pcm_instances; d++) {
281 		struct xen_front_cfg_pcm_instance *pcm_instance;
282 		int s, index;
283 
284 		pcm_instance = &cfg->pcm_instances[d];
285 
286 		for (s = 0; s < pcm_instance->num_streams_pb; s++) {
287 			index = pcm_instance->streams_pb[s].index;
288 
289 			ret = evtchnl_alloc(front_info, index,
290 					    &front_info->evt_pairs[index].req,
291 					    EVTCHNL_TYPE_REQ);
292 			if (ret < 0) {
293 				dev_err(dev, "Error allocating control channel\n");
294 				goto fail;
295 			}
296 
297 			ret = evtchnl_alloc(front_info, index,
298 					    &front_info->evt_pairs[index].evt,
299 					    EVTCHNL_TYPE_EVT);
300 			if (ret < 0) {
301 				dev_err(dev, "Error allocating in-event channel\n");
302 				goto fail;
303 			}
304 		}
305 
306 		for (s = 0; s < pcm_instance->num_streams_cap; s++) {
307 			index = pcm_instance->streams_cap[s].index;
308 
309 			ret = evtchnl_alloc(front_info, index,
310 					    &front_info->evt_pairs[index].req,
311 					    EVTCHNL_TYPE_REQ);
312 			if (ret < 0) {
313 				dev_err(dev, "Error allocating control channel\n");
314 				goto fail;
315 			}
316 
317 			ret = evtchnl_alloc(front_info, index,
318 					    &front_info->evt_pairs[index].evt,
319 					    EVTCHNL_TYPE_EVT);
320 			if (ret < 0) {
321 				dev_err(dev, "Error allocating in-event channel\n");
322 				goto fail;
323 			}
324 		}
325 	}
326 
327 	front_info->num_evt_pairs = num_streams;
328 	return 0;
329 
330 fail:
331 	xen_snd_front_evtchnl_free_all(front_info);
332 	return ret;
333 }
334 
evtchnl_publish(struct xenbus_transaction xbt,struct xen_snd_front_evtchnl * channel,const char * path,const char * node_ring,const char * node_chnl)335 static int evtchnl_publish(struct xenbus_transaction xbt,
336 			   struct xen_snd_front_evtchnl *channel,
337 			   const char *path, const char *node_ring,
338 			   const char *node_chnl)
339 {
340 	struct xenbus_device *xb_dev = channel->front_info->xb_dev;
341 	int ret;
342 
343 	/* Write control channel ring reference. */
344 	ret = xenbus_printf(xbt, path, node_ring, "%u", channel->gref);
345 	if (ret < 0) {
346 		dev_err(&xb_dev->dev, "Error writing ring-ref: %d\n", ret);
347 		return ret;
348 	}
349 
350 	/* Write event channel ring reference. */
351 	ret = xenbus_printf(xbt, path, node_chnl, "%u", channel->port);
352 	if (ret < 0) {
353 		dev_err(&xb_dev->dev, "Error writing event channel: %d\n", ret);
354 		return ret;
355 	}
356 
357 	return 0;
358 }
359 
xen_snd_front_evtchnl_publish_all(struct xen_snd_front_info * front_info)360 int xen_snd_front_evtchnl_publish_all(struct xen_snd_front_info *front_info)
361 {
362 	struct xen_front_cfg_card *cfg = &front_info->cfg;
363 	struct xenbus_transaction xbt;
364 	int ret, d;
365 
366 again:
367 	ret = xenbus_transaction_start(&xbt);
368 	if (ret < 0) {
369 		xenbus_dev_fatal(front_info->xb_dev, ret,
370 				 "starting transaction");
371 		return ret;
372 	}
373 
374 	for (d = 0; d < cfg->num_pcm_instances; d++) {
375 		struct xen_front_cfg_pcm_instance *pcm_instance;
376 		int s, index;
377 
378 		pcm_instance = &cfg->pcm_instances[d];
379 
380 		for (s = 0; s < pcm_instance->num_streams_pb; s++) {
381 			index = pcm_instance->streams_pb[s].index;
382 
383 			ret = evtchnl_publish(xbt,
384 					      &front_info->evt_pairs[index].req,
385 					      pcm_instance->streams_pb[s].xenstore_path,
386 					      XENSND_FIELD_RING_REF,
387 					      XENSND_FIELD_EVT_CHNL);
388 			if (ret < 0)
389 				goto fail;
390 
391 			ret = evtchnl_publish(xbt,
392 					      &front_info->evt_pairs[index].evt,
393 					      pcm_instance->streams_pb[s].xenstore_path,
394 					      XENSND_FIELD_EVT_RING_REF,
395 					      XENSND_FIELD_EVT_EVT_CHNL);
396 			if (ret < 0)
397 				goto fail;
398 		}
399 
400 		for (s = 0; s < pcm_instance->num_streams_cap; s++) {
401 			index = pcm_instance->streams_cap[s].index;
402 
403 			ret = evtchnl_publish(xbt,
404 					      &front_info->evt_pairs[index].req,
405 					      pcm_instance->streams_cap[s].xenstore_path,
406 					      XENSND_FIELD_RING_REF,
407 					      XENSND_FIELD_EVT_CHNL);
408 			if (ret < 0)
409 				goto fail;
410 
411 			ret = evtchnl_publish(xbt,
412 					      &front_info->evt_pairs[index].evt,
413 					      pcm_instance->streams_cap[s].xenstore_path,
414 					      XENSND_FIELD_EVT_RING_REF,
415 					      XENSND_FIELD_EVT_EVT_CHNL);
416 			if (ret < 0)
417 				goto fail;
418 		}
419 	}
420 	ret = xenbus_transaction_end(xbt, 0);
421 	if (ret < 0) {
422 		if (ret == -EAGAIN)
423 			goto again;
424 
425 		xenbus_dev_fatal(front_info->xb_dev, ret,
426 				 "completing transaction");
427 		goto fail_to_end;
428 	}
429 	return 0;
430 fail:
431 	xenbus_transaction_end(xbt, 1);
432 fail_to_end:
433 	xenbus_dev_fatal(front_info->xb_dev, ret, "writing XenStore");
434 	return ret;
435 }
436 
xen_snd_front_evtchnl_pair_set_connected(struct xen_snd_front_evtchnl_pair * evt_pair,bool is_connected)437 void xen_snd_front_evtchnl_pair_set_connected(struct xen_snd_front_evtchnl_pair *evt_pair,
438 					      bool is_connected)
439 {
440 	enum xen_snd_front_evtchnl_state state;
441 
442 	if (is_connected)
443 		state = EVTCHNL_STATE_CONNECTED;
444 	else
445 		state = EVTCHNL_STATE_DISCONNECTED;
446 
447 	mutex_lock(&evt_pair->req.ring_io_lock);
448 	evt_pair->req.state = state;
449 	mutex_unlock(&evt_pair->req.ring_io_lock);
450 
451 	mutex_lock(&evt_pair->evt.ring_io_lock);
452 	evt_pair->evt.state = state;
453 	mutex_unlock(&evt_pair->evt.ring_io_lock);
454 }
455 
xen_snd_front_evtchnl_pair_clear(struct xen_snd_front_evtchnl_pair * evt_pair)456 void xen_snd_front_evtchnl_pair_clear(struct xen_snd_front_evtchnl_pair *evt_pair)
457 {
458 	mutex_lock(&evt_pair->req.ring_io_lock);
459 	evt_pair->req.evt_next_id = 0;
460 	mutex_unlock(&evt_pair->req.ring_io_lock);
461 
462 	mutex_lock(&evt_pair->evt.ring_io_lock);
463 	evt_pair->evt.evt_next_id = 0;
464 	mutex_unlock(&evt_pair->evt.ring_io_lock);
465 }
466 
467