97 lines
		
	
	
		
			2.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			97 lines
		
	
	
		
			2.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  * DVB USB framework
 | |
|  *
 | |
|  * Copyright (C) 2004-6 Patrick Boettcher <patrick.boettcher@posteo.de>
 | |
|  * Copyright (C) 2012 Antti Palosaari <crope@iki.fi>
 | |
|  */
 | |
| 
 | |
| #include "dvb_usb_common.h"
 | |
| 
 | |
| static int dvb_usb_v2_generic_io(struct dvb_usb_device *d,
 | |
| 		u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
 | |
| {
 | |
| 	int ret, actual_length;
 | |
| 
 | |
| 	if (!wbuf || !wlen || !d->props->generic_bulk_ctrl_endpoint ||
 | |
| 			!d->props->generic_bulk_ctrl_endpoint_response) {
 | |
| 		dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, -EINVAL);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	dev_dbg(&d->udev->dev, "%s: >>> %*ph\n", __func__, wlen, wbuf);
 | |
| 
 | |
| 	ret = usb_bulk_msg(d->udev, usb_sndbulkpipe(d->udev,
 | |
| 			d->props->generic_bulk_ctrl_endpoint), wbuf, wlen,
 | |
| 			&actual_length, 2000);
 | |
| 	if (ret) {
 | |
| 		dev_err(&d->udev->dev, "%s: usb_bulk_msg() failed=%d\n",
 | |
| 				KBUILD_MODNAME, ret);
 | |
| 		return ret;
 | |
| 	}
 | |
| 	if (actual_length != wlen) {
 | |
| 		dev_err(&d->udev->dev, "%s: usb_bulk_msg() write length=%d, actual=%d\n",
 | |
| 			KBUILD_MODNAME, wlen, actual_length);
 | |
| 		return -EIO;
 | |
| 	}
 | |
| 
 | |
| 	/* an answer is expected */
 | |
| 	if (rbuf && rlen) {
 | |
| 		if (d->props->generic_bulk_ctrl_delay)
 | |
| 			usleep_range(d->props->generic_bulk_ctrl_delay,
 | |
| 					d->props->generic_bulk_ctrl_delay
 | |
| 					+ 20000);
 | |
| 
 | |
| 		ret = usb_bulk_msg(d->udev, usb_rcvbulkpipe(d->udev,
 | |
| 				d->props->generic_bulk_ctrl_endpoint_response),
 | |
| 				rbuf, rlen, &actual_length, 2000);
 | |
| 		if (ret)
 | |
| 			dev_err(&d->udev->dev,
 | |
| 					"%s: 2nd usb_bulk_msg() failed=%d\n",
 | |
| 					KBUILD_MODNAME, ret);
 | |
| 
 | |
| 		dev_dbg(&d->udev->dev, "%s: <<< %*ph\n", __func__,
 | |
| 				actual_length, rbuf);
 | |
| 	}
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| int dvb_usbv2_generic_rw(struct dvb_usb_device *d,
 | |
| 		u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	mutex_lock(&d->usb_mutex);
 | |
| 	ret = dvb_usb_v2_generic_io(d, wbuf, wlen, rbuf, rlen);
 | |
| 	mutex_unlock(&d->usb_mutex);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| EXPORT_SYMBOL(dvb_usbv2_generic_rw);
 | |
| 
 | |
| int dvb_usbv2_generic_write(struct dvb_usb_device *d, u8 *buf, u16 len)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	mutex_lock(&d->usb_mutex);
 | |
| 	ret = dvb_usb_v2_generic_io(d, buf, len, NULL, 0);
 | |
| 	mutex_unlock(&d->usb_mutex);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| EXPORT_SYMBOL(dvb_usbv2_generic_write);
 | |
| 
 | |
| int dvb_usbv2_generic_rw_locked(struct dvb_usb_device *d,
 | |
| 		u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
 | |
| {
 | |
| 	return dvb_usb_v2_generic_io(d, wbuf, wlen, rbuf, rlen);
 | |
| }
 | |
| EXPORT_SYMBOL(dvb_usbv2_generic_rw_locked);
 | |
| 
 | |
| int dvb_usbv2_generic_write_locked(struct dvb_usb_device *d, u8 *buf, u16 len)
 | |
| {
 | |
| 	return dvb_usb_v2_generic_io(d, buf, len, NULL, 0);
 | |
| }
 | |
| EXPORT_SYMBOL(dvb_usbv2_generic_write_locked);
 |