1 /* SPDX-License-Identifier: (GPL-2.0 OR CDDL-1.0) */
2 /*
3  * vboxguest vmm-req and hgcm-call code, VBoxGuestR0LibHGCMInternal.cpp,
4  * VBoxGuestR0LibGenericRequest.cpp and RTErrConvertToErrno.cpp in vbox svn.
5  *
6  * Copyright (C) 2006-2016 Oracle Corporation
7  */
8 
9 #include <linux/errno.h>
10 #include <linux/kernel.h>
11 #include <linux/mm.h>
12 #include <linux/module.h>
13 #include <linux/sizes.h>
14 #include <linux/slab.h>
15 #include <linux/uaccess.h>
16 #include <linux/vmalloc.h>
17 #include <linux/vbox_err.h>
18 #include <linux/vbox_utils.h>
19 #include "vboxguest_core.h"
20 
21 /* Get the pointer to the first parameter of a HGCM call request. */
22 #define VMMDEV_HGCM_CALL_PARMS(a) \
23 	((struct vmmdev_hgcm_function_parameter *)( \
24 		(u8 *)(a) + sizeof(struct vmmdev_hgcm_call)))
25 
26 /* The max parameter buffer size for a user request. */
27 #define VBG_MAX_HGCM_USER_PARM		(24 * SZ_1M)
28 /* The max parameter buffer size for a kernel request. */
29 #define VBG_MAX_HGCM_KERNEL_PARM	(16 * SZ_1M)
30 
31 #define VBG_DEBUG_PORT			0x504
32 
33 /* This protects vbg_log_buf and serializes VBG_DEBUG_PORT accesses */
34 static DEFINE_SPINLOCK(vbg_log_lock);
35 static char vbg_log_buf[128];
36 
37 #define VBG_LOG(name, pr_func) \
38 void name(const char *fmt, ...)						\
39 {									\
40 	unsigned long flags;						\
41 	va_list args;							\
42 	int i, count;							\
43 									\
44 	va_start(args, fmt);						\
45 	spin_lock_irqsave(&vbg_log_lock, flags);			\
46 									\
47 	count = vscnprintf(vbg_log_buf, sizeof(vbg_log_buf), fmt, args);\
48 	for (i = 0; i < count; i++)					\
49 		outb(vbg_log_buf[i], VBG_DEBUG_PORT);			\
50 									\
51 	pr_func("%s", vbg_log_buf);					\
52 									\
53 	spin_unlock_irqrestore(&vbg_log_lock, flags);			\
54 	va_end(args);							\
55 }									\
56 EXPORT_SYMBOL(name)
57 
58 VBG_LOG(vbg_info, pr_info);
59 VBG_LOG(vbg_warn, pr_warn);
60 VBG_LOG(vbg_err, pr_err);
61 #if defined(DEBUG) && !defined(CONFIG_DYNAMIC_DEBUG)
62 VBG_LOG(vbg_debug, pr_debug);
63 #endif
64 
65 void *vbg_req_alloc(size_t len, enum vmmdev_request_type req_type,
66 		    u32 requestor)
67 {
68 	struct vmmdev_request_header *req;
69 	int order = get_order(PAGE_ALIGN(len));
70 
71 	req = (void *)__get_free_pages(GFP_KERNEL | GFP_DMA32, order);
72 	if (!req)
73 		return NULL;
74 
75 	memset(req, 0xaa, len);
76 
77 	req->size = len;
78 	req->version = VMMDEV_REQUEST_HEADER_VERSION;
79 	req->request_type = req_type;
80 	req->rc = VERR_GENERAL_FAILURE;
81 	req->reserved1 = 0;
82 	req->requestor = requestor;
83 
84 	return req;
85 }
86 
87 void vbg_req_free(void *req, size_t len)
88 {
89 	if (!req)
90 		return;
91 
92 	free_pages((unsigned long)req, get_order(PAGE_ALIGN(len)));
93 }
94 
95 /* Note this function returns a VBox status code, not a negative errno!! */
96 int vbg_req_perform(struct vbg_dev *gdev, void *req)
97 {
98 	unsigned long phys_req = virt_to_phys(req);
99 
100 	outl(phys_req, gdev->io_port + VMMDEV_PORT_OFF_REQUEST);
101 	/*
102 	 * The host changes the request as a result of the outl, make sure
103 	 * the outl and any reads of the req happen in the correct order.
104 	 */
105 	mb();
106 
107 	return ((struct vmmdev_request_header *)req)->rc;
108 }
109 
110 static bool hgcm_req_done(struct vbg_dev *gdev,
111 			  struct vmmdev_hgcmreq_header *header)
112 {
113 	unsigned long flags;
114 	bool done;
115 
116 	spin_lock_irqsave(&gdev->event_spinlock, flags);
117 	done = header->flags & VMMDEV_HGCM_REQ_DONE;
118 	spin_unlock_irqrestore(&gdev->event_spinlock, flags);
119 
120 	return done;
121 }
122 
123 int vbg_hgcm_connect(struct vbg_dev *gdev, u32 requestor,
124 		     struct vmmdev_hgcm_service_location *loc,
125 		     u32 *client_id, int *vbox_status)
126 {
127 	struct vmmdev_hgcm_connect *hgcm_connect = NULL;
128 	int rc;
129 
130 	hgcm_connect = vbg_req_alloc(sizeof(*hgcm_connect),
131 				     VMMDEVREQ_HGCM_CONNECT, requestor);
132 	if (!hgcm_connect)
133 		return -ENOMEM;
134 
135 	hgcm_connect->header.flags = 0;
136 	memcpy(&hgcm_connect->loc, loc, sizeof(*loc));
137 	hgcm_connect->client_id = 0;
138 
139 	rc = vbg_req_perform(gdev, hgcm_connect);
140 
141 	if (rc == VINF_HGCM_ASYNC_EXECUTE)
142 		wait_event(gdev->hgcm_wq,
143 			   hgcm_req_done(gdev, &hgcm_connect->header));
144 
145 	if (rc >= 0) {
146 		*client_id = hgcm_connect->client_id;
147 		rc = hgcm_connect->header.result;
148 	}
149 
150 	vbg_req_free(hgcm_connect, sizeof(*hgcm_connect));
151 
152 	*vbox_status = rc;
153 	return 0;
154 }
155 EXPORT_SYMBOL(vbg_hgcm_connect);
156 
157 int vbg_hgcm_disconnect(struct vbg_dev *gdev, u32 requestor,
158 			u32 client_id, int *vbox_status)
159 {
160 	struct vmmdev_hgcm_disconnect *hgcm_disconnect = NULL;
161 	int rc;
162 
163 	hgcm_disconnect = vbg_req_alloc(sizeof(*hgcm_disconnect),
164 					VMMDEVREQ_HGCM_DISCONNECT,
165 					requestor);
166 	if (!hgcm_disconnect)
167 		return -ENOMEM;
168 
169 	hgcm_disconnect->header.flags = 0;
170 	hgcm_disconnect->client_id = client_id;
171 
172 	rc = vbg_req_perform(gdev, hgcm_disconnect);
173 
174 	if (rc == VINF_HGCM_ASYNC_EXECUTE)
175 		wait_event(gdev->hgcm_wq,
176 			   hgcm_req_done(gdev, &hgcm_disconnect->header));
177 
178 	if (rc >= 0)
179 		rc = hgcm_disconnect->header.result;
180 
181 	vbg_req_free(hgcm_disconnect, sizeof(*hgcm_disconnect));
182 
183 	*vbox_status = rc;
184 	return 0;
185 }
186 EXPORT_SYMBOL(vbg_hgcm_disconnect);
187 
188 static u32 hgcm_call_buf_size_in_pages(void *buf, u32 len)
189 {
190 	u32 size = PAGE_ALIGN(len + ((unsigned long)buf & ~PAGE_MASK));
191 
192 	return size >> PAGE_SHIFT;
193 }
194 
195 static void hgcm_call_add_pagelist_size(void *buf, u32 len, size_t *extra)
196 {
197 	u32 page_count;
198 
199 	page_count = hgcm_call_buf_size_in_pages(buf, len);
200 	*extra += offsetof(struct vmmdev_hgcm_pagelist, pages[page_count]);
201 }
202 
203 static int hgcm_call_preprocess_linaddr(
204 	const struct vmmdev_hgcm_function_parameter *src_parm,
205 	void **bounce_buf_ret, size_t *extra)
206 {
207 	void *buf, *bounce_buf;
208 	bool copy_in;
209 	u32 len;
210 	int ret;
211 
212 	buf = (void *)src_parm->u.pointer.u.linear_addr;
213 	len = src_parm->u.pointer.size;
214 	copy_in = src_parm->type != VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT;
215 
216 	if (len > VBG_MAX_HGCM_USER_PARM)
217 		return -E2BIG;
218 
219 	bounce_buf = kvmalloc(len, GFP_KERNEL);
220 	if (!bounce_buf)
221 		return -ENOMEM;
222 
223 	if (copy_in) {
224 		ret = copy_from_user(bounce_buf, (void __user *)buf, len);
225 		if (ret)
226 			return -EFAULT;
227 	} else {
228 		memset(bounce_buf, 0, len);
229 	}
230 
231 	*bounce_buf_ret = bounce_buf;
232 	hgcm_call_add_pagelist_size(bounce_buf, len, extra);
233 	return 0;
234 }
235 
236 /**
237  * Preprocesses the HGCM call, validate parameters, alloc bounce buffers and
238  * figure out how much extra storage we need for page lists.
239  * Return: 0 or negative errno value.
240  * @src_parm:         Pointer to source function call parameters
241  * @parm_count:       Number of function call parameters.
242  * @bounce_bufs_ret:  Where to return the allocated bouncebuffer array
243  * @extra:            Where to return the extra request space needed for
244  *                    physical page lists.
245  */
246 static int hgcm_call_preprocess(
247 	const struct vmmdev_hgcm_function_parameter *src_parm,
248 	u32 parm_count, void ***bounce_bufs_ret, size_t *extra)
249 {
250 	void *buf, **bounce_bufs = NULL;
251 	u32 i, len;
252 	int ret;
253 
254 	for (i = 0; i < parm_count; i++, src_parm++) {
255 		switch (src_parm->type) {
256 		case VMMDEV_HGCM_PARM_TYPE_32BIT:
257 		case VMMDEV_HGCM_PARM_TYPE_64BIT:
258 			break;
259 
260 		case VMMDEV_HGCM_PARM_TYPE_LINADDR:
261 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_IN:
262 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT:
263 			if (!bounce_bufs) {
264 				bounce_bufs = kcalloc(parm_count,
265 						      sizeof(void *),
266 						      GFP_KERNEL);
267 				if (!bounce_bufs)
268 					return -ENOMEM;
269 
270 				*bounce_bufs_ret = bounce_bufs;
271 			}
272 
273 			ret = hgcm_call_preprocess_linaddr(src_parm,
274 							   &bounce_bufs[i],
275 							   extra);
276 			if (ret)
277 				return ret;
278 
279 			break;
280 
281 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL:
282 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN:
283 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT:
284 			buf = (void *)src_parm->u.pointer.u.linear_addr;
285 			len = src_parm->u.pointer.size;
286 			if (WARN_ON(len > VBG_MAX_HGCM_KERNEL_PARM))
287 				return -E2BIG;
288 
289 			hgcm_call_add_pagelist_size(buf, len, extra);
290 			break;
291 
292 		default:
293 			return -EINVAL;
294 		}
295 	}
296 
297 	return 0;
298 }
299 
300 /**
301  * Translates linear address types to page list direction flags.
302  *
303  * Return: page list flags.
304  * @type:  The type.
305  */
306 static u32 hgcm_call_linear_addr_type_to_pagelist_flags(
307 	enum vmmdev_hgcm_function_parameter_type type)
308 {
309 	switch (type) {
310 	default:
311 		WARN_ON(1);
312 		/* Fall through */
313 	case VMMDEV_HGCM_PARM_TYPE_LINADDR:
314 	case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL:
315 		return VMMDEV_HGCM_F_PARM_DIRECTION_BOTH;
316 
317 	case VMMDEV_HGCM_PARM_TYPE_LINADDR_IN:
318 	case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN:
319 		return VMMDEV_HGCM_F_PARM_DIRECTION_TO_HOST;
320 
321 	case VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT:
322 	case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT:
323 		return VMMDEV_HGCM_F_PARM_DIRECTION_FROM_HOST;
324 	}
325 }
326 
327 static void hgcm_call_init_linaddr(struct vmmdev_hgcm_call *call,
328 	struct vmmdev_hgcm_function_parameter *dst_parm, void *buf, u32 len,
329 	enum vmmdev_hgcm_function_parameter_type type, u32 *off_extra)
330 {
331 	struct vmmdev_hgcm_pagelist *dst_pg_lst;
332 	struct page *page;
333 	bool is_vmalloc;
334 	u32 i, page_count;
335 
336 	dst_parm->type = type;
337 
338 	if (len == 0) {
339 		dst_parm->u.pointer.size = 0;
340 		dst_parm->u.pointer.u.linear_addr = 0;
341 		return;
342 	}
343 
344 	dst_pg_lst = (void *)call + *off_extra;
345 	page_count = hgcm_call_buf_size_in_pages(buf, len);
346 	is_vmalloc = is_vmalloc_addr(buf);
347 
348 	dst_parm->type = VMMDEV_HGCM_PARM_TYPE_PAGELIST;
349 	dst_parm->u.page_list.size = len;
350 	dst_parm->u.page_list.offset = *off_extra;
351 	dst_pg_lst->flags = hgcm_call_linear_addr_type_to_pagelist_flags(type);
352 	dst_pg_lst->offset_first_page = (unsigned long)buf & ~PAGE_MASK;
353 	dst_pg_lst->page_count = page_count;
354 
355 	for (i = 0; i < page_count; i++) {
356 		if (is_vmalloc)
357 			page = vmalloc_to_page(buf);
358 		else
359 			page = virt_to_page(buf);
360 
361 		dst_pg_lst->pages[i] = page_to_phys(page);
362 		buf += PAGE_SIZE;
363 	}
364 
365 	*off_extra += offsetof(struct vmmdev_hgcm_pagelist, pages[page_count]);
366 }
367 
368 /**
369  * Initializes the call request that we're sending to the host.
370  * @call:            The call to initialize.
371  * @client_id:       The client ID of the caller.
372  * @function:        The function number of the function to call.
373  * @src_parm:        Pointer to source function call parameters.
374  * @parm_count:      Number of function call parameters.
375  * @bounce_bufs:     The bouncebuffer array.
376  */
377 static void hgcm_call_init_call(
378 	struct vmmdev_hgcm_call *call, u32 client_id, u32 function,
379 	const struct vmmdev_hgcm_function_parameter *src_parm,
380 	u32 parm_count, void **bounce_bufs)
381 {
382 	struct vmmdev_hgcm_function_parameter *dst_parm =
383 		VMMDEV_HGCM_CALL_PARMS(call);
384 	u32 i, off_extra = (uintptr_t)(dst_parm + parm_count) - (uintptr_t)call;
385 	void *buf;
386 
387 	call->header.flags = 0;
388 	call->header.result = VINF_SUCCESS;
389 	call->client_id = client_id;
390 	call->function = function;
391 	call->parm_count = parm_count;
392 
393 	for (i = 0; i < parm_count; i++, src_parm++, dst_parm++) {
394 		switch (src_parm->type) {
395 		case VMMDEV_HGCM_PARM_TYPE_32BIT:
396 		case VMMDEV_HGCM_PARM_TYPE_64BIT:
397 			*dst_parm = *src_parm;
398 			break;
399 
400 		case VMMDEV_HGCM_PARM_TYPE_LINADDR:
401 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_IN:
402 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT:
403 			hgcm_call_init_linaddr(call, dst_parm, bounce_bufs[i],
404 					       src_parm->u.pointer.size,
405 					       src_parm->type, &off_extra);
406 			break;
407 
408 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL:
409 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN:
410 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT:
411 			buf = (void *)src_parm->u.pointer.u.linear_addr;
412 			hgcm_call_init_linaddr(call, dst_parm, buf,
413 					       src_parm->u.pointer.size,
414 					       src_parm->type, &off_extra);
415 			break;
416 
417 		default:
418 			WARN_ON(1);
419 			dst_parm->type = VMMDEV_HGCM_PARM_TYPE_INVALID;
420 		}
421 	}
422 }
423 
424 /**
425  * Tries to cancel a pending HGCM call.
426  *
427  * Return: VBox status code
428  */
429 static int hgcm_cancel_call(struct vbg_dev *gdev, struct vmmdev_hgcm_call *call)
430 {
431 	int rc;
432 
433 	/*
434 	 * We use a pre-allocated request for cancellations, which is
435 	 * protected by cancel_req_mutex. This means that all cancellations
436 	 * get serialized, this should be fine since they should be rare.
437 	 */
438 	mutex_lock(&gdev->cancel_req_mutex);
439 	gdev->cancel_req->phys_req_to_cancel = virt_to_phys(call);
440 	rc = vbg_req_perform(gdev, gdev->cancel_req);
441 	mutex_unlock(&gdev->cancel_req_mutex);
442 
443 	if (rc == VERR_NOT_IMPLEMENTED) {
444 		call->header.flags |= VMMDEV_HGCM_REQ_CANCELLED;
445 		call->header.header.request_type = VMMDEVREQ_HGCM_CANCEL;
446 
447 		rc = vbg_req_perform(gdev, call);
448 		if (rc == VERR_INVALID_PARAMETER)
449 			rc = VERR_NOT_FOUND;
450 	}
451 
452 	if (rc >= 0)
453 		call->header.flags |= VMMDEV_HGCM_REQ_CANCELLED;
454 
455 	return rc;
456 }
457 
458 /**
459  * Performs the call and completion wait.
460  * Return: 0 or negative errno value.
461  * @gdev:        The VBoxGuest device extension.
462  * @call:        The call to execute.
463  * @timeout_ms:  Timeout in ms.
464  * @leak_it:     Where to return the leak it / free it, indicator.
465  *               Cancellation fun.
466  */
467 static int vbg_hgcm_do_call(struct vbg_dev *gdev, struct vmmdev_hgcm_call *call,
468 			    u32 timeout_ms, bool *leak_it)
469 {
470 	int rc, cancel_rc, ret;
471 	long timeout;
472 
473 	*leak_it = false;
474 
475 	rc = vbg_req_perform(gdev, call);
476 
477 	/*
478 	 * If the call failed, then pretend success. Upper layers will
479 	 * interpret the result code in the packet.
480 	 */
481 	if (rc < 0) {
482 		call->header.result = rc;
483 		return 0;
484 	}
485 
486 	if (rc != VINF_HGCM_ASYNC_EXECUTE)
487 		return 0;
488 
489 	/* Host decided to process the request asynchronously, wait for it */
490 	if (timeout_ms == U32_MAX)
491 		timeout = MAX_SCHEDULE_TIMEOUT;
492 	else
493 		timeout = msecs_to_jiffies(timeout_ms);
494 
495 	timeout = wait_event_interruptible_timeout(
496 					gdev->hgcm_wq,
497 					hgcm_req_done(gdev, &call->header),
498 					timeout);
499 
500 	/* timeout > 0 means hgcm_req_done has returned true, so success */
501 	if (timeout > 0)
502 		return 0;
503 
504 	if (timeout == 0)
505 		ret = -ETIMEDOUT;
506 	else
507 		ret = -EINTR;
508 
509 	/* Cancel the request */
510 	cancel_rc = hgcm_cancel_call(gdev, call);
511 	if (cancel_rc >= 0)
512 		return ret;
513 
514 	/*
515 	 * Failed to cancel, this should mean that the cancel has lost the
516 	 * race with normal completion, wait while the host completes it.
517 	 */
518 	if (cancel_rc == VERR_NOT_FOUND || cancel_rc == VERR_SEM_DESTROYED)
519 		timeout = msecs_to_jiffies(500);
520 	else
521 		timeout = msecs_to_jiffies(2000);
522 
523 	timeout = wait_event_timeout(gdev->hgcm_wq,
524 				     hgcm_req_done(gdev, &call->header),
525 				     timeout);
526 
527 	if (WARN_ON(timeout == 0)) {
528 		/* We really should never get here */
529 		vbg_err("%s: Call timedout and cancellation failed, leaking the request\n",
530 			__func__);
531 		*leak_it = true;
532 		return ret;
533 	}
534 
535 	/* The call has completed normally after all */
536 	return 0;
537 }
538 
539 /**
540  * Copies the result of the call back to the caller info structure and user
541  * buffers.
542  * Return: 0 or negative errno value.
543  * @call:            HGCM call request.
544  * @dst_parm:        Pointer to function call parameters destination.
545  * @parm_count:      Number of function call parameters.
546  * @bounce_bufs:     The bouncebuffer array.
547  */
548 static int hgcm_call_copy_back_result(
549 	const struct vmmdev_hgcm_call *call,
550 	struct vmmdev_hgcm_function_parameter *dst_parm,
551 	u32 parm_count, void **bounce_bufs)
552 {
553 	const struct vmmdev_hgcm_function_parameter *src_parm =
554 		VMMDEV_HGCM_CALL_PARMS(call);
555 	void __user *p;
556 	int ret;
557 	u32 i;
558 
559 	/* Copy back parameters. */
560 	for (i = 0; i < parm_count; i++, src_parm++, dst_parm++) {
561 		switch (dst_parm->type) {
562 		case VMMDEV_HGCM_PARM_TYPE_32BIT:
563 		case VMMDEV_HGCM_PARM_TYPE_64BIT:
564 			*dst_parm = *src_parm;
565 			break;
566 
567 		case VMMDEV_HGCM_PARM_TYPE_PAGELIST:
568 			dst_parm->u.page_list.size = src_parm->u.page_list.size;
569 			break;
570 
571 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_IN:
572 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL:
573 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_IN:
574 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_KERNEL_OUT:
575 			dst_parm->u.pointer.size = src_parm->u.pointer.size;
576 			break;
577 
578 		case VMMDEV_HGCM_PARM_TYPE_LINADDR:
579 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT:
580 			dst_parm->u.pointer.size = src_parm->u.pointer.size;
581 
582 			p = (void __user *)dst_parm->u.pointer.u.linear_addr;
583 			ret = copy_to_user(p, bounce_bufs[i],
584 					   min(src_parm->u.pointer.size,
585 					       dst_parm->u.pointer.size));
586 			if (ret)
587 				return -EFAULT;
588 			break;
589 
590 		default:
591 			WARN_ON(1);
592 			return -EINVAL;
593 		}
594 	}
595 
596 	return 0;
597 }
598 
599 int vbg_hgcm_call(struct vbg_dev *gdev, u32 requestor, u32 client_id,
600 		  u32 function, u32 timeout_ms,
601 		  struct vmmdev_hgcm_function_parameter *parms, u32 parm_count,
602 		  int *vbox_status)
603 {
604 	struct vmmdev_hgcm_call *call;
605 	void **bounce_bufs = NULL;
606 	bool leak_it;
607 	size_t size;
608 	int i, ret;
609 
610 	size = sizeof(struct vmmdev_hgcm_call) +
611 		   parm_count * sizeof(struct vmmdev_hgcm_function_parameter);
612 	/*
613 	 * Validate and buffer the parameters for the call. This also increases
614 	 * call_size with the amount of extra space needed for page lists.
615 	 */
616 	ret = hgcm_call_preprocess(parms, parm_count, &bounce_bufs, &size);
617 	if (ret) {
618 		/* Even on error bounce bufs may still have been allocated */
619 		goto free_bounce_bufs;
620 	}
621 
622 	call = vbg_req_alloc(size, VMMDEVREQ_HGCM_CALL, requestor);
623 	if (!call) {
624 		ret = -ENOMEM;
625 		goto free_bounce_bufs;
626 	}
627 
628 	hgcm_call_init_call(call, client_id, function, parms, parm_count,
629 			    bounce_bufs);
630 
631 	ret = vbg_hgcm_do_call(gdev, call, timeout_ms, &leak_it);
632 	if (ret == 0) {
633 		*vbox_status = call->header.result;
634 		ret = hgcm_call_copy_back_result(call, parms, parm_count,
635 						 bounce_bufs);
636 	}
637 
638 	if (!leak_it)
639 		vbg_req_free(call, size);
640 
641 free_bounce_bufs:
642 	if (bounce_bufs) {
643 		for (i = 0; i < parm_count; i++)
644 			kvfree(bounce_bufs[i]);
645 		kfree(bounce_bufs);
646 	}
647 
648 	return ret;
649 }
650 EXPORT_SYMBOL(vbg_hgcm_call);
651 
652 #ifdef CONFIG_COMPAT
653 int vbg_hgcm_call32(
654 	struct vbg_dev *gdev, u32 requestor, u32 client_id, u32 function,
655 	u32 timeout_ms, struct vmmdev_hgcm_function_parameter32 *parm32,
656 	u32 parm_count, int *vbox_status)
657 {
658 	struct vmmdev_hgcm_function_parameter *parm64 = NULL;
659 	u32 i, size;
660 	int ret = 0;
661 
662 	/* KISS allocate a temporary request and convert the parameters. */
663 	size = parm_count * sizeof(struct vmmdev_hgcm_function_parameter);
664 	parm64 = kzalloc(size, GFP_KERNEL);
665 	if (!parm64)
666 		return -ENOMEM;
667 
668 	for (i = 0; i < parm_count; i++) {
669 		switch (parm32[i].type) {
670 		case VMMDEV_HGCM_PARM_TYPE_32BIT:
671 			parm64[i].type = VMMDEV_HGCM_PARM_TYPE_32BIT;
672 			parm64[i].u.value32 = parm32[i].u.value32;
673 			break;
674 
675 		case VMMDEV_HGCM_PARM_TYPE_64BIT:
676 			parm64[i].type = VMMDEV_HGCM_PARM_TYPE_64BIT;
677 			parm64[i].u.value64 = parm32[i].u.value64;
678 			break;
679 
680 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT:
681 		case VMMDEV_HGCM_PARM_TYPE_LINADDR:
682 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_IN:
683 			parm64[i].type = parm32[i].type;
684 			parm64[i].u.pointer.size = parm32[i].u.pointer.size;
685 			parm64[i].u.pointer.u.linear_addr =
686 			    parm32[i].u.pointer.u.linear_addr;
687 			break;
688 
689 		default:
690 			ret = -EINVAL;
691 		}
692 		if (ret < 0)
693 			goto out_free;
694 	}
695 
696 	ret = vbg_hgcm_call(gdev, requestor, client_id, function, timeout_ms,
697 			    parm64, parm_count, vbox_status);
698 	if (ret < 0)
699 		goto out_free;
700 
701 	/* Copy back. */
702 	for (i = 0; i < parm_count; i++, parm32++, parm64++) {
703 		switch (parm64[i].type) {
704 		case VMMDEV_HGCM_PARM_TYPE_32BIT:
705 			parm32[i].u.value32 = parm64[i].u.value32;
706 			break;
707 
708 		case VMMDEV_HGCM_PARM_TYPE_64BIT:
709 			parm32[i].u.value64 = parm64[i].u.value64;
710 			break;
711 
712 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_OUT:
713 		case VMMDEV_HGCM_PARM_TYPE_LINADDR:
714 		case VMMDEV_HGCM_PARM_TYPE_LINADDR_IN:
715 			parm32[i].u.pointer.size = parm64[i].u.pointer.size;
716 			break;
717 
718 		default:
719 			WARN_ON(1);
720 			ret = -EINVAL;
721 		}
722 	}
723 
724 out_free:
725 	kfree(parm64);
726 	return ret;
727 }
728 #endif
729 
730 static const int vbg_status_code_to_errno_table[] = {
731 	[-VERR_ACCESS_DENIED]                            = -EPERM,
732 	[-VERR_FILE_NOT_FOUND]                           = -ENOENT,
733 	[-VERR_PROCESS_NOT_FOUND]                        = -ESRCH,
734 	[-VERR_INTERRUPTED]                              = -EINTR,
735 	[-VERR_DEV_IO_ERROR]                             = -EIO,
736 	[-VERR_TOO_MUCH_DATA]                            = -E2BIG,
737 	[-VERR_BAD_EXE_FORMAT]                           = -ENOEXEC,
738 	[-VERR_INVALID_HANDLE]                           = -EBADF,
739 	[-VERR_TRY_AGAIN]                                = -EAGAIN,
740 	[-VERR_NO_MEMORY]                                = -ENOMEM,
741 	[-VERR_INVALID_POINTER]                          = -EFAULT,
742 	[-VERR_RESOURCE_BUSY]                            = -EBUSY,
743 	[-VERR_ALREADY_EXISTS]                           = -EEXIST,
744 	[-VERR_NOT_SAME_DEVICE]                          = -EXDEV,
745 	[-VERR_NOT_A_DIRECTORY]                          = -ENOTDIR,
746 	[-VERR_PATH_NOT_FOUND]                           = -ENOTDIR,
747 	[-VERR_INVALID_NAME]                             = -ENOENT,
748 	[-VERR_IS_A_DIRECTORY]                           = -EISDIR,
749 	[-VERR_INVALID_PARAMETER]                        = -EINVAL,
750 	[-VERR_TOO_MANY_OPEN_FILES]                      = -ENFILE,
751 	[-VERR_INVALID_FUNCTION]                         = -ENOTTY,
752 	[-VERR_SHARING_VIOLATION]                        = -ETXTBSY,
753 	[-VERR_FILE_TOO_BIG]                             = -EFBIG,
754 	[-VERR_DISK_FULL]                                = -ENOSPC,
755 	[-VERR_SEEK_ON_DEVICE]                           = -ESPIPE,
756 	[-VERR_WRITE_PROTECT]                            = -EROFS,
757 	[-VERR_BROKEN_PIPE]                              = -EPIPE,
758 	[-VERR_DEADLOCK]                                 = -EDEADLK,
759 	[-VERR_FILENAME_TOO_LONG]                        = -ENAMETOOLONG,
760 	[-VERR_FILE_LOCK_FAILED]                         = -ENOLCK,
761 	[-VERR_NOT_IMPLEMENTED]                          = -ENOSYS,
762 	[-VERR_NOT_SUPPORTED]                            = -ENOSYS,
763 	[-VERR_DIR_NOT_EMPTY]                            = -ENOTEMPTY,
764 	[-VERR_TOO_MANY_SYMLINKS]                        = -ELOOP,
765 	[-VERR_NO_MORE_FILES]				 = -ENODATA,
766 	[-VERR_NO_DATA]                                  = -ENODATA,
767 	[-VERR_NET_NO_NETWORK]                           = -ENONET,
768 	[-VERR_NET_NOT_UNIQUE_NAME]                      = -ENOTUNIQ,
769 	[-VERR_NO_TRANSLATION]                           = -EILSEQ,
770 	[-VERR_NET_NOT_SOCKET]                           = -ENOTSOCK,
771 	[-VERR_NET_DEST_ADDRESS_REQUIRED]                = -EDESTADDRREQ,
772 	[-VERR_NET_MSG_SIZE]                             = -EMSGSIZE,
773 	[-VERR_NET_PROTOCOL_TYPE]                        = -EPROTOTYPE,
774 	[-VERR_NET_PROTOCOL_NOT_AVAILABLE]               = -ENOPROTOOPT,
775 	[-VERR_NET_PROTOCOL_NOT_SUPPORTED]               = -EPROTONOSUPPORT,
776 	[-VERR_NET_SOCKET_TYPE_NOT_SUPPORTED]            = -ESOCKTNOSUPPORT,
777 	[-VERR_NET_OPERATION_NOT_SUPPORTED]              = -EOPNOTSUPP,
778 	[-VERR_NET_PROTOCOL_FAMILY_NOT_SUPPORTED]        = -EPFNOSUPPORT,
779 	[-VERR_NET_ADDRESS_FAMILY_NOT_SUPPORTED]         = -EAFNOSUPPORT,
780 	[-VERR_NET_ADDRESS_IN_USE]                       = -EADDRINUSE,
781 	[-VERR_NET_ADDRESS_NOT_AVAILABLE]                = -EADDRNOTAVAIL,
782 	[-VERR_NET_DOWN]                                 = -ENETDOWN,
783 	[-VERR_NET_UNREACHABLE]                          = -ENETUNREACH,
784 	[-VERR_NET_CONNECTION_RESET]                     = -ENETRESET,
785 	[-VERR_NET_CONNECTION_ABORTED]                   = -ECONNABORTED,
786 	[-VERR_NET_CONNECTION_RESET_BY_PEER]             = -ECONNRESET,
787 	[-VERR_NET_NO_BUFFER_SPACE]                      = -ENOBUFS,
788 	[-VERR_NET_ALREADY_CONNECTED]                    = -EISCONN,
789 	[-VERR_NET_NOT_CONNECTED]                        = -ENOTCONN,
790 	[-VERR_NET_SHUTDOWN]                             = -ESHUTDOWN,
791 	[-VERR_NET_TOO_MANY_REFERENCES]                  = -ETOOMANYREFS,
792 	[-VERR_TIMEOUT]                                  = -ETIMEDOUT,
793 	[-VERR_NET_CONNECTION_REFUSED]                   = -ECONNREFUSED,
794 	[-VERR_NET_HOST_DOWN]                            = -EHOSTDOWN,
795 	[-VERR_NET_HOST_UNREACHABLE]                     = -EHOSTUNREACH,
796 	[-VERR_NET_ALREADY_IN_PROGRESS]                  = -EALREADY,
797 	[-VERR_NET_IN_PROGRESS]                          = -EINPROGRESS,
798 	[-VERR_MEDIA_NOT_PRESENT]                        = -ENOMEDIUM,
799 	[-VERR_MEDIA_NOT_RECOGNIZED]                     = -EMEDIUMTYPE,
800 };
801 
802 int vbg_status_code_to_errno(int rc)
803 {
804 	if (rc >= 0)
805 		return 0;
806 
807 	rc = -rc;
808 	if (rc >= ARRAY_SIZE(vbg_status_code_to_errno_table) ||
809 	    vbg_status_code_to_errno_table[rc] == 0) {
810 		vbg_warn("%s: Unhandled err %d\n", __func__, -rc);
811 		return -EPROTO;
812 	}
813 
814 	return vbg_status_code_to_errno_table[rc];
815 }
816 EXPORT_SYMBOL(vbg_status_code_to_errno);
817