123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579 |
- /**
- * Copyright (c) 2014 Redpine Signals Inc.
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- *
- */
- #include <linux/module.h>
- #include "rsi_usb.h"
- /**
- * rsi_usb_card_write() - This function writes to the USB Card.
- * @adapter: Pointer to the adapter structure.
- * @buf: Pointer to the buffer from where the data has to be taken.
- * @len: Length to be written.
- * @endpoint: Type of endpoint.
- *
- * Return: status: 0 on success, a negative error code on failure.
- */
- static int rsi_usb_card_write(struct rsi_hw *adapter,
- void *buf,
- u16 len,
- u8 endpoint)
- {
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- int status;
- s32 transfer;
- status = usb_bulk_msg(dev->usbdev,
- usb_sndbulkpipe(dev->usbdev,
- dev->bulkout_endpoint_addr[endpoint - 1]),
- buf,
- len,
- &transfer,
- HZ * 5);
- if (status < 0) {
- rsi_dbg(ERR_ZONE,
- "Card write failed with error code :%10d\n", status);
- dev->write_fail = 1;
- }
- return status;
- }
- /**
- * rsi_write_multiple() - This function writes multiple bytes of information
- * to the USB card.
- * @adapter: Pointer to the adapter structure.
- * @addr: Address of the register.
- * @data: Pointer to the data that has to be written.
- * @count: Number of multiple bytes to be written.
- *
- * Return: 0 on success, a negative error code on failure.
- */
- static int rsi_write_multiple(struct rsi_hw *adapter,
- u8 endpoint,
- u8 *data,
- u32 count)
- {
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- u8 *seg = dev->tx_buffer;
- if (dev->write_fail)
- return 0;
- 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);
- }
- return rsi_usb_card_write(adapter,
- seg,
- count + RSI_USB_TX_HEAD_ROOM,
- endpoint);
- }
- /**
- * rsi_find_bulk_in_and_out_endpoints() - This function initializes the bulk
- * endpoints to the device.
- * @interface: Pointer to the USB interface structure.
- * @adapter: Pointer to the adapter structure.
- *
- * Return: ret_val: 0 on success, -ENOMEM on failure.
- */
- static int rsi_find_bulk_in_and_out_endpoints(struct usb_interface *interface,
- struct rsi_hw *adapter)
- {
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- struct usb_host_interface *iface_desc;
- struct usb_endpoint_descriptor *endpoint;
- __le16 buffer_size;
- int ii, bep_found = 0;
- iface_desc = &(interface->altsetting[0]);
- for (ii = 0; ii < iface_desc->desc.bNumEndpoints; ++ii) {
- endpoint = &(iface_desc->endpoint[ii].desc);
- if ((!(dev->bulkin_endpoint_addr)) &&
- (endpoint->bEndpointAddress & USB_DIR_IN) &&
- ((endpoint->bmAttributes &
- USB_ENDPOINT_XFERTYPE_MASK) ==
- USB_ENDPOINT_XFER_BULK)) {
- buffer_size = endpoint->wMaxPacketSize;
- dev->bulkin_size = buffer_size;
- dev->bulkin_endpoint_addr =
- endpoint->bEndpointAddress;
- }
- if (!dev->bulkout_endpoint_addr[bep_found] &&
- !(endpoint->bEndpointAddress & USB_DIR_IN) &&
- ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
- USB_ENDPOINT_XFER_BULK)) {
- dev->bulkout_endpoint_addr[bep_found] =
- endpoint->bEndpointAddress;
- buffer_size = endpoint->wMaxPacketSize;
- dev->bulkout_size[bep_found] = buffer_size;
- bep_found++;
- }
- if (bep_found >= MAX_BULK_EP)
- break;
- }
- if (!(dev->bulkin_endpoint_addr) &&
- (dev->bulkout_endpoint_addr[0]))
- return -EINVAL;
- return 0;
- }
- /* rsi_usb_reg_read() - This function reads data from given register address.
- * @usbdev: Pointer to the usb_device structure.
- * @reg: Address of the register to be read.
- * @value: Value to be read.
- * @len: length of data to be read.
- *
- * Return: status: 0 on success, a negative error code on failure.
- */
- static int rsi_usb_reg_read(struct usb_device *usbdev,
- u32 reg,
- u16 *value,
- u16 len)
- {
- u8 *buf;
- int status = -ENOMEM;
- buf = kmalloc(0x04, GFP_KERNEL);
- if (!buf)
- return status;
- status = usb_control_msg(usbdev,
- usb_rcvctrlpipe(usbdev, 0),
- USB_VENDOR_REGISTER_READ,
- USB_TYPE_VENDOR,
- ((reg & 0xffff0000) >> 16), (reg & 0xffff),
- (void *)buf,
- len,
- HZ * 5);
- *value = (buf[0] | (buf[1] << 8));
- if (status < 0) {
- rsi_dbg(ERR_ZONE,
- "%s: Reg read failed with error code :%d\n",
- __func__, status);
- }
- kfree(buf);
- return status;
- }
- /**
- * rsi_usb_reg_write() - This function writes the given data into the given
- * register address.
- * @usbdev: Pointer to the usb_device structure.
- * @reg: Address of the register.
- * @value: Value to write.
- * @len: Length of data to be written.
- *
- * Return: status: 0 on success, a negative error code on failure.
- */
- static int rsi_usb_reg_write(struct usb_device *usbdev,
- u32 reg,
- u16 value,
- u16 len)
- {
- u8 *usb_reg_buf;
- int status = -ENOMEM;
- usb_reg_buf = kmalloc(0x04, GFP_KERNEL);
- if (!usb_reg_buf)
- return status;
- usb_reg_buf[0] = (value & 0x00ff);
- usb_reg_buf[1] = (value & 0xff00) >> 8;
- usb_reg_buf[2] = 0x0;
- usb_reg_buf[3] = 0x0;
- status = usb_control_msg(usbdev,
- usb_sndctrlpipe(usbdev, 0),
- USB_VENDOR_REGISTER_WRITE,
- USB_TYPE_VENDOR,
- ((reg & 0xffff0000) >> 16),
- (reg & 0xffff),
- (void *)usb_reg_buf,
- len,
- HZ * 5);
- if (status < 0) {
- rsi_dbg(ERR_ZONE,
- "%s: Reg write failed with error code :%d\n",
- __func__, status);
- }
- kfree(usb_reg_buf);
- return status;
- }
- /**
- * rsi_rx_done_handler() - This function is called when a packet is received
- * from USB stack. This is callback to recieve done.
- * @urb: Received URB.
- *
- * Return: None.
- */
- static void rsi_rx_done_handler(struct urb *urb)
- {
- struct rsi_hw *adapter = urb->context;
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- if (urb->status)
- return;
- rsi_set_event(&dev->rx_thread.event);
- }
- /**
- * rsi_rx_urb_submit() - This function submits the given URB to the USB stack.
- * @adapter: Pointer to the adapter structure.
- *
- * Return: 0 on success, a negative error code on failure.
- */
- static int rsi_rx_urb_submit(struct rsi_hw *adapter)
- {
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- struct urb *urb = dev->rx_usb_urb[0];
- int status;
- usb_fill_bulk_urb(urb,
- dev->usbdev,
- usb_rcvbulkpipe(dev->usbdev,
- dev->bulkin_endpoint_addr),
- urb->transfer_buffer,
- 3000,
- rsi_rx_done_handler,
- adapter);
- status = usb_submit_urb(urb, GFP_KERNEL);
- if (status)
- rsi_dbg(ERR_ZONE, "%s: Failed in urb submission\n", __func__);
- return status;
- }
- /**
- * rsi_usb_write_register_multiple() - This function writes multiple bytes of
- * information to multiple registers.
- * @adapter: Pointer to the adapter structure.
- * @addr: Address of the register.
- * @data: Pointer to the data that has to be written.
- * @count: Number of multiple bytes to be written on to the registers.
- *
- * Return: status: 0 on success, a negative error code on failure.
- */
- int rsi_usb_write_register_multiple(struct rsi_hw *adapter,
- u32 addr,
- u8 *data,
- u32 count)
- {
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- u8 *buf;
- u8 transfer;
- int status = 0;
- buf = kzalloc(4096, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- while (count) {
- transfer = (u8)(min_t(u32, count, 4096));
- memcpy(buf, data, transfer);
- status = usb_control_msg(dev->usbdev,
- usb_sndctrlpipe(dev->usbdev, 0),
- USB_VENDOR_REGISTER_WRITE,
- USB_TYPE_VENDOR,
- ((addr & 0xffff0000) >> 16),
- (addr & 0xffff),
- (void *)buf,
- transfer,
- HZ * 5);
- if (status < 0) {
- rsi_dbg(ERR_ZONE,
- "Reg write failed with error code :%d\n",
- status);
- } else {
- count -= transfer;
- data += transfer;
- addr += transfer;
- }
- }
- kfree(buf);
- return 0;
- }
- /**
- *rsi_usb_host_intf_write_pkt() - This function writes the packet to the
- * USB card.
- * @adapter: Pointer to the adapter structure.
- * @pkt: Pointer to the data to be written on to the card.
- * @len: Length of the data to be written on to the card.
- *
- * Return: 0 on success, a negative error code on failure.
- */
- static int rsi_usb_host_intf_write_pkt(struct rsi_hw *adapter,
- u8 *pkt,
- u32 len)
- {
- u32 queueno = ((pkt[1] >> 4) & 0xf);
- u8 endpoint;
- endpoint = ((queueno == RSI_WIFI_MGMT_Q) ? MGMT_EP : DATA_EP);
- return rsi_write_multiple(adapter,
- endpoint,
- (u8 *)pkt,
- len);
- }
- /**
- * rsi_deinit_usb_interface() - This function deinitializes the usb interface.
- * @adapter: Pointer to the adapter structure.
- *
- * Return: None.
- */
- static void rsi_deinit_usb_interface(struct rsi_hw *adapter)
- {
- struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- rsi_kill_thread(&dev->rx_thread);
- usb_free_urb(dev->rx_usb_urb[0]);
- kfree(adapter->priv->rx_data_pkt);
- kfree(dev->tx_buffer);
- }
- /**
- * rsi_init_usb_interface() - This function initializes the usb interface.
- * @adapter: Pointer to the adapter structure.
- * @pfunction: Pointer to USB interface structure.
- *
- * Return: 0 on success, a negative error code on failure.
- */
- static int rsi_init_usb_interface(struct rsi_hw *adapter,
- struct usb_interface *pfunction)
- {
- struct rsi_91x_usbdev *rsi_dev;
- struct rsi_common *common = adapter->priv;
- int status;
- rsi_dev = kzalloc(sizeof(*rsi_dev), GFP_KERNEL);
- if (!rsi_dev)
- return -ENOMEM;
- adapter->rsi_dev = rsi_dev;
- rsi_dev->usbdev = interface_to_usbdev(pfunction);
- if (rsi_find_bulk_in_and_out_endpoints(pfunction, adapter))
- return -EINVAL;
- adapter->device = &pfunction->dev;
- usb_set_intfdata(pfunction, adapter);
- common->rx_data_pkt = kmalloc(2048, GFP_KERNEL);
- if (!common->rx_data_pkt) {
- rsi_dbg(ERR_ZONE, "%s: Failed to allocate memory\n",
- __func__);
- return -ENOMEM;
- }
- rsi_dev->tx_buffer = kmalloc(2048, GFP_KERNEL);
- if (!rsi_dev->tx_buffer) {
- status = -ENOMEM;
- goto fail_tx;
- }
- rsi_dev->rx_usb_urb[0] = usb_alloc_urb(0, GFP_KERNEL);
- if (!rsi_dev->rx_usb_urb[0]) {
- status = -ENOMEM;
- goto fail_rx;
- }
- rsi_dev->rx_usb_urb[0]->transfer_buffer = adapter->priv->rx_data_pkt;
- rsi_dev->tx_blk_size = 252;
- /* Initializing function callbacks */
- adapter->rx_urb_submit = rsi_rx_urb_submit;
- adapter->host_intf_write_pkt = rsi_usb_host_intf_write_pkt;
- adapter->check_hw_queue_status = rsi_usb_check_queue_status;
- adapter->determine_event_timeout = rsi_usb_event_timeout;
- rsi_init_event(&rsi_dev->rx_thread.event);
- status = rsi_create_kthread(common, &rsi_dev->rx_thread,
- rsi_usb_rx_thread, "RX-Thread");
- if (status) {
- rsi_dbg(ERR_ZONE, "%s: Unable to init rx thrd\n", __func__);
- goto fail_thread;
- }
- #ifdef CONFIG_RSI_DEBUGFS
- /* In USB, one less than the MAX_DEBUGFS_ENTRIES entries is required */
- adapter->num_debugfs_entries = (MAX_DEBUGFS_ENTRIES - 1);
- #endif
- rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
- return 0;
- fail_thread:
- usb_free_urb(rsi_dev->rx_usb_urb[0]);
- fail_rx:
- kfree(rsi_dev->tx_buffer);
- fail_tx:
- kfree(common->rx_data_pkt);
- return status;
- }
- /**
- * rsi_probe() - This function is called by kernel when the driver provided
- * Vendor and device IDs are matched. All the initialization
- * work is done here.
- * @pfunction: Pointer to the USB interface structure.
- * @id: Pointer to the usb_device_id structure.
- *
- * Return: 0 on success, a negative error code on failure.
- */
- static int rsi_probe(struct usb_interface *pfunction,
- const struct usb_device_id *id)
- {
- struct rsi_hw *adapter;
- struct rsi_91x_usbdev *dev;
- u16 fw_status;
- int status;
- rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
- adapter = rsi_91x_init();
- if (!adapter) {
- rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
- __func__);
- return -ENOMEM;
- }
- status = rsi_init_usb_interface(adapter, pfunction);
- if (status) {
- rsi_dbg(ERR_ZONE, "%s: Failed to init usb interface\n",
- __func__);
- goto err;
- }
- rsi_dbg(ERR_ZONE, "%s: Initialized os intf ops\n", __func__);
- dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
- status = rsi_usb_reg_read(dev->usbdev, FW_STATUS_REG, &fw_status, 2);
- if (status)
- goto err1;
- else
- fw_status &= 1;
- if (!fw_status) {
- status = rsi_usb_device_init(adapter->priv);
- if (status) {
- rsi_dbg(ERR_ZONE, "%s: Failed in device init\n",
- __func__);
- goto err1;
- }
- status = rsi_usb_reg_write(dev->usbdev,
- USB_INTERNAL_REG_1,
- RSI_USB_READY_MAGIC_NUM, 1);
- if (status)
- goto err1;
- rsi_dbg(INIT_ZONE, "%s: Performed device init\n", __func__);
- }
- status = rsi_rx_urb_submit(adapter);
- if (status)
- goto err1;
- return 0;
- err1:
- rsi_deinit_usb_interface(adapter);
- err:
- rsi_91x_deinit(adapter);
- rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
- return status;
- }
- /**
- * rsi_disconnect() - This function performs the reverse of the probe function,
- * it deintialize the driver structure.
- * @pfunction: Pointer to the USB interface structure.
- *
- * Return: None.
- */
- static void rsi_disconnect(struct usb_interface *pfunction)
- {
- struct rsi_hw *adapter = usb_get_intfdata(pfunction);
- if (!adapter)
- return;
- rsi_mac80211_detach(adapter);
- rsi_deinit_usb_interface(adapter);
- rsi_91x_deinit(adapter);
- rsi_dbg(INFO_ZONE, "%s: Deinitialization completed\n", __func__);
- }
- #ifdef CONFIG_PM
- static int rsi_suspend(struct usb_interface *intf, pm_message_t message)
- {
- /* Not yet implemented */
- return -ENOSYS;
- }
- static int rsi_resume(struct usb_interface *intf)
- {
- /* Not yet implemented */
- return -ENOSYS;
- }
- #endif
- static const struct usb_device_id rsi_dev_table[] = {
- { USB_DEVICE(0x0303, 0x0100) },
- { USB_DEVICE(0x041B, 0x0301) },
- { USB_DEVICE(0x041B, 0x0201) },
- { USB_DEVICE(0x041B, 0x9330) },
- { /* Blank */},
- };
- static struct usb_driver rsi_driver = {
- .name = "RSI-USB WLAN",
- .probe = rsi_probe,
- .disconnect = rsi_disconnect,
- .id_table = rsi_dev_table,
- #ifdef CONFIG_PM
- .suspend = rsi_suspend,
- .resume = rsi_resume,
- #endif
- };
- module_usb_driver(rsi_driver);
- MODULE_AUTHOR("Redpine Signals Inc");
- MODULE_DESCRIPTION("Common USB layer for RSI drivers");
- MODULE_SUPPORTED_DEVICE("RSI-91x");
- MODULE_DEVICE_TABLE(usb, rsi_dev_table);
- MODULE_FIRMWARE(FIRMWARE_RSI9113);
- MODULE_VERSION("0.1");
- MODULE_LICENSE("Dual BSD/GPL");
|