|
@@ -29,19 +29,24 @@
|
|
|
* Return: status: 0 on success, a negative error code on failure.
|
|
|
*/
|
|
|
static int rsi_usb_card_write(struct rsi_hw *adapter,
|
|
|
- void *buf,
|
|
|
+ u8 *buf,
|
|
|
u16 len,
|
|
|
u8 endpoint)
|
|
|
{
|
|
|
struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
|
|
|
int status;
|
|
|
- s32 transfer;
|
|
|
+ u8 *seg = dev->tx_buffer;
|
|
|
+ int transfer;
|
|
|
+ int ep = dev->bulkout_endpoint_addr[endpoint - 1];
|
|
|
|
|
|
+ memset(seg, 0, len + RSI_USB_TX_HEAD_ROOM);
|
|
|
+ memcpy(seg + RSI_USB_TX_HEAD_ROOM, buf, len);
|
|
|
+ len += RSI_USB_TX_HEAD_ROOM;
|
|
|
+ transfer = len;
|
|
|
status = usb_bulk_msg(dev->usbdev,
|
|
|
- usb_sndbulkpipe(dev->usbdev,
|
|
|
- dev->bulkout_endpoint_addr[endpoint - 1]),
|
|
|
- buf,
|
|
|
- len,
|
|
|
+ usb_sndbulkpipe(dev->usbdev, ep),
|
|
|
+ (void *)seg,
|
|
|
+ (int)len,
|
|
|
&transfer,
|
|
|
HZ * 5);
|
|
|
|
|
@@ -68,23 +73,19 @@ static int rsi_write_multiple(struct rsi_hw *adapter,
|
|
|
u8 *data,
|
|
|
u32 count)
|
|
|
{
|
|
|
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
|
|
|
- u8 *seg = dev->tx_buffer;
|
|
|
+ struct rsi_91x_usbdev *dev =
|
|
|
+ (struct rsi_91x_usbdev *)adapter->rsi_dev;
|
|
|
|
|
|
- if (dev->write_fail)
|
|
|
- return 0;
|
|
|
+ if (!adapter)
|
|
|
+ return -ENODEV;
|
|
|
|
|
|
- if (endpoint == MGMT_EP) {
|
|
|
- memset(seg, 0, RSI_USB_TX_HEAD_ROOM);
|
|
|
- memcpy(seg + RSI_USB_TX_HEAD_ROOM, data, count);
|
|
|
- } else {
|
|
|
- seg = ((u8 *)data - RSI_USB_TX_HEAD_ROOM);
|
|
|
- }
|
|
|
+ if (endpoint == 0)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ if (dev->write_fail)
|
|
|
+ return -ENETDOWN;
|
|
|
|
|
|
- return rsi_usb_card_write(adapter,
|
|
|
- seg,
|
|
|
- count + RSI_USB_TX_HEAD_ROOM,
|
|
|
- endpoint);
|
|
|
+ return rsi_usb_card_write(adapter, data, count, endpoint);
|
|
|
}
|
|
|
|
|
|
/**
|