diff options
| -rw-r--r-- | drivers/net/wimax/i2400m/usb-notif.c | 269 | ||||
| -rw-r--r-- | drivers/net/wimax/i2400m/usb-rx.c | 417 | ||||
| -rw-r--r-- | drivers/net/wimax/i2400m/usb-tx.c | 229 |
3 files changed, 915 insertions, 0 deletions
diff --git a/drivers/net/wimax/i2400m/usb-notif.c b/drivers/net/wimax/i2400m/usb-notif.c new file mode 100644 index 000000000000..9702c22b2497 --- /dev/null +++ b/drivers/net/wimax/i2400m/usb-notif.c | |||
| @@ -0,0 +1,269 @@ | |||
| 1 | /* | ||
| 2 | * Intel Wireless WiMAX Connection 2400m over USB | ||
| 3 | * Notification handling | ||
| 4 | * | ||
| 5 | * | ||
| 6 | * Copyright (C) 2007-2008 Intel Corporation. All rights reserved. | ||
| 7 | * | ||
| 8 | * Redistribution and use in source and binary forms, with or without | ||
| 9 | * modification, are permitted provided that the following conditions | ||
| 10 | * are met: | ||
| 11 | * | ||
| 12 | * * Redistributions of source code must retain the above copyright | ||
| 13 | * notice, this list of conditions and the following disclaimer. | ||
| 14 | * * Redistributions in binary form must reproduce the above copyright | ||
| 15 | * notice, this list of conditions and the following disclaimer in | ||
| 16 | * the documentation and/or other materials provided with the | ||
| 17 | * distribution. | ||
| 18 | * * Neither the name of Intel Corporation nor the names of its | ||
| 19 | * contributors may be used to endorse or promote products derived | ||
| 20 | * from this software without specific prior written permission. | ||
| 21 | * | ||
| 22 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | ||
| 23 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | ||
| 24 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | ||
| 25 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | ||
| 26 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | ||
| 27 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | ||
| 28 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | ||
| 29 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | ||
| 30 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | ||
| 31 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | ||
| 32 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||
| 33 | * | ||
| 34 | * | ||
| 35 | * Intel Corporation <linux-wimax@intel.com> | ||
| 36 | * Yanir Lubetkin <yanirx.lubetkin@intel.com> | ||
| 37 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
| 38 | * - Initial implementation | ||
| 39 | * | ||
| 40 | * | ||
| 41 | * The notification endpoint is active when the device is not in boot | ||
| 42 | * mode; in here we just read and get notifications; based on those, | ||
| 43 | * we act to either reinitialize the device after a reboot or to | ||
| 44 | * submit a RX request. | ||
| 45 | * | ||
| 46 | * ROADMAP | ||
| 47 | * | ||
| 48 | * i2400mu_usb_notification_setup() | ||
| 49 | * | ||
| 50 | * i2400mu_usb_notification_release() | ||
| 51 | * | ||
| 52 | * i2400mu_usb_notification_cb() Called when a URB is ready | ||
| 53 | * i2400mu_notif_grok() | ||
| 54 | * i2400m_dev_reset_handle() | ||
| 55 | * i2400mu_rx_kick() | ||
| 56 | */ | ||
| 57 | #include <linux/usb.h> | ||
| 58 | #include "i2400m-usb.h" | ||
| 59 | |||
| 60 | |||
| 61 | #define D_SUBMODULE notif | ||
| 62 | #include "usb-debug-levels.h" | ||
| 63 | |||
| 64 | |||
| 65 | static const | ||
| 66 | __le32 i2400m_ZERO_BARKER[4] = { 0, 0, 0, 0 }; | ||
| 67 | |||
| 68 | |||
| 69 | /* | ||
| 70 | * Process a received notification | ||
| 71 | * | ||
| 72 | * In normal operation mode, we can only receive two types of payloads | ||
| 73 | * on the notification endpoint: | ||
| 74 | * | ||
| 75 | * - a reboot barker, we do a bootstrap (the device has reseted). | ||
| 76 | * | ||
| 77 | * - a block of zeroes: there is pending data in the IN endpoint | ||
| 78 | */ | ||
| 79 | static | ||
| 80 | int i2400mu_notification_grok(struct i2400mu *i2400mu, const void *buf, | ||
| 81 | size_t buf_len) | ||
| 82 | { | ||
| 83 | int ret; | ||
| 84 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 85 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 86 | |||
| 87 | d_fnstart(4, dev, "(i2400m %p buf %p buf_len %zu)\n", | ||
| 88 | i2400mu, buf, buf_len); | ||
| 89 | ret = -EIO; | ||
| 90 | if (buf_len < sizeof(i2400m_NBOOT_BARKER)) | ||
| 91 | /* Not a bug, just ignore */ | ||
| 92 | goto error_bad_size; | ||
| 93 | if (!memcmp(i2400m_NBOOT_BARKER, buf, sizeof(i2400m_NBOOT_BARKER)) | ||
| 94 | || !memcmp(i2400m_SBOOT_BARKER, buf, sizeof(i2400m_SBOOT_BARKER))) | ||
| 95 | ret = i2400m_dev_reset_handle(i2400m); | ||
| 96 | else if (!memcmp(i2400m_ZERO_BARKER, buf, sizeof(i2400m_ZERO_BARKER))) { | ||
| 97 | i2400mu_rx_kick(i2400mu); | ||
| 98 | ret = 0; | ||
| 99 | } else { /* Unknown or unexpected data in the notif message */ | ||
| 100 | char prefix[64]; | ||
| 101 | ret = -EIO; | ||
| 102 | dev_err(dev, "HW BUG? Unknown/unexpected data in notification " | ||
| 103 | "message (%zu bytes)\n", buf_len); | ||
| 104 | snprintf(prefix, sizeof(prefix), "%s %s: ", | ||
| 105 | dev_driver_string(dev) , dev->bus_id); | ||
| 106 | if (buf_len > 64) { | ||
| 107 | print_hex_dump(KERN_ERR, prefix, DUMP_PREFIX_OFFSET, | ||
| 108 | 8, 4, buf, 64, 0); | ||
| 109 | printk(KERN_ERR "%s... (only first 64 bytes " | ||
| 110 | "dumped)\n", prefix); | ||
| 111 | } else | ||
| 112 | print_hex_dump(KERN_ERR, prefix, DUMP_PREFIX_OFFSET, | ||
| 113 | 8, 4, buf, buf_len, 0); | ||
| 114 | } | ||
| 115 | error_bad_size: | ||
| 116 | d_fnend(4, dev, "(i2400m %p buf %p buf_len %zu) = %d\n", | ||
| 117 | i2400mu, buf, buf_len, ret); | ||
| 118 | return ret; | ||
| 119 | } | ||
| 120 | |||
| 121 | |||
| 122 | /* | ||
| 123 | * URB callback for the notification endpoint | ||
| 124 | * | ||
| 125 | * @urb: the urb received from the notification endpoint | ||
| 126 | * | ||
| 127 | * This function will just process the USB side of the transaction, | ||
| 128 | * checking everything is fine, pass the processing to | ||
| 129 | * i2400m_notification_grok() and resubmit the URB. | ||
| 130 | */ | ||
| 131 | static | ||
| 132 | void i2400mu_notification_cb(struct urb *urb) | ||
| 133 | { | ||
| 134 | int ret; | ||
| 135 | struct i2400mu *i2400mu = urb->context; | ||
| 136 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 137 | |||
| 138 | d_fnstart(4, dev, "(urb %p status %d actual_length %d)\n", | ||
| 139 | urb, urb->status, urb->actual_length); | ||
| 140 | ret = urb->status; | ||
| 141 | switch (ret) { | ||
| 142 | case 0: | ||
| 143 | ret = i2400mu_notification_grok(i2400mu, urb->transfer_buffer, | ||
| 144 | urb->actual_length); | ||
| 145 | if (ret == -EIO && edc_inc(&i2400mu->urb_edc, EDC_MAX_ERRORS, | ||
| 146 | EDC_ERROR_TIMEFRAME)) | ||
| 147 | goto error_exceeded; | ||
| 148 | if (ret == -ENOMEM) /* uff...power cycle? shutdown? */ | ||
| 149 | goto error_exceeded; | ||
| 150 | break; | ||
| 151 | case -EINVAL: /* while removing driver */ | ||
| 152 | case -ENODEV: /* dev disconnect ... */ | ||
| 153 | case -ENOENT: /* ditto */ | ||
| 154 | case -ESHUTDOWN: /* URB killed */ | ||
| 155 | case -ECONNRESET: /* disconnection */ | ||
| 156 | goto out; /* Notify around */ | ||
| 157 | default: /* Some error? */ | ||
| 158 | if (edc_inc(&i2400mu->urb_edc, | ||
| 159 | EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) | ||
| 160 | goto error_exceeded; | ||
| 161 | dev_err(dev, "notification: URB error %d, retrying\n", | ||
| 162 | urb->status); | ||
| 163 | } | ||
| 164 | usb_mark_last_busy(i2400mu->usb_dev); | ||
| 165 | ret = usb_submit_urb(i2400mu->notif_urb, GFP_ATOMIC); | ||
| 166 | switch (ret) { | ||
| 167 | case 0: | ||
| 168 | case -EINVAL: /* while removing driver */ | ||
| 169 | case -ENODEV: /* dev disconnect ... */ | ||
| 170 | case -ENOENT: /* ditto */ | ||
| 171 | case -ESHUTDOWN: /* URB killed */ | ||
| 172 | case -ECONNRESET: /* disconnection */ | ||
| 173 | break; /* just ignore */ | ||
| 174 | default: /* Some error? */ | ||
| 175 | dev_err(dev, "notification: cannot submit URB: %d\n", ret); | ||
| 176 | goto error_submit; | ||
| 177 | } | ||
| 178 | d_fnend(4, dev, "(urb %p status %d actual_length %d) = void\n", | ||
| 179 | urb, urb->status, urb->actual_length); | ||
| 180 | return; | ||
| 181 | |||
| 182 | error_exceeded: | ||
| 183 | dev_err(dev, "maximum errors in notification URB exceeded; " | ||
| 184 | "resetting device\n"); | ||
| 185 | error_submit: | ||
| 186 | usb_queue_reset_device(i2400mu->usb_iface); | ||
| 187 | out: | ||
| 188 | d_fnend(4, dev, "(urb %p status %d actual_length %d) = void\n", | ||
| 189 | urb, urb->status, urb->actual_length); | ||
| 190 | return; | ||
| 191 | } | ||
| 192 | |||
| 193 | |||
| 194 | /* | ||
| 195 | * setup the notification endpoint | ||
| 196 | * | ||
| 197 | * @i2400m: device descriptor | ||
| 198 | * | ||
| 199 | * This procedure prepares the notification urb and handler for receiving | ||
| 200 | * unsolicited barkers from the device. | ||
| 201 | */ | ||
| 202 | int i2400mu_notification_setup(struct i2400mu *i2400mu) | ||
| 203 | { | ||
| 204 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 205 | int usb_pipe, ret = 0; | ||
| 206 | struct usb_endpoint_descriptor *epd; | ||
| 207 | char *buf; | ||
| 208 | |||
| 209 | d_fnstart(4, dev, "(i2400m %p)\n", i2400mu); | ||
| 210 | buf = kmalloc(I2400MU_MAX_NOTIFICATION_LEN, GFP_KERNEL | GFP_DMA); | ||
| 211 | if (buf == NULL) { | ||
| 212 | dev_err(dev, "notification: buffer allocation failed\n"); | ||
| 213 | ret = -ENOMEM; | ||
| 214 | goto error_buf_alloc; | ||
| 215 | } | ||
| 216 | |||
| 217 | i2400mu->notif_urb = usb_alloc_urb(0, GFP_KERNEL); | ||
| 218 | if (!i2400mu->notif_urb) { | ||
| 219 | ret = -ENOMEM; | ||
| 220 | dev_err(dev, "notification: cannot allocate URB\n"); | ||
| 221 | goto error_alloc_urb; | ||
| 222 | } | ||
| 223 | epd = usb_get_epd(i2400mu->usb_iface, I2400MU_EP_NOTIFICATION); | ||
| 224 | usb_pipe = usb_rcvintpipe(i2400mu->usb_dev, epd->bEndpointAddress); | ||
| 225 | usb_fill_int_urb(i2400mu->notif_urb, i2400mu->usb_dev, usb_pipe, | ||
| 226 | buf, I2400MU_MAX_NOTIFICATION_LEN, | ||
| 227 | i2400mu_notification_cb, i2400mu, epd->bInterval); | ||
| 228 | ret = usb_submit_urb(i2400mu->notif_urb, GFP_KERNEL); | ||
| 229 | if (ret != 0) { | ||
| 230 | dev_err(dev, "notification: cannot submit URB: %d\n", ret); | ||
| 231 | goto error_submit; | ||
| 232 | } | ||
| 233 | d_fnend(4, dev, "(i2400m %p) = %d\n", i2400mu, ret); | ||
| 234 | return ret; | ||
| 235 | |||
| 236 | error_submit: | ||
| 237 | usb_free_urb(i2400mu->notif_urb); | ||
| 238 | error_alloc_urb: | ||
| 239 | kfree(buf); | ||
| 240 | error_buf_alloc: | ||
| 241 | d_fnend(4, dev, "(i2400m %p) = %d\n", i2400mu, ret); | ||
| 242 | return ret; | ||
| 243 | } | ||
| 244 | |||
| 245 | |||
| 246 | /* | ||
| 247 | * Tear down of the notification mechanism | ||
| 248 | * | ||
| 249 | * @i2400m: device descriptor | ||
| 250 | * | ||
| 251 | * Kill the interrupt endpoint urb, free any allocated resources. | ||
| 252 | * | ||
| 253 | * We need to check if we have done it before as for example, | ||
| 254 | * _suspend() call this; if after a suspend() we get a _disconnect() | ||
| 255 | * (as the case is when hibernating), nothing bad happens. | ||
| 256 | */ | ||
| 257 | void i2400mu_notification_release(struct i2400mu *i2400mu) | ||
| 258 | { | ||
| 259 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 260 | |||
| 261 | d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu); | ||
| 262 | if (i2400mu->notif_urb != NULL) { | ||
| 263 | usb_kill_urb(i2400mu->notif_urb); | ||
| 264 | kfree(i2400mu->notif_urb->transfer_buffer); | ||
| 265 | usb_free_urb(i2400mu->notif_urb); | ||
| 266 | i2400mu->notif_urb = NULL; | ||
| 267 | } | ||
| 268 | d_fnend(4, dev, "(i2400mu %p)\n", i2400mu); | ||
| 269 | } | ||
diff --git a/drivers/net/wimax/i2400m/usb-rx.c b/drivers/net/wimax/i2400m/usb-rx.c new file mode 100644 index 000000000000..074cc1f89853 --- /dev/null +++ b/drivers/net/wimax/i2400m/usb-rx.c | |||
| @@ -0,0 +1,417 @@ | |||
| 1 | /* | ||
| 2 | * Intel Wireless WiMAX Connection 2400m | ||
| 3 | * USB RX handling | ||
| 4 | * | ||
| 5 | * | ||
| 6 | * Copyright (C) 2007-2008 Intel Corporation. All rights reserved. | ||
| 7 | * | ||
| 8 | * Redistribution and use in source and binary forms, with or without | ||
| 9 | * modification, are permitted provided that the following conditions | ||
| 10 | * are met: | ||
| 11 | * | ||
| 12 | * * Redistributions of source code must retain the above copyright | ||
| 13 | * notice, this list of conditions and the following disclaimer. | ||
| 14 | * * Redistributions in binary form must reproduce the above copyright | ||
| 15 | * notice, this list of conditions and the following disclaimer in | ||
| 16 | * the documentation and/or other materials provided with the | ||
| 17 | * distribution. | ||
| 18 | * * Neither the name of Intel Corporation nor the names of its | ||
| 19 | * contributors may be used to endorse or promote products derived | ||
| 20 | * from this software without specific prior written permission. | ||
| 21 | * | ||
| 22 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | ||
| 23 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | ||
| 24 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | ||
| 25 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | ||
| 26 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | ||
| 27 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | ||
| 28 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | ||
| 29 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | ||
| 30 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | ||
| 31 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | ||
| 32 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||
| 33 | * | ||
| 34 | * | ||
| 35 | * Intel Corporation <linux-wimax@intel.com> | ||
| 36 | * Yanir Lubetkin <yanirx.lubetkin@intel.com> | ||
| 37 | * - Initial implementation | ||
| 38 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
| 39 | * - Use skb_clone(), break up processing in chunks | ||
| 40 | * - Split transport/device specific | ||
| 41 | * - Make buffer size dynamic to exert less memory pressure | ||
| 42 | * | ||
| 43 | * | ||
| 44 | * This handles the RX path on USB. | ||
| 45 | * | ||
| 46 | * When a notification is received that says 'there is RX data ready', | ||
| 47 | * we call i2400mu_rx_kick(); that wakes up the RX kthread, which | ||
| 48 | * reads a buffer from USB and passes it to i2400m_rx() in the generic | ||
| 49 | * handling code. The RX buffer has an specific format that is | ||
| 50 | * described in rx.c. | ||
| 51 | * | ||
| 52 | * We use a kernel thread in a loop because: | ||
| 53 | * | ||
| 54 | * - we want to be able to call the USB power management get/put | ||
| 55 | * functions (blocking) before each transaction. | ||
| 56 | * | ||
| 57 | * - We might get a lot of notifications and we don't want to submit | ||
| 58 | * a zillion reads; by serializing, we are throttling. | ||
| 59 | * | ||
| 60 | * - RX data processing can get heavy enough so that it is not | ||
| 61 | * appropiate for doing it in the USB callback; thus we run it in a | ||
| 62 | * process context. | ||
| 63 | * | ||
| 64 | * We provide a read buffer of an arbitrary size (short of a page); if | ||
| 65 | * the callback reports -EOVERFLOW, it means it was too small, so we | ||
| 66 | * just double the size and retry (being careful to append, as | ||
| 67 | * sometimes the device provided some data). Every now and then we | ||
| 68 | * check if the average packet size is smaller than the current packet | ||
| 69 | * size and if so, we halve it. At the end, the size of the | ||
| 70 | * preallocated buffer should be following the average received | ||
| 71 | * transaction size, adapting dynamically to it. | ||
| 72 | * | ||
| 73 | * ROADMAP | ||
| 74 | * | ||
| 75 | * i2400mu_rx_kick() Called from notif.c when we get a | ||
| 76 | * 'data ready' notification | ||
| 77 | * i2400mu_rxd() Kernel RX daemon | ||
| 78 | * i2400mu_rx() Receive USB data | ||
| 79 | * i2400m_rx() Send data to generic i2400m RX handling | ||
| 80 | * | ||
| 81 | * i2400mu_rx_setup() called from i2400mu_bus_dev_start() | ||
| 82 | * | ||
| 83 | * i2400mu_rx_release() called from i2400mu_bus_dev_stop() | ||
| 84 | */ | ||
| 85 | #include <linux/workqueue.h> | ||
| 86 | #include <linux/usb.h> | ||
| 87 | #include "i2400m-usb.h" | ||
| 88 | |||
| 89 | |||
| 90 | #define D_SUBMODULE rx | ||
| 91 | #include "usb-debug-levels.h" | ||
| 92 | |||
| 93 | /* | ||
| 94 | * Dynamic RX size | ||
| 95 | * | ||
| 96 | * We can't let the rx_size be a multiple of 512 bytes (the RX | ||
| 97 | * endpoint's max packet size). On some USB host controllers (we | ||
| 98 | * haven't been able to fully characterize which), if the device is | ||
| 99 | * about to send (for example) X bytes and we only post a buffer to | ||
| 100 | * receive n*512, it will fail to mark that as babble (so that | ||
| 101 | * i2400mu_rx() [case -EOVERFLOW] can resize the buffer and get the | ||
| 102 | * rest). | ||
| 103 | * | ||
| 104 | * So on growing or shrinking, if it is a multiple of the | ||
| 105 | * maxpacketsize, we remove some (instead of incresing some, so in a | ||
| 106 | * buddy allocator we try to waste less space). | ||
| 107 | * | ||
| 108 | * Note we also need a hook for this on i2400mu_rx() -- when we do the | ||
| 109 | * first read, we are sure we won't hit this spot because | ||
| 110 | * i240mm->rx_size has been set properly. However, if we have to | ||
| 111 | * double because of -EOVERFLOW, when we launch the read to get the | ||
| 112 | * rest of the data, we *have* to make sure that also is not a | ||
| 113 | * multiple of the max_pkt_size. | ||
| 114 | */ | ||
| 115 | |||
| 116 | static | ||
| 117 | size_t i2400mu_rx_size_grow(struct i2400mu *i2400mu) | ||
| 118 | { | ||
| 119 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 120 | size_t rx_size; | ||
| 121 | const size_t max_pkt_size = 512; | ||
| 122 | |||
| 123 | rx_size = 2 * i2400mu->rx_size; | ||
| 124 | if (rx_size % max_pkt_size == 0) { | ||
| 125 | rx_size -= 8; | ||
| 126 | d_printf(1, dev, | ||
| 127 | "RX: expected size grew to %zu [adjusted -8] " | ||
| 128 | "from %zu\n", | ||
| 129 | rx_size, i2400mu->rx_size); | ||
| 130 | } else | ||
| 131 | d_printf(1, dev, | ||
| 132 | "RX: expected size grew to %zu from %zu\n", | ||
| 133 | rx_size, i2400mu->rx_size); | ||
| 134 | return rx_size; | ||
| 135 | } | ||
| 136 | |||
| 137 | |||
| 138 | static | ||
| 139 | void i2400mu_rx_size_maybe_shrink(struct i2400mu *i2400mu) | ||
| 140 | { | ||
| 141 | const size_t max_pkt_size = 512; | ||
| 142 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 143 | |||
| 144 | if (unlikely(i2400mu->rx_size_cnt >= 100 | ||
| 145 | && i2400mu->rx_size_auto_shrink)) { | ||
| 146 | size_t avg_rx_size = | ||
| 147 | i2400mu->rx_size_acc / i2400mu->rx_size_cnt; | ||
| 148 | size_t new_rx_size = i2400mu->rx_size / 2; | ||
| 149 | if (avg_rx_size < new_rx_size) { | ||
| 150 | if (new_rx_size % max_pkt_size == 0) { | ||
| 151 | new_rx_size -= 8; | ||
| 152 | d_printf(1, dev, | ||
| 153 | "RX: expected size shrank to %zu " | ||
| 154 | "[adjusted -8] from %zu\n", | ||
| 155 | new_rx_size, i2400mu->rx_size); | ||
| 156 | } else | ||
| 157 | d_printf(1, dev, | ||
| 158 | "RX: expected size shrank to %zu " | ||
| 159 | "from %zu\n", | ||
| 160 | new_rx_size, i2400mu->rx_size); | ||
| 161 | i2400mu->rx_size = new_rx_size; | ||
| 162 | i2400mu->rx_size_cnt = 0; | ||
| 163 | i2400mu->rx_size_acc = i2400mu->rx_size; | ||
| 164 | } | ||
| 165 | } | ||
| 166 | } | ||
| 167 | |||
| 168 | /* | ||
| 169 | * Receive a message with payloads from the USB bus into an skb | ||
| 170 | * | ||
| 171 | * @i2400mu: USB device descriptor | ||
| 172 | * @rx_skb: skb where to place the received message | ||
| 173 | * | ||
| 174 | * Deals with all the USB-specifics of receiving, dynamically | ||
| 175 | * increasing the buffer size if so needed. Returns the payload in the | ||
| 176 | * skb, ready to process. On a zero-length packet, we retry. | ||
| 177 | * | ||
| 178 | * On soft USB errors, we retry (until they become too frequent and | ||
| 179 | * then are promoted to hard); on hard USB errors, we reset the | ||
| 180 | * device. On other errors (skb realloacation, we just drop it and | ||
| 181 | * hope for the next invocation to solve it). | ||
| 182 | * | ||
| 183 | * Returns: pointer to the skb if ok, ERR_PTR on error. | ||
| 184 | * NOTE: this function might realloc the skb (if it is too small), | ||
| 185 | * so always update with the one returned. | ||
| 186 | * ERR_PTR() is < 0 on error. | ||
| 187 | */ | ||
| 188 | static | ||
| 189 | struct sk_buff *i2400mu_rx(struct i2400mu *i2400mu, struct sk_buff *rx_skb) | ||
| 190 | { | ||
| 191 | int result = 0; | ||
| 192 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 193 | int usb_pipe, read_size, rx_size, do_autopm; | ||
| 194 | struct usb_endpoint_descriptor *epd; | ||
| 195 | const size_t max_pkt_size = 512; | ||
| 196 | |||
| 197 | d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu); | ||
| 198 | do_autopm = atomic_read(&i2400mu->do_autopm); | ||
| 199 | result = do_autopm ? | ||
| 200 | usb_autopm_get_interface(i2400mu->usb_iface) : 0; | ||
| 201 | if (result < 0) { | ||
| 202 | dev_err(dev, "RX: can't get autopm: %d\n", result); | ||
| 203 | do_autopm = 0; | ||
| 204 | } | ||
| 205 | epd = usb_get_epd(i2400mu->usb_iface, I2400MU_EP_BULK_IN); | ||
| 206 | usb_pipe = usb_rcvbulkpipe(i2400mu->usb_dev, epd->bEndpointAddress); | ||
| 207 | retry: | ||
| 208 | rx_size = skb_end_pointer(rx_skb) - rx_skb->data - rx_skb->len; | ||
| 209 | if (unlikely(rx_size % max_pkt_size == 0)) { | ||
| 210 | rx_size -= 8; | ||
| 211 | d_printf(1, dev, "RX: rx_size adapted to %d [-8]\n", rx_size); | ||
| 212 | } | ||
| 213 | result = usb_bulk_msg( | ||
| 214 | i2400mu->usb_dev, usb_pipe, rx_skb->data + rx_skb->len, | ||
| 215 | rx_size, &read_size, HZ); | ||
| 216 | usb_mark_last_busy(i2400mu->usb_dev); | ||
| 217 | switch (result) { | ||
| 218 | case 0: | ||
| 219 | if (read_size == 0) | ||
| 220 | goto retry; /* ZLP, just resubmit */ | ||
| 221 | skb_put(rx_skb, read_size); | ||
| 222 | break; | ||
| 223 | case -EINVAL: /* while removing driver */ | ||
| 224 | case -ENODEV: /* dev disconnect ... */ | ||
| 225 | case -ENOENT: /* just ignore it */ | ||
| 226 | case -ESHUTDOWN: | ||
| 227 | case -ECONNRESET: | ||
| 228 | break; | ||
| 229 | case -EOVERFLOW: { /* too small, reallocate */ | ||
| 230 | struct sk_buff *new_skb; | ||
| 231 | rx_size = i2400mu_rx_size_grow(i2400mu); | ||
| 232 | if (rx_size <= (1 << 16)) /* cap it */ | ||
| 233 | i2400mu->rx_size = rx_size; | ||
| 234 | else if (printk_ratelimit()) { | ||
| 235 | dev_err(dev, "BUG? rx_size up to %d\n", rx_size); | ||
| 236 | result = -EINVAL; | ||
| 237 | goto out; | ||
| 238 | } | ||
| 239 | skb_put(rx_skb, read_size); | ||
| 240 | new_skb = skb_copy_expand(rx_skb, 0, rx_size - rx_skb->len, | ||
| 241 | GFP_KERNEL); | ||
| 242 | if (new_skb == NULL) { | ||
| 243 | if (printk_ratelimit()) | ||
| 244 | dev_err(dev, "RX: Can't reallocate skb to %d; " | ||
| 245 | "RX dropped\n", rx_size); | ||
| 246 | kfree(rx_skb); | ||
| 247 | result = 0; | ||
| 248 | goto out; /* drop it...*/ | ||
| 249 | } | ||
| 250 | kfree_skb(rx_skb); | ||
| 251 | rx_skb = new_skb; | ||
| 252 | i2400mu->rx_size_cnt = 0; | ||
| 253 | i2400mu->rx_size_acc = i2400mu->rx_size; | ||
| 254 | d_printf(1, dev, "RX: size changed to %d, received %d, " | ||
| 255 | "copied %d, capacity %ld\n", | ||
| 256 | rx_size, read_size, rx_skb->len, | ||
| 257 | (long) (skb_end_pointer(new_skb) - new_skb->head)); | ||
| 258 | goto retry; | ||
| 259 | } | ||
| 260 | /* In most cases, it happens due to the hardware scheduling a | ||
| 261 | * read when there was no data - unfortunately, we have no way | ||
| 262 | * to tell this timeout from a USB timeout. So we just ignore | ||
| 263 | * it. */ | ||
| 264 | case -ETIMEDOUT: | ||
| 265 | dev_err(dev, "RX: timeout: %d\n", result); | ||
| 266 | result = 0; | ||
| 267 | break; | ||
| 268 | default: /* Any error */ | ||
| 269 | if (edc_inc(&i2400mu->urb_edc, | ||
| 270 | EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) | ||
| 271 | goto error_reset; | ||
| 272 | dev_err(dev, "RX: error receiving URB: %d, retrying\n", result); | ||
| 273 | goto retry; | ||
| 274 | } | ||
| 275 | out: | ||
| 276 | if (do_autopm) | ||
| 277 | usb_autopm_put_interface(i2400mu->usb_iface); | ||
| 278 | d_fnend(4, dev, "(i2400mu %p) = %p\n", i2400mu, rx_skb); | ||
| 279 | return rx_skb; | ||
| 280 | |||
| 281 | error_reset: | ||
| 282 | dev_err(dev, "RX: maximum errors in URB exceeded; " | ||
| 283 | "resetting device\n"); | ||
| 284 | usb_queue_reset_device(i2400mu->usb_iface); | ||
| 285 | rx_skb = ERR_PTR(result); | ||
| 286 | goto out; | ||
| 287 | } | ||
| 288 | |||
| 289 | |||
| 290 | /* | ||
| 291 | * Kernel thread for USB reception of data | ||
| 292 | * | ||
| 293 | * This thread waits for a kick; once kicked, it will allocate an skb | ||
| 294 | * and receive a single message to it from USB (using | ||
| 295 | * i2400mu_rx()). Once received, it is passed to the generic i2400m RX | ||
| 296 | * code for processing. | ||
| 297 | * | ||
| 298 | * When done processing, it runs some dirty statistics to verify if | ||
| 299 | * the last 100 messages received were smaller than half of the | ||
| 300 | * current RX buffer size. In that case, the RX buffer size is | ||
| 301 | * halved. This will helps lowering the pressure on the memory | ||
| 302 | * allocator. | ||
| 303 | * | ||
| 304 | * Hard errors force the thread to exit. | ||
| 305 | */ | ||
| 306 | static | ||
| 307 | int i2400mu_rxd(void *_i2400mu) | ||
| 308 | { | ||
| 309 | int result = 0; | ||
| 310 | struct i2400mu *i2400mu = _i2400mu; | ||
| 311 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 312 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 313 | struct net_device *net_dev = i2400m->wimax_dev.net_dev; | ||
| 314 | size_t pending; | ||
| 315 | int rx_size; | ||
| 316 | struct sk_buff *rx_skb; | ||
| 317 | |||
| 318 | d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu); | ||
| 319 | while (1) { | ||
| 320 | d_printf(2, dev, "TX: waiting for messages\n"); | ||
| 321 | pending = 0; | ||
| 322 | wait_event_interruptible( | ||
| 323 | i2400mu->rx_wq, | ||
| 324 | (kthread_should_stop() /* check this first! */ | ||
| 325 | || (pending = atomic_read(&i2400mu->rx_pending_count))) | ||
| 326 | ); | ||
| 327 | if (kthread_should_stop()) | ||
| 328 | break; | ||
| 329 | if (pending == 0) | ||
| 330 | continue; | ||
| 331 | rx_size = i2400mu->rx_size; | ||
| 332 | d_printf(2, dev, "RX: reading up to %d bytes\n", rx_size); | ||
| 333 | rx_skb = __netdev_alloc_skb(net_dev, rx_size, GFP_KERNEL); | ||
| 334 | if (rx_skb == NULL) { | ||
| 335 | dev_err(dev, "RX: can't allocate skb [%d bytes]\n", | ||
| 336 | rx_size); | ||
| 337 | msleep(50); /* give it some time? */ | ||
| 338 | continue; | ||
| 339 | } | ||
| 340 | |||
| 341 | /* Receive the message with the payloads */ | ||
| 342 | rx_skb = i2400mu_rx(i2400mu, rx_skb); | ||
| 343 | result = PTR_ERR(rx_skb); | ||
| 344 | if (IS_ERR(rx_skb)) | ||
| 345 | goto out; | ||
| 346 | atomic_dec(&i2400mu->rx_pending_count); | ||
| 347 | if (rx_skb->len == 0) { /* some ignorable condition */ | ||
| 348 | kfree_skb(rx_skb); | ||
| 349 | continue; | ||
| 350 | } | ||
| 351 | |||
| 352 | /* Deliver the message to the generic i2400m code */ | ||
| 353 | i2400mu->rx_size_cnt++; | ||
| 354 | i2400mu->rx_size_acc += rx_skb->len; | ||
| 355 | result = i2400m_rx(i2400m, rx_skb); | ||
| 356 | if (result == -EIO | ||
| 357 | && edc_inc(&i2400mu->urb_edc, | ||
| 358 | EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) { | ||
| 359 | goto error_reset; | ||
| 360 | } | ||
| 361 | |||
| 362 | /* Maybe adjust RX buffer size */ | ||
| 363 | i2400mu_rx_size_maybe_shrink(i2400mu); | ||
| 364 | } | ||
| 365 | result = 0; | ||
| 366 | out: | ||
| 367 | d_fnend(4, dev, "(i2400mu %p) = %d\n", i2400mu, result); | ||
| 368 | return result; | ||
| 369 | |||
| 370 | error_reset: | ||
| 371 | dev_err(dev, "RX: maximum errors in received buffer exceeded; " | ||
| 372 | "resetting device\n"); | ||
| 373 | usb_queue_reset_device(i2400mu->usb_iface); | ||
| 374 | goto out; | ||
| 375 | } | ||
| 376 | |||
| 377 | |||
| 378 | /* | ||
| 379 | * Start reading from the device | ||
| 380 | * | ||
| 381 | * @i2400m: device instance | ||
| 382 | * | ||
| 383 | * Notify the RX thread that there is data pending. | ||
| 384 | */ | ||
| 385 | void i2400mu_rx_kick(struct i2400mu *i2400mu) | ||
| 386 | { | ||
| 387 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 388 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 389 | |||
| 390 | d_fnstart(3, dev, "(i2400mu %p)\n", i2400m); | ||
| 391 | atomic_inc(&i2400mu->rx_pending_count); | ||
| 392 | wake_up_all(&i2400mu->rx_wq); | ||
| 393 | d_fnend(3, dev, "(i2400m %p) = void\n", i2400m); | ||
| 394 | } | ||
| 395 | |||
| 396 | |||
| 397 | int i2400mu_rx_setup(struct i2400mu *i2400mu) | ||
| 398 | { | ||
| 399 | int result = 0; | ||
| 400 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 401 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 402 | struct wimax_dev *wimax_dev = &i2400m->wimax_dev; | ||
| 403 | |||
| 404 | i2400mu->rx_kthread = kthread_run(i2400mu_rxd, i2400mu, "%s-rx", | ||
| 405 | wimax_dev->name); | ||
| 406 | if (IS_ERR(i2400mu->rx_kthread)) { | ||
| 407 | result = PTR_ERR(i2400mu->rx_kthread); | ||
| 408 | dev_err(dev, "RX: cannot start thread: %d\n", result); | ||
| 409 | } | ||
| 410 | return result; | ||
| 411 | } | ||
| 412 | |||
| 413 | void i2400mu_rx_release(struct i2400mu *i2400mu) | ||
| 414 | { | ||
| 415 | kthread_stop(i2400mu->rx_kthread); | ||
| 416 | } | ||
| 417 | |||
diff --git a/drivers/net/wimax/i2400m/usb-tx.c b/drivers/net/wimax/i2400m/usb-tx.c new file mode 100644 index 000000000000..dfd893356f49 --- /dev/null +++ b/drivers/net/wimax/i2400m/usb-tx.c | |||
| @@ -0,0 +1,229 @@ | |||
| 1 | /* | ||
| 2 | * Intel Wireless WiMAX Connection 2400m | ||
| 3 | * USB specific TX handling | ||
| 4 | * | ||
| 5 | * | ||
| 6 | * Copyright (C) 2007-2008 Intel Corporation. All rights reserved. | ||
| 7 | * | ||
| 8 | * Redistribution and use in source and binary forms, with or without | ||
| 9 | * modification, are permitted provided that the following conditions | ||
| 10 | * are met: | ||
| 11 | * | ||
| 12 | * * Redistributions of source code must retain the above copyright | ||
| 13 | * notice, this list of conditions and the following disclaimer. | ||
| 14 | * * Redistributions in binary form must reproduce the above copyright | ||
| 15 | * notice, this list of conditions and the following disclaimer in | ||
| 16 | * the documentation and/or other materials provided with the | ||
| 17 | * distribution. | ||
| 18 | * * Neither the name of Intel Corporation nor the names of its | ||
| 19 | * contributors may be used to endorse or promote products derived | ||
| 20 | * from this software without specific prior written permission. | ||
| 21 | * | ||
| 22 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | ||
| 23 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | ||
| 24 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | ||
| 25 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | ||
| 26 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | ||
| 27 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | ||
| 28 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | ||
| 29 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | ||
| 30 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | ||
| 31 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | ||
| 32 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||
| 33 | * | ||
| 34 | * | ||
| 35 | * Intel Corporation <linux-wimax@intel.com> | ||
| 36 | * Yanir Lubetkin <yanirx.lubetkin@intel.com> | ||
| 37 | * - Initial implementation | ||
| 38 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
| 39 | * - Split transport/device specific | ||
| 40 | * | ||
| 41 | * | ||
| 42 | * Takes the TX messages in the i2400m's driver TX FIFO and sends them | ||
| 43 | * to the device until there are no more. | ||
| 44 | * | ||
| 45 | * If we fail sending the message, we just drop it. There isn't much | ||
| 46 | * we can do at this point. We could also retry, but the USB stack has | ||
| 47 | * already retried and still failed, so there is not much of a | ||
| 48 | * point. As well, most of the traffic is network, which has recovery | ||
| 49 | * methods for dropped packets. | ||
| 50 | * | ||
| 51 | * For sending we just obtain a FIFO buffer to send, send it to the | ||
| 52 | * USB bulk out, tell the TX FIFO code we have sent it; query for | ||
| 53 | * another one, etc... until done. | ||
| 54 | * | ||
| 55 | * We use a thread so we can call usb_autopm_enable() and | ||
| 56 | * usb_autopm_disable() for each transaction; this way when the device | ||
| 57 | * goes idle, it will suspend. It also has less overhead than a | ||
| 58 | * dedicated workqueue, as it is being used for a single task. | ||
| 59 | * | ||
| 60 | * ROADMAP | ||
| 61 | * | ||
| 62 | * i2400mu_tx_setup() | ||
| 63 | * i2400mu_tx_release() | ||
| 64 | * | ||
| 65 | * i2400mu_bus_tx_kick() - Called by the tx.c code when there | ||
| 66 | * is new data in the FIFO. | ||
| 67 | * i2400mu_txd() | ||
| 68 | * i2400m_tx_msg_get() | ||
| 69 | * i2400m_tx_msg_sent() | ||
| 70 | */ | ||
| 71 | #include "i2400m-usb.h" | ||
| 72 | |||
| 73 | |||
| 74 | #define D_SUBMODULE tx | ||
| 75 | #include "usb-debug-levels.h" | ||
| 76 | |||
| 77 | |||
| 78 | /* | ||
| 79 | * Get the next TX message in the TX FIFO and send it to the device | ||
| 80 | * | ||
| 81 | * Note that any iteration consumes a message to be sent, no matter if | ||
| 82 | * it succeeds or fails (we have no real way to retry or complain). | ||
| 83 | * | ||
| 84 | * Return: 0 if ok, < 0 errno code on hard error. | ||
| 85 | */ | ||
| 86 | static | ||
| 87 | int i2400mu_tx(struct i2400mu *i2400mu, struct i2400m_msg_hdr *tx_msg, | ||
| 88 | size_t tx_msg_size) | ||
| 89 | { | ||
| 90 | int result = 0; | ||
| 91 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 92 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 93 | int usb_pipe, sent_size, do_autopm; | ||
| 94 | struct usb_endpoint_descriptor *epd; | ||
| 95 | |||
| 96 | d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu); | ||
| 97 | do_autopm = atomic_read(&i2400mu->do_autopm); | ||
| 98 | result = do_autopm ? | ||
| 99 | usb_autopm_get_interface(i2400mu->usb_iface) : 0; | ||
| 100 | if (result < 0) { | ||
| 101 | dev_err(dev, "TX: can't get autopm: %d\n", result); | ||
| 102 | do_autopm = 0; | ||
| 103 | } | ||
| 104 | epd = usb_get_epd(i2400mu->usb_iface, I2400MU_EP_BULK_OUT); | ||
| 105 | usb_pipe = usb_sndbulkpipe(i2400mu->usb_dev, epd->bEndpointAddress); | ||
| 106 | retry: | ||
| 107 | result = usb_bulk_msg(i2400mu->usb_dev, usb_pipe, | ||
| 108 | tx_msg, tx_msg_size, &sent_size, HZ); | ||
| 109 | usb_mark_last_busy(i2400mu->usb_dev); | ||
| 110 | switch (result) { | ||
| 111 | case 0: | ||
| 112 | if (sent_size != tx_msg_size) { /* Too short? drop it */ | ||
| 113 | dev_err(dev, "TX: short write (%d B vs %zu " | ||
| 114 | "expected)\n", sent_size, tx_msg_size); | ||
| 115 | result = -EIO; | ||
| 116 | } | ||
| 117 | break; | ||
| 118 | case -EINVAL: /* while removing driver */ | ||
| 119 | case -ENODEV: /* dev disconnect ... */ | ||
| 120 | case -ENOENT: /* just ignore it */ | ||
| 121 | case -ESHUTDOWN: /* and exit */ | ||
| 122 | case -ECONNRESET: | ||
| 123 | result = -ESHUTDOWN; | ||
| 124 | break; | ||
| 125 | default: /* Some error? */ | ||
| 126 | if (edc_inc(&i2400mu->urb_edc, | ||
| 127 | EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) { | ||
| 128 | dev_err(dev, "TX: maximum errors in URB " | ||
| 129 | "exceeded; resetting device\n"); | ||
| 130 | usb_queue_reset_device(i2400mu->usb_iface); | ||
| 131 | } else { | ||
| 132 | dev_err(dev, "TX: cannot send URB; retrying. " | ||
| 133 | "tx_msg @%zu %zu B [%d sent]: %d\n", | ||
| 134 | (void *) tx_msg - i2400m->tx_buf, | ||
| 135 | tx_msg_size, sent_size, result); | ||
| 136 | goto retry; | ||
| 137 | } | ||
| 138 | } | ||
| 139 | if (do_autopm) | ||
| 140 | usb_autopm_put_interface(i2400mu->usb_iface); | ||
| 141 | d_fnend(4, dev, "(i2400mu %p) = result\n", i2400mu); | ||
| 142 | return result; | ||
| 143 | } | ||
| 144 | |||
| 145 | |||
| 146 | /* | ||
| 147 | * Get the next TX message in the TX FIFO and send it to the device | ||
| 148 | * | ||
| 149 | * Note we exit the loop if i2400mu_tx() fails; that funtion only | ||
| 150 | * fails on hard error (failing to tx a buffer not being one of them, | ||
| 151 | * see its doc). | ||
| 152 | * | ||
| 153 | * Return: 0 | ||
| 154 | */ | ||
| 155 | static | ||
| 156 | int i2400mu_txd(void *_i2400mu) | ||
| 157 | { | ||
| 158 | int result = 0; | ||
| 159 | struct i2400mu *i2400mu = _i2400mu; | ||
| 160 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 161 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 162 | struct i2400m_msg_hdr *tx_msg; | ||
| 163 | size_t tx_msg_size; | ||
| 164 | |||
| 165 | d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu); | ||
| 166 | |||
| 167 | while (1) { | ||
| 168 | d_printf(2, dev, "TX: waiting for messages\n"); | ||
| 169 | tx_msg = NULL; | ||
| 170 | wait_event_interruptible( | ||
| 171 | i2400mu->tx_wq, | ||
| 172 | (kthread_should_stop() /* check this first! */ | ||
| 173 | || (tx_msg = i2400m_tx_msg_get(i2400m, &tx_msg_size))) | ||
| 174 | ); | ||
| 175 | if (kthread_should_stop()) | ||
| 176 | break; | ||
| 177 | WARN_ON(tx_msg == NULL); /* should not happen...*/ | ||
| 178 | d_printf(2, dev, "TX: submitting %zu bytes\n", tx_msg_size); | ||
| 179 | d_dump(5, dev, tx_msg, tx_msg_size); | ||
| 180 | /* Yeah, we ignore errors ... not much we can do */ | ||
| 181 | i2400mu_tx(i2400mu, tx_msg, tx_msg_size); | ||
| 182 | i2400m_tx_msg_sent(i2400m); /* ack it, advance the FIFO */ | ||
| 183 | if (result < 0) | ||
| 184 | break; | ||
| 185 | } | ||
| 186 | d_fnend(4, dev, "(i2400mu %p) = %d\n", i2400mu, result); | ||
| 187 | return result; | ||
| 188 | } | ||
| 189 | |||
| 190 | |||
| 191 | /* | ||
| 192 | * i2400m TX engine notifies us that there is data in the FIFO ready | ||
| 193 | * for TX | ||
| 194 | * | ||
| 195 | * If there is a URB in flight, don't do anything; when it finishes, | ||
| 196 | * it will see there is data in the FIFO and send it. Else, just | ||
| 197 | * submit a write. | ||
| 198 | */ | ||
| 199 | void i2400mu_bus_tx_kick(struct i2400m *i2400m) | ||
| 200 | { | ||
| 201 | struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m); | ||
| 202 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 203 | |||
| 204 | d_fnstart(3, dev, "(i2400m %p) = void\n", i2400m); | ||
| 205 | wake_up_all(&i2400mu->tx_wq); | ||
| 206 | d_fnend(3, dev, "(i2400m %p) = void\n", i2400m); | ||
| 207 | } | ||
| 208 | |||
| 209 | |||
| 210 | int i2400mu_tx_setup(struct i2400mu *i2400mu) | ||
| 211 | { | ||
| 212 | int result = 0; | ||
| 213 | struct i2400m *i2400m = &i2400mu->i2400m; | ||
| 214 | struct device *dev = &i2400mu->usb_iface->dev; | ||
| 215 | struct wimax_dev *wimax_dev = &i2400m->wimax_dev; | ||
| 216 | |||
| 217 | i2400mu->tx_kthread = kthread_run(i2400mu_txd, i2400mu, "%s-tx", | ||
| 218 | wimax_dev->name); | ||
| 219 | if (IS_ERR(i2400mu->tx_kthread)) { | ||
| 220 | result = PTR_ERR(i2400mu->tx_kthread); | ||
| 221 | dev_err(dev, "TX: cannot start thread: %d\n", result); | ||
| 222 | } | ||
| 223 | return result; | ||
| 224 | } | ||
| 225 | |||
| 226 | void i2400mu_tx_release(struct i2400mu *i2400mu) | ||
| 227 | { | ||
| 228 | kthread_stop(i2400mu->tx_kthread); | ||
| 229 | } | ||
