Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit e8f311a5 authored by Ian Abbott's avatar Ian Abbott Committed by Greg Kroah-Hartman
Browse files

staging: comedi: vmk80xx: simplify vmk80xx_reset_device()



vmk80xx_reset_device() is called during initialization of a Velleman
K8055 (aka VM110) to send a reset command to the hardware.  The current
function is a bit long-winded and doesn't set the TRANS_OUT_BUSY flag to
prevent re-use of the transmit buffer while the URB is in progress.

Rewrite the function to use vmk80xx_write_packet() to send the command.

Signed-off-by: default avatarIan Abbott <abbotti@mev.co.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 0cbfc826
Loading
Loading
Loading
Loading
+9 −35
Original line number Diff line number Diff line
@@ -277,41 +277,6 @@ static void vmk80xx_read_eeprom(struct vmk80xx_private *devpriv, int flag)
		strncpy(devpriv->fw.ic6_vers, rx + 25, 24);
}

static int vmk80xx_reset_device(struct vmk80xx_private *devpriv)
{
	struct usb_device *usb = devpriv->usb;
	unsigned char *tx_buf = devpriv->usb_tx_buf;
	struct urb *urb;
	unsigned int tx_pipe;
	int ival;
	size_t size;

	urb = usb_alloc_urb(0, GFP_KERNEL);
	if (!urb)
		return -ENOMEM;

	tx_pipe = usb_sndintpipe(usb, 0x01);

	ival = devpriv->ep_tx->bInterval;
	size = le16_to_cpu(devpriv->ep_tx->wMaxPacketSize);

	tx_buf[0] = VMK8055_CMD_RST;
	tx_buf[1] = 0x00;
	tx_buf[2] = 0x00;
	tx_buf[3] = 0x00;
	tx_buf[4] = 0x00;
	tx_buf[5] = 0x00;
	tx_buf[6] = 0x00;
	tx_buf[7] = 0x00;

	usb_fill_int_urb(urb, usb, tx_pipe, tx_buf, size,
			 vmk80xx_tx_callback, devpriv, ival);

	usb_anchor_urb(urb, &devpriv->tx_anchor);

	return usb_submit_urb(urb, GFP_KERNEL);
}

static void vmk80xx_build_int_urb(struct urb *urb, int flag)
{
	struct vmk80xx_private *devpriv = urb->context;
@@ -468,6 +433,15 @@ static int vmk80xx_write_packet(struct vmk80xx_private *devpriv, int cmd)
	return retval;
}

static int vmk80xx_reset_device(struct vmk80xx_private *devpriv)
{
	size_t size;

	size = le16_to_cpu(devpriv->ep_tx->wMaxPacketSize);
	memset(devpriv->usb_tx_buf, 0, size);
	return vmk80xx_write_packet(devpriv, VMK8055_CMD_RST);
}

#define DIR_IN  1
#define DIR_OUT 2