aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/staging/otus/wrap_usb.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/staging/otus/wrap_usb.c')
-rw-r--r--drivers/staging/otus/wrap_usb.c213
1 files changed, 103 insertions, 110 deletions
diff --git a/drivers/staging/otus/wrap_usb.c b/drivers/staging/otus/wrap_usb.c
index 70fd410bc894..6b336ede8867 100644
--- a/drivers/staging/otus/wrap_usb.c
+++ b/drivers/staging/otus/wrap_usb.c
@@ -30,159 +30,152 @@
#include <linux/netlink.h>
#include <net/iw_handler.h>
-extern void zfLnxInitUsbTxQ(zdev_t* dev);
-extern void zfLnxInitUsbRxQ(zdev_t* dev);
+extern void zfLnxInitUsbTxQ(zdev_t *dev);
+extern void zfLnxInitUsbRxQ(zdev_t *dev);
extern u32_t zfLnxSubmitRegInUrb(zdev_t *dev);
-u32_t zfLnxUsbOut(zdev_t* dev, u8_t *hdr, u16_t hdrlen, u8_t *snap, u16_t snapLen,
- u8_t *tail, u16_t tailLen, zbuf_t *buf, u16_t offset);
-u32_t zfLnxUsbWriteReg(zdev_t* dev, u32_t* cmd, u16_t cmdLen);
+u32_t zfLnxUsbOut(zdev_t *dev, u8_t *hdr, u16_t hdrlen, u8_t *snap,
+ u16_t snapLen, u8_t *tail, u16_t tailLen, zbuf_t *buf,
+ u16_t offset);
+u32_t zfLnxUsbWriteReg(zdev_t *dev, u32_t *cmd, u16_t cmdLen);
-void zfwUsbRegisterCallBack(zdev_t* dev, struct zfCbUsbFuncTbl *zfUsbFunc) {
- struct usbdrv_private *macp = dev->ml_priv;
+void zfwUsbRegisterCallBack(zdev_t *dev, struct zfCbUsbFuncTbl *zfUsbFunc)
+{
+ struct usbdrv_private *macp = dev->ml_priv;
- macp->usbCbFunctions.zfcbUsbRecv = zfUsbFunc->zfcbUsbRecv;
- macp->usbCbFunctions.zfcbUsbRegIn = zfUsbFunc->zfcbUsbRegIn;
- macp->usbCbFunctions.zfcbUsbOutComplete = zfUsbFunc->zfcbUsbOutComplete;
+ macp->usbCbFunctions.zfcbUsbRecv = zfUsbFunc->zfcbUsbRecv;
+ macp->usbCbFunctions.zfcbUsbRegIn = zfUsbFunc->zfcbUsbRegIn;
+ macp->usbCbFunctions.zfcbUsbOutComplete = zfUsbFunc->zfcbUsbOutComplete;
- return;
+ return;
}
-u32_t zfwUsbGetFreeTxQSize(zdev_t* dev)
+u32_t zfwUsbGetFreeTxQSize(zdev_t *dev)
{
- struct usbdrv_private *macp = dev->ml_priv;
- u32_t freeTxQSize;
- unsigned long irqFlag;
- //zmw_declare_for_critical_section();
+ struct usbdrv_private *macp = dev->ml_priv;
+ u32_t freeTxQSize;
+ unsigned long irqFlag;
+ /* zmw_declare_for_critical_section(); */
- //zmw_enter_critical_section(dev);
- spin_lock_irqsave(&macp->cs_lock, irqFlag);
+ /* zmw_enter_critical_section(dev); */
+ spin_lock_irqsave(&macp->cs_lock, irqFlag);
- freeTxQSize = ZM_MAX_TX_BUF_NUM - macp->TxBufCnt;
+ freeTxQSize = ZM_MAX_TX_BUF_NUM - macp->TxBufCnt;
- //zmw_leave_critical_section(dev);
- spin_unlock_irqrestore(&macp->cs_lock, irqFlag);
+ /* zmw_leave_critical_section(dev); */
+ spin_unlock_irqrestore(&macp->cs_lock, irqFlag);
- return freeTxQSize;
+ return freeTxQSize;
}
-u32_t zfwUsbGetMaxTxQSize(zdev_t* dev)
+u32_t zfwUsbGetMaxTxQSize(zdev_t *dev)
{
- return ZM_MAX_TX_BUF_NUM;
+ return ZM_MAX_TX_BUF_NUM;
}
u32_t zfwUsbEnableIntEpt(zdev_t *dev, u8_t endpt)
{
- /* Initialize USB TxQ */
- zfLnxInitUsbTxQ(dev);
+ /* Initialize USB TxQ */
+ zfLnxInitUsbTxQ(dev);
- /* Initialize USB RxQ */
- zfLnxInitUsbRxQ(dev);
+ /* Initialize USB RxQ */
+ zfLnxInitUsbRxQ(dev);
- /* Initialize USB Register In URB */
- //zfwUsbSubmitRegIn(dev);
- /* Initialize USB Register In URB */
- zfLnxSubmitRegInUrb(dev);
+ /* Initialize USB Register In URB */
+ /* zfwUsbSubmitRegIn(dev); */
+ /* Initialize USB Register In URB */
+ zfLnxSubmitRegInUrb(dev);
- return 0;
+ return 0;
}
-int zfwUsbEnableRxEpt(zdev_t* dev, u8_t endpt)
+int zfwUsbEnableRxEpt(zdev_t *dev, u8_t endpt)
{
- return 0;
+ return 0;
}
-u32_t zfwUsbSubmitControl(zdev_t* dev, u8_t req, u16_t value, u16_t index, void *data, u32_t size)
+u32_t zfwUsbSubmitControl(zdev_t *dev, u8_t req, u16_t value, u16_t index,
+ void *data, u32_t size)
{
- int result = 0;
- u32_t ret = 0;
- struct usbdrv_private *macp = dev->ml_priv;
- u8_t* buf;
-
- if (size > 0)
- {
- buf = kmalloc(size, GFP_KERNEL);
- memcpy(buf, (u8_t*)data, size);
- }
- else
- {
- buf = NULL;
- }
+ int result = 0;
+ u32_t ret = 0;
+ struct usbdrv_private *macp = dev->ml_priv;
+ u8_t *buf;
+
+ if (size > 0) {
+ buf = kmalloc(size, GFP_KERNEL);
+ memcpy(buf, (u8_t *)data, size);
+ } else
+ buf = NULL;
#if 0
- printk(KERN_ERR "req = 0x%02x\n", req);
- printk(KERN_ERR "value = 0x%04x\n", value);
- printk(KERN_ERR "index = 0x%04x\n", index);
- printk(KERN_ERR "data = 0x%lx\n", (u32_t) data);
- printk(KERN_ERR "size = %ld\n", size);
+ printk(KERN_ERR "req = 0x%02x\n", req);
+ printk(KERN_ERR "value = 0x%04x\n", value);
+ printk(KERN_ERR "index = 0x%04x\n", index);
+ printk(KERN_ERR "data = 0x%lx\n", (u32_t) data);
+ printk(KERN_ERR "size = %ld\n", size);
#endif
- result = usb_control_msg(macp->udev, usb_sndctrlpipe(macp->udev, 0),
- req, USB_DIR_OUT | 0x40, value, index, buf, size, HZ);
+ result = usb_control_msg(macp->udev, usb_sndctrlpipe(macp->udev, 0),
+ req, USB_DIR_OUT | 0x40, value, index, buf, size, HZ);
- if (result < 0)
- {
- printk("zfwUsbSubmitControl() failed, result=0x%x\n", result);
- ret = 1;
- }
- kfree(buf);
+ if (result < 0) {
+ printk(KERN_ERR "zfwUsbSubmitControl() failed, result = 0x%x\n",
+ result);
+ ret = 1;
+ }
+ kfree(buf);
- return ret;
+ return ret;
}
-void zfwUsbCmd(zdev_t* dev, u8_t endpt, u32_t* cmd, u16_t cmdLen)
+void zfwUsbCmd(zdev_t *dev, u8_t endpt, u32_t *cmd, u16_t cmdLen)
{
- struct usbdrv_private *macp = dev->ml_priv;
- u32_t ret;
-
- //MPUsbCommand(dev, endpt, cmd, cmdLen);
- ret = zfLnxUsbWriteReg(dev, cmd, cmdLen);
-
- /* if zfLnxUsbWriteReg() return error, free and allocate urb, resend again */
- if (ret != 0)
- {
- usb_free_urb(macp->RegOutUrb);
- macp->RegOutUrb = usb_alloc_urb(0, GFP_ATOMIC);
- ret = zfLnxUsbWriteReg(dev, cmd, cmdLen);
- }
+ struct usbdrv_private *macp = dev->ml_priv;
+ u32_t ret;
+
+ /* MPUsbCommand(dev, endpt, cmd, cmdLen); */
+ ret = zfLnxUsbWriteReg(dev, cmd, cmdLen);
+
+ /*
+ * if zfLnxUsbWriteReg() return error, free and allocate urb,
+ * resend again
+ */
+ if (ret != 0) {
+ usb_free_urb(macp->RegOutUrb);
+ macp->RegOutUrb = usb_alloc_urb(0, GFP_ATOMIC);
+ ret = zfLnxUsbWriteReg(dev, cmd, cmdLen);
+ }
}
-u32_t zfwUsbSend(zdev_t* dev, u8_t endpt, u8_t *hdr, u16_t hdrlen, u8_t *snap, u16_t snapLen,
- u8_t *tail, u16_t tailLen, zbuf_t *buf, u16_t offset)
+u32_t zfwUsbSend(zdev_t *dev, u8_t endpt, u8_t *hdr, u16_t hdrlen, u8_t *snap,
+ u16_t snapLen, u8_t *tail, u16_t tailLen,
+ zbuf_t *buf, u16_t offset)
{
- u32_t status;
+ u32_t status;
#ifdef ZM_CONFIG_BIG_ENDIAN
- u32_t ii = 0;
- u16_t *pc = NULL;
-
- pc = (u16_t *)hdr;
- for(ii=0; ii<(hdrlen>>1); ii++)
- {
- pc[ii] = cpu_to_le16(pc[ii]);
- }
-
- pc = (u16_t *)snap;
- for(ii=0; ii<(snapLen>>1); ii++)
- {
- pc[ii] = cpu_to_le16(pc[ii]);
- }
-
- pc = (u16_t *)tail;
- for(ii=0; ii<(tailLen>>1); ii++)
- {
- pc[ii] = cpu_to_le16(pc[ii]);
- }
+ u32_t ii = 0;
+ u16_t *pc = NULL;
+
+ pc = (u16_t *)hdr;
+ for (ii = 0; ii < (hdrlen >> 1); ii++)
+ pc[ii] = cpu_to_le16(pc[ii]);
+
+ pc = (u16_t *)snap;
+ for (ii = 0; ii < (snapLen >> 1); ii++)
+ pc[ii] = cpu_to_le16(pc[ii]);
+
+ pc = (u16_t *)tail;
+ for (ii = 0; ii < (tailLen>>1); ii++)
+ pc[ii] = cpu_to_le16(pc[ii]);
#endif
- status = zfLnxUsbOut(dev, hdr, hdrlen, snap, snapLen, tail, tailLen, buf, offset);
- if ( status == 0 )
- {
- return 0;
- }
- else
- {
- return 1;
- }
+ status = zfLnxUsbOut(dev, hdr, hdrlen, snap, snapLen, tail, tailLen,
+ buf, offset);
+ if (status == 0)
+ return 0;
+ else
+ return 1;
}
/* Leave an empty line below to remove warning message on some compiler */