Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1 | //===================================================== |
| 2 | // CopyRight (C) 2007 Qualcomm Inc. All Rights Reserved. |
| 3 | // |
| 4 | // |
| 5 | // This file is part of Express Card USB Driver |
| 6 | // |
| 7 | // $Id: |
| 8 | //==================================================== |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 9 | #include <linux/init.h> |
| 10 | #include <linux/kernel.h> |
| 11 | #include <linux/module.h> |
| 12 | #include <linux/netdevice.h> |
| 13 | #include <linux/etherdevice.h> |
| 14 | #include <linux/usb.h> |
| 15 | #include "ft1000_usb.h" |
| 16 | #include <linux/types.h> |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 17 | |
| 18 | #define HARLEY_READ_REGISTER 0x0 |
| 19 | #define HARLEY_WRITE_REGISTER 0x01 |
| 20 | #define HARLEY_READ_DPRAM_32 0x02 |
| 21 | #define HARLEY_READ_DPRAM_LOW 0x03 |
| 22 | #define HARLEY_READ_DPRAM_HIGH 0x04 |
| 23 | #define HARLEY_WRITE_DPRAM_32 0x05 |
| 24 | #define HARLEY_WRITE_DPRAM_LOW 0x06 |
| 25 | #define HARLEY_WRITE_DPRAM_HIGH 0x07 |
| 26 | |
| 27 | #define HARLEY_READ_OPERATION 0xc1 |
| 28 | #define HARLEY_WRITE_OPERATION 0x41 |
| 29 | |
| 30 | //#define JDEBUG |
| 31 | |
Arnd Bergmann | 2a953cf | 2010-09-30 10:24:10 +0200 | [diff] [blame] | 32 | static int ft1000_reset(struct net_device *ft1000dev); |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 33 | static int ft1000_submit_rx_urb(struct ft1000_info *info); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 34 | static int ft1000_start_xmit(struct sk_buff *skb, struct net_device *dev); |
| 35 | static int ft1000_open (struct net_device *dev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 36 | static struct net_device_stats *ft1000_netdev_stats(struct net_device *dev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 37 | static int ft1000_chkcard (struct ft1000_device *dev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 38 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 39 | static u8 tempbuffer[1600]; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 40 | |
| 41 | #define MAX_RCV_LOOP 100 |
| 42 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 43 | //--------------------------------------------------------------------------- |
| 44 | // Function: ft1000_control |
| 45 | // |
| 46 | // Parameters: ft1000_device - device structure |
| 47 | // pipe - usb control message pipe |
| 48 | // request - control request |
| 49 | // requesttype - control message request type |
| 50 | // value - value to be written or 0 |
| 51 | // index - register index |
| 52 | // data - data buffer to hold the read/write values |
| 53 | // size - data size |
| 54 | // timeout - control message time out value |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 55 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 56 | // Returns: STATUS_SUCCESS - success |
| 57 | // STATUS_FAILURE - failure |
| 58 | // |
| 59 | // Description: This function sends a control message via USB interface synchronously |
| 60 | // |
| 61 | // Notes: |
| 62 | // |
| 63 | //--------------------------------------------------------------------------- |
Marek Belisko | 537a20a | 2011-02-09 15:02:34 +0100 | [diff] [blame] | 64 | static int ft1000_control(struct ft1000_device *ft1000dev, unsigned int pipe, |
| 65 | u8 request, u8 requesttype, u16 value, u16 index, |
| 66 | void *data, u16 size, int timeout) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 67 | { |
| 68 | u16 ret; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 69 | |
Marek Belisko | 537a20a | 2011-02-09 15:02:34 +0100 | [diff] [blame] | 70 | if ((ft1000dev == NULL) || (ft1000dev->dev == NULL)) { |
| 71 | DEBUG("ft1000dev or ft1000dev->dev == NULL, failure\n"); |
| 72 | return -ENODEV; |
| 73 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 74 | |
Marek Belisko | 537a20a | 2011-02-09 15:02:34 +0100 | [diff] [blame] | 75 | ret = usb_control_msg(ft1000dev->dev, pipe, request, requesttype, |
Marek Belisko | 1897895 | 2012-07-30 23:07:16 +0200 | [diff] [blame] | 76 | value, index, data, size, timeout); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 77 | |
Marek Belisko | 310bad0 | 2010-10-14 13:36:11 +0200 | [diff] [blame] | 78 | if (ret > 0) |
| 79 | ret = 0; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 80 | |
Marek Belisko | 537a20a | 2011-02-09 15:02:34 +0100 | [diff] [blame] | 81 | return ret; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 82 | } |
Marek Belisko | 537a20a | 2011-02-09 15:02:34 +0100 | [diff] [blame] | 83 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 84 | //--------------------------------------------------------------------------- |
| 85 | // Function: ft1000_read_register |
| 86 | // |
| 87 | // Parameters: ft1000_device - device structure |
| 88 | // Data - data buffer to hold the value read |
| 89 | // nRegIndex - register index |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 90 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 91 | // Returns: STATUS_SUCCESS - success |
| 92 | // STATUS_FAILURE - failure |
| 93 | // |
| 94 | // Description: This function returns the value in a register |
| 95 | // |
| 96 | // Notes: |
| 97 | // |
| 98 | //--------------------------------------------------------------------------- |
| 99 | |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 100 | int ft1000_read_register(struct ft1000_device *ft1000dev, u16* Data, |
| 101 | u16 nRegIndx) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 102 | { |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 103 | int ret = STATUS_SUCCESS; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 104 | |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 105 | ret = ft1000_control(ft1000dev, |
| 106 | usb_rcvctrlpipe(ft1000dev->dev, 0), |
| 107 | HARLEY_READ_REGISTER, |
| 108 | HARLEY_READ_OPERATION, |
| 109 | 0, |
| 110 | nRegIndx, |
| 111 | Data, |
| 112 | 2, |
Marek Belisko | b0add95 | 2012-07-30 23:07:17 +0200 | [diff] [blame^] | 113 | USB_CTRL_GET_TIMEOUT); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 114 | |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 115 | return ret; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 116 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 117 | |
| 118 | //--------------------------------------------------------------------------- |
| 119 | // Function: ft1000_write_register |
| 120 | // |
| 121 | // Parameters: ft1000_device - device structure |
| 122 | // value - value to write into a register |
| 123 | // nRegIndex - register index |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 124 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 125 | // Returns: STATUS_SUCCESS - success |
| 126 | // STATUS_FAILURE - failure |
| 127 | // |
| 128 | // Description: This function writes the value in a register |
| 129 | // |
| 130 | // Notes: |
| 131 | // |
| 132 | //--------------------------------------------------------------------------- |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 133 | int ft1000_write_register(struct ft1000_device *ft1000dev, u16 value, |
| 134 | u16 nRegIndx) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 135 | { |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 136 | int ret = STATUS_SUCCESS; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 137 | |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 138 | ret = ft1000_control(ft1000dev, |
| 139 | usb_sndctrlpipe(ft1000dev->dev, 0), |
| 140 | HARLEY_WRITE_REGISTER, |
| 141 | HARLEY_WRITE_OPERATION, |
| 142 | value, |
| 143 | nRegIndx, |
| 144 | NULL, |
| 145 | 0, |
Marek Belisko | b0add95 | 2012-07-30 23:07:17 +0200 | [diff] [blame^] | 146 | USB_CTRL_SET_TIMEOUT); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 147 | |
Marek Belisko | 31da7c0 | 2011-02-09 15:02:37 +0100 | [diff] [blame] | 148 | return ret; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 149 | } |
| 150 | |
| 151 | //--------------------------------------------------------------------------- |
| 152 | // Function: ft1000_read_dpram32 |
| 153 | // |
| 154 | // Parameters: ft1000_device - device structure |
| 155 | // indx - starting address to read |
| 156 | // buffer - data buffer to hold the data read |
| 157 | // cnt - number of byte read from DPRAM |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 158 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 159 | // Returns: STATUS_SUCCESS - success |
| 160 | // STATUS_FAILURE - failure |
| 161 | // |
| 162 | // Description: This function read a number of bytes from DPRAM |
| 163 | // |
| 164 | // Notes: |
| 165 | // |
| 166 | //--------------------------------------------------------------------------- |
| 167 | |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 168 | int ft1000_read_dpram32(struct ft1000_device *ft1000dev, u16 indx, u8 *buffer, |
| 169 | u16 cnt) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 170 | { |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 171 | int ret = STATUS_SUCCESS; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 172 | |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 173 | ret = ft1000_control(ft1000dev, |
| 174 | usb_rcvctrlpipe(ft1000dev->dev, 0), |
| 175 | HARLEY_READ_DPRAM_32, |
| 176 | HARLEY_READ_OPERATION, |
| 177 | 0, |
| 178 | indx, |
| 179 | buffer, |
| 180 | cnt, |
Marek Belisko | b0add95 | 2012-07-30 23:07:17 +0200 | [diff] [blame^] | 181 | USB_CTRL_GET_TIMEOUT); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 182 | |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 183 | return ret; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 184 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 185 | |
| 186 | //--------------------------------------------------------------------------- |
| 187 | // Function: ft1000_write_dpram32 |
| 188 | // |
| 189 | // Parameters: ft1000_device - device structure |
| 190 | // indx - starting address to write the data |
| 191 | // buffer - data buffer to write into DPRAM |
| 192 | // cnt - number of bytes to write |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 193 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 194 | // Returns: STATUS_SUCCESS - success |
| 195 | // STATUS_FAILURE - failure |
| 196 | // |
| 197 | // Description: This function writes into DPRAM a number of bytes |
| 198 | // |
| 199 | // Notes: |
| 200 | // |
| 201 | //--------------------------------------------------------------------------- |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 202 | int ft1000_write_dpram32(struct ft1000_device *ft1000dev, u16 indx, u8 *buffer, |
| 203 | u16 cnt) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 204 | { |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 205 | int ret = STATUS_SUCCESS; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 206 | |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 207 | if (cnt % 4) |
| 208 | cnt += cnt - (cnt % 4); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 209 | |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 210 | ret = ft1000_control(ft1000dev, |
| 211 | usb_sndctrlpipe(ft1000dev->dev, 0), |
| 212 | HARLEY_WRITE_DPRAM_32, |
| 213 | HARLEY_WRITE_OPERATION, |
| 214 | 0, |
| 215 | indx, |
| 216 | buffer, |
| 217 | cnt, |
Marek Belisko | b0add95 | 2012-07-30 23:07:17 +0200 | [diff] [blame^] | 218 | USB_CTRL_SET_TIMEOUT); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 219 | |
Marek Belisko | e3fc923 | 2011-02-09 15:02:38 +0100 | [diff] [blame] | 220 | return ret; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 221 | } |
| 222 | |
| 223 | //--------------------------------------------------------------------------- |
| 224 | // Function: ft1000_read_dpram16 |
| 225 | // |
| 226 | // Parameters: ft1000_device - device structure |
| 227 | // indx - starting address to read |
| 228 | // buffer - data buffer to hold the data read |
| 229 | // hightlow - high or low 16 bit word |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 230 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 231 | // Returns: STATUS_SUCCESS - success |
| 232 | // STATUS_FAILURE - failure |
| 233 | // |
| 234 | // Description: This function read 16 bits from DPRAM |
| 235 | // |
| 236 | // Notes: |
| 237 | // |
| 238 | //--------------------------------------------------------------------------- |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 239 | int ft1000_read_dpram16(struct ft1000_device *ft1000dev, u16 indx, u8 *buffer, |
| 240 | u8 highlow) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 241 | { |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 242 | int ret = STATUS_SUCCESS; |
| 243 | u8 request; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 244 | |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 245 | if (highlow == 0) |
| 246 | request = HARLEY_READ_DPRAM_LOW; |
| 247 | else |
| 248 | request = HARLEY_READ_DPRAM_HIGH; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 249 | |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 250 | ret = ft1000_control(ft1000dev, |
| 251 | usb_rcvctrlpipe(ft1000dev->dev, 0), |
| 252 | request, |
| 253 | HARLEY_READ_OPERATION, |
| 254 | 0, |
| 255 | indx, |
| 256 | buffer, |
| 257 | 2, |
Marek Belisko | b0add95 | 2012-07-30 23:07:17 +0200 | [diff] [blame^] | 258 | USB_CTRL_GET_TIMEOUT); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 259 | |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 260 | return ret; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 261 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 262 | |
| 263 | //--------------------------------------------------------------------------- |
| 264 | // Function: ft1000_write_dpram16 |
| 265 | // |
| 266 | // Parameters: ft1000_device - device structure |
| 267 | // indx - starting address to write the data |
| 268 | // value - 16bits value to write |
| 269 | // hightlow - high or low 16 bit word |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 270 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 271 | // Returns: STATUS_SUCCESS - success |
| 272 | // STATUS_FAILURE - failure |
| 273 | // |
| 274 | // Description: This function writes into DPRAM a number of bytes |
| 275 | // |
| 276 | // Notes: |
| 277 | // |
| 278 | //--------------------------------------------------------------------------- |
Marek Belisko | 4a526fc | 2011-02-09 15:02:36 +0100 | [diff] [blame] | 279 | int ft1000_write_dpram16(struct ft1000_device *ft1000dev, u16 indx, u16 value, u8 highlow) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 280 | { |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 281 | int ret = STATUS_SUCCESS; |
| 282 | u8 request; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 283 | |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 284 | if (highlow == 0) |
| 285 | request = HARLEY_WRITE_DPRAM_LOW; |
| 286 | else |
| 287 | request = HARLEY_WRITE_DPRAM_HIGH; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 288 | |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 289 | ret = ft1000_control(ft1000dev, |
| 290 | usb_sndctrlpipe(ft1000dev->dev, 0), |
| 291 | request, |
| 292 | HARLEY_WRITE_OPERATION, |
| 293 | value, |
| 294 | indx, |
| 295 | NULL, |
| 296 | 0, |
Marek Belisko | b0add95 | 2012-07-30 23:07:17 +0200 | [diff] [blame^] | 297 | USB_CTRL_SET_TIMEOUT); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 298 | |
Marek Belisko | 460bd5d | 2011-02-09 15:02:39 +0100 | [diff] [blame] | 299 | return ret; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 300 | } |
| 301 | |
| 302 | //--------------------------------------------------------------------------- |
| 303 | // Function: fix_ft1000_read_dpram32 |
| 304 | // |
| 305 | // Parameters: ft1000_device - device structure |
| 306 | // indx - starting address to read |
| 307 | // buffer - data buffer to hold the data read |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 308 | // |
| 309 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 310 | // Returns: STATUS_SUCCESS - success |
| 311 | // STATUS_FAILURE - failure |
| 312 | // |
| 313 | // Description: This function read DPRAM 4 words at a time |
| 314 | // |
| 315 | // Notes: |
| 316 | // |
| 317 | //--------------------------------------------------------------------------- |
Marek Belisko | 71e3335 | 2011-02-09 15:02:40 +0100 | [diff] [blame] | 318 | int fix_ft1000_read_dpram32(struct ft1000_device *ft1000dev, u16 indx, |
| 319 | u8 *buffer) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 320 | { |
Marek Belisko | 71e3335 | 2011-02-09 15:02:40 +0100 | [diff] [blame] | 321 | u8 buf[16]; |
| 322 | u16 pos; |
| 323 | int ret = STATUS_SUCCESS; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 324 | |
Marek Belisko | 71e3335 | 2011-02-09 15:02:40 +0100 | [diff] [blame] | 325 | pos = (indx / 4) * 4; |
| 326 | ret = ft1000_read_dpram32(ft1000dev, pos, buf, 16); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 327 | |
Marek Belisko | 71e3335 | 2011-02-09 15:02:40 +0100 | [diff] [blame] | 328 | if (ret == STATUS_SUCCESS) { |
| 329 | pos = (indx % 4) * 4; |
| 330 | *buffer++ = buf[pos++]; |
| 331 | *buffer++ = buf[pos++]; |
| 332 | *buffer++ = buf[pos++]; |
| 333 | *buffer++ = buf[pos++]; |
| 334 | } else { |
| 335 | DEBUG("fix_ft1000_read_dpram32: DPRAM32 Read failed\n"); |
| 336 | *buffer++ = 0; |
| 337 | *buffer++ = 0; |
| 338 | *buffer++ = 0; |
| 339 | *buffer++ = 0; |
| 340 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 341 | |
Marek Belisko | 71e3335 | 2011-02-09 15:02:40 +0100 | [diff] [blame] | 342 | return ret; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 343 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 344 | |
| 345 | |
| 346 | //--------------------------------------------------------------------------- |
| 347 | // Function: fix_ft1000_write_dpram32 |
| 348 | // |
| 349 | // Parameters: ft1000_device - device structure |
| 350 | // indx - starting address to write |
| 351 | // buffer - data buffer to write |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 352 | // |
| 353 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 354 | // Returns: STATUS_SUCCESS - success |
| 355 | // STATUS_FAILURE - failure |
| 356 | // |
| 357 | // Description: This function write to DPRAM 4 words at a time |
| 358 | // |
| 359 | // Notes: |
| 360 | // |
| 361 | //--------------------------------------------------------------------------- |
Marek Belisko | 4a526fc | 2011-02-09 15:02:36 +0100 | [diff] [blame] | 362 | int fix_ft1000_write_dpram32(struct ft1000_device *ft1000dev, u16 indx, u8 *buffer) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 363 | { |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 364 | u16 pos1; |
| 365 | u16 pos2; |
| 366 | u16 i; |
| 367 | u8 buf[32]; |
| 368 | u8 resultbuffer[32]; |
| 369 | u8 *pdata; |
| 370 | int ret = STATUS_SUCCESS; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 371 | |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 372 | pos1 = (indx / 4) * 4; |
| 373 | pdata = buffer; |
| 374 | ret = ft1000_read_dpram32(ft1000dev, pos1, buf, 16); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 375 | |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 376 | if (ret == STATUS_SUCCESS) { |
| 377 | pos2 = (indx % 4)*4; |
| 378 | buf[pos2++] = *buffer++; |
| 379 | buf[pos2++] = *buffer++; |
| 380 | buf[pos2++] = *buffer++; |
| 381 | buf[pos2++] = *buffer++; |
| 382 | ret = ft1000_write_dpram32(ft1000dev, pos1, buf, 16); |
| 383 | } else { |
| 384 | DEBUG("fix_ft1000_write_dpram32: DPRAM32 Read failed\n"); |
| 385 | return ret; |
| 386 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 387 | |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 388 | ret = ft1000_read_dpram32(ft1000dev, pos1, (u8 *)&resultbuffer[0], 16); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 389 | |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 390 | if (ret == STATUS_SUCCESS) { |
| 391 | buffer = pdata; |
| 392 | for (i = 0; i < 16; i++) { |
| 393 | if (buf[i] != resultbuffer[i]) |
| 394 | ret = STATUS_FAILURE; |
| 395 | } |
| 396 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 397 | |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 398 | if (ret == STATUS_FAILURE) { |
| 399 | ret = ft1000_write_dpram32(ft1000dev, pos1, |
| 400 | (u8 *)&tempbuffer[0], 16); |
| 401 | ret = ft1000_read_dpram32(ft1000dev, pos1, |
| 402 | (u8 *)&resultbuffer[0], 16); |
| 403 | if (ret == STATUS_SUCCESS) { |
| 404 | buffer = pdata; |
| 405 | for (i = 0; i < 16; i++) { |
| 406 | if (tempbuffer[i] != resultbuffer[i]) { |
| 407 | ret = STATUS_FAILURE; |
| 408 | DEBUG("%s Failed to write\n", |
| 409 | __func__); |
| 410 | } |
| 411 | } |
| 412 | } |
| 413 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 414 | |
Marek Belisko | 8bfef50 | 2011-02-09 15:02:41 +0100 | [diff] [blame] | 415 | return ret; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 416 | } |
| 417 | |
| 418 | |
| 419 | //------------------------------------------------------------------------ |
| 420 | // |
| 421 | // Function: card_reset_dsp |
| 422 | // |
| 423 | // Synopsis: This function is called to reset or activate the DSP |
| 424 | // |
| 425 | // Arguments: value - reset or activate |
| 426 | // |
| 427 | // Returns: None |
| 428 | //----------------------------------------------------------------------- |
Marek Belisko | 677aaa4 | 2011-02-09 15:02:42 +0100 | [diff] [blame] | 429 | static void card_reset_dsp(struct ft1000_device *ft1000dev, bool value) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 430 | { |
Marek Belisko | 677aaa4 | 2011-02-09 15:02:42 +0100 | [diff] [blame] | 431 | u16 status = STATUS_SUCCESS; |
| 432 | u16 tempword; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 433 | |
Marek Belisko | 677aaa4 | 2011-02-09 15:02:42 +0100 | [diff] [blame] | 434 | status = ft1000_write_register(ft1000dev, HOST_INTF_BE, |
| 435 | FT1000_REG_SUP_CTRL); |
| 436 | status = ft1000_read_register(ft1000dev, &tempword, |
| 437 | FT1000_REG_SUP_CTRL); |
| 438 | |
| 439 | if (value) { |
| 440 | DEBUG("Reset DSP\n"); |
| 441 | status = ft1000_read_register(ft1000dev, &tempword, |
| 442 | FT1000_REG_RESET); |
| 443 | tempword |= DSP_RESET_BIT; |
| 444 | status = ft1000_write_register(ft1000dev, tempword, |
| 445 | FT1000_REG_RESET); |
| 446 | } else { |
| 447 | DEBUG("Activate DSP\n"); |
| 448 | status = ft1000_read_register(ft1000dev, &tempword, |
| 449 | FT1000_REG_RESET); |
| 450 | tempword |= DSP_ENCRYPTED; |
| 451 | tempword &= ~DSP_UNENCRYPTED; |
| 452 | status = ft1000_write_register(ft1000dev, tempword, |
| 453 | FT1000_REG_RESET); |
| 454 | status = ft1000_read_register(ft1000dev, &tempword, |
| 455 | FT1000_REG_RESET); |
| 456 | tempword &= ~EFUSE_MEM_DISABLE; |
| 457 | tempword &= ~DSP_RESET_BIT; |
| 458 | status = ft1000_write_register(ft1000dev, tempword, |
| 459 | FT1000_REG_RESET); |
| 460 | status = ft1000_read_register(ft1000dev, &tempword, |
| 461 | FT1000_REG_RESET); |
| 462 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 463 | } |
| 464 | |
| 465 | //--------------------------------------------------------------------------- |
Marek Belisko | a209efa | 2011-03-10 11:51:15 +0100 | [diff] [blame] | 466 | // Function: card_send_command |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 467 | // |
| 468 | // Parameters: ft1000_device - device structure |
| 469 | // ptempbuffer - command buffer |
| 470 | // size - command buffer size |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 471 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 472 | // Returns: STATUS_SUCCESS - success |
| 473 | // STATUS_FAILURE - failure |
| 474 | // |
| 475 | // Description: This function sends a command to ASIC |
| 476 | // |
| 477 | // Notes: |
| 478 | // |
| 479 | //--------------------------------------------------------------------------- |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 480 | void card_send_command(struct ft1000_device *ft1000dev, void *ptempbuffer, |
| 481 | int size) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 482 | { |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 483 | unsigned short temp; |
| 484 | unsigned char *commandbuf; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 485 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 486 | DEBUG("card_send_command: enter card_send_command... size=%d\n", size); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 487 | |
Thomas Meyer | 528959a | 2011-08-13 11:31:48 +0200 | [diff] [blame] | 488 | commandbuf = kmalloc(size + 2, GFP_KERNEL); |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 489 | memcpy((void *)commandbuf + 2, (void *)ptempbuffer, size); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 490 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 491 | ft1000_read_register(ft1000dev, &temp, FT1000_REG_DOORBELL); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 492 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 493 | if (temp & 0x0100) |
| 494 | msleep(10); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 495 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 496 | /* check for odd word */ |
| 497 | size = size + 2; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 498 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 499 | /* Must force to be 32 bit aligned */ |
| 500 | if (size % 4) |
| 501 | size += 4 - (size % 4); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 502 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 503 | ft1000_write_dpram32(ft1000dev, 0, commandbuf, size); |
| 504 | msleep(1); |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 505 | ft1000_write_register(ft1000dev, FT1000_DB_DPRAM_TX, |
| 506 | FT1000_REG_DOORBELL); |
| 507 | msleep(1); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 508 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 509 | ft1000_read_register(ft1000dev, &temp, FT1000_REG_DOORBELL); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 510 | |
Marek Belisko | 68e79bc | 2011-03-10 11:51:16 +0100 | [diff] [blame] | 511 | if ((temp & 0x0100) == 0) { |
| 512 | //DEBUG("card_send_command: Message sent\n"); |
| 513 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 514 | |
| 515 | } |
| 516 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 517 | //-------------------------------------------------------------------------- |
| 518 | // |
| 519 | // Function: dsp_reload |
| 520 | // |
| 521 | // Synopsis: This function is called to load or reload the DSP |
| 522 | // |
| 523 | // Arguments: ft1000dev - device structure |
| 524 | // |
| 525 | // Returns: None |
| 526 | //----------------------------------------------------------------------- |
Marek Belisko | 5cb9954 | 2010-10-12 10:26:40 +0200 | [diff] [blame] | 527 | int dsp_reload(struct ft1000_device *ft1000dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 528 | { |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 529 | u16 status; |
| 530 | u16 tempword; |
| 531 | u32 templong; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 532 | |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 533 | struct ft1000_info *pft1000info; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 534 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 535 | pft1000info = netdev_priv(ft1000dev->net); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 536 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 537 | pft1000info->CardReady = 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 538 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 539 | /* Program Interrupt Mask register */ |
| 540 | status = ft1000_write_register(ft1000dev, 0xffff, FT1000_REG_SUP_IMASK); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 541 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 542 | status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_RESET); |
| 543 | tempword |= ASIC_RESET_BIT; |
| 544 | status = ft1000_write_register(ft1000dev, tempword, FT1000_REG_RESET); |
| 545 | msleep(1000); |
| 546 | status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_RESET); |
| 547 | DEBUG("Reset Register = 0x%x\n", tempword); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 548 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 549 | /* Toggle DSP reset */ |
| 550 | card_reset_dsp(ft1000dev, 1); |
| 551 | msleep(1000); |
| 552 | card_reset_dsp(ft1000dev, 0); |
| 553 | msleep(1000); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 554 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 555 | status = |
| 556 | ft1000_write_register(ft1000dev, HOST_INTF_BE, FT1000_REG_SUP_CTRL); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 557 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 558 | /* Let's check for FEFE */ |
| 559 | status = |
| 560 | ft1000_read_dpram32(ft1000dev, FT1000_MAG_DPRAM_FEFE_INDX, |
| 561 | (u8 *) &templong, 4); |
| 562 | DEBUG("templong (fefe) = 0x%8x\n", templong); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 563 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 564 | /* call codeloader */ |
| 565 | status = scram_dnldr(ft1000dev, pFileStart, FileLength); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 566 | |
Marek Belisko | 5cb9954 | 2010-10-12 10:26:40 +0200 | [diff] [blame] | 567 | if (status != STATUS_SUCCESS) |
| 568 | return -EIO; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 569 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 570 | msleep(1000); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 571 | |
Marek Belisko | 3529bd4 | 2011-03-10 11:51:17 +0100 | [diff] [blame] | 572 | DEBUG("dsp_reload returned\n"); |
| 573 | |
Marek Belisko | 5cb9954 | 2010-10-12 10:26:40 +0200 | [diff] [blame] | 574 | return 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 575 | } |
| 576 | |
| 577 | //--------------------------------------------------------------------------- |
| 578 | // |
| 579 | // Function: ft1000_reset_asic |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 580 | // Description: This function will call the Card Service function to reset the |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 581 | // ASIC. |
| 582 | // Input: |
| 583 | // dev - device structure |
| 584 | // Output: |
| 585 | // none |
| 586 | // |
| 587 | //--------------------------------------------------------------------------- |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 588 | static void ft1000_reset_asic(struct net_device *dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 589 | { |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 590 | struct ft1000_info *info = netdev_priv(dev); |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 591 | struct ft1000_device *ft1000dev = info->pFt1000Dev; |
| 592 | u16 tempword; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 593 | |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 594 | DEBUG("ft1000_hw:ft1000_reset_asic called\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 595 | |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 596 | /* Let's use the register provided by the Magnemite ASIC to reset the |
| 597 | * ASIC and DSP. |
| 598 | */ |
| 599 | ft1000_write_register(ft1000dev, (DSP_RESET_BIT | ASIC_RESET_BIT), |
| 600 | FT1000_REG_RESET); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 601 | |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 602 | mdelay(1); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 603 | |
Justin P. Mattock | 42b2aa8 | 2011-11-28 20:31:00 -0800 | [diff] [blame] | 604 | /* set watermark to -1 in order to not generate an interrupt */ |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 605 | ft1000_write_register(ft1000dev, 0xffff, FT1000_REG_MAG_WATERMARK); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 606 | |
Marek Belisko | 84a6096 | 2011-03-10 11:51:18 +0100 | [diff] [blame] | 607 | /* clear interrupts */ |
| 608 | ft1000_read_register(ft1000dev, &tempword, FT1000_REG_SUP_ISR); |
| 609 | DEBUG("ft1000_hw: interrupt status register = 0x%x\n", tempword); |
| 610 | ft1000_write_register(ft1000dev, tempword, FT1000_REG_SUP_ISR); |
| 611 | ft1000_read_register(ft1000dev, &tempword, FT1000_REG_SUP_ISR); |
| 612 | DEBUG("ft1000_hw: interrupt status register = 0x%x\n", tempword); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 613 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 614 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 615 | |
| 616 | //--------------------------------------------------------------------------- |
| 617 | // |
| 618 | // Function: ft1000_reset_card |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 619 | // Description: This function will reset the card |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 620 | // Input: |
| 621 | // dev - device structure |
| 622 | // Output: |
| 623 | // status - FALSE (card reset fail) |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 624 | // TRUE (card reset successful) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 625 | // |
| 626 | //--------------------------------------------------------------------------- |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 627 | static int ft1000_reset_card(struct net_device *dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 628 | { |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 629 | struct ft1000_info *info = netdev_priv(dev); |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 630 | struct ft1000_device *ft1000dev = info->pFt1000Dev; |
| 631 | u16 tempword; |
Marek Belisko | e27d96d | 2010-10-15 14:13:01 +0200 | [diff] [blame] | 632 | struct prov_record *ptr; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 633 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 634 | DEBUG("ft1000_hw:ft1000_reset_card called.....\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 635 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 636 | info->fCondResetPend = 1; |
| 637 | info->CardReady = 0; |
| 638 | info->fProvComplete = 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 639 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 640 | /* Make sure we free any memory reserve for provisioning */ |
| 641 | while (list_empty(&info->prov_list) == 0) { |
| 642 | DEBUG("ft1000_reset_card:deleting provisioning record\n"); |
| 643 | ptr = |
| 644 | list_entry(info->prov_list.next, struct prov_record, list); |
| 645 | list_del(&ptr->list); |
| 646 | kfree(ptr->pprov_data); |
| 647 | kfree(ptr); |
| 648 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 649 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 650 | DEBUG("ft1000_hw:ft1000_reset_card: reset asic\n"); |
| 651 | ft1000_reset_asic(dev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 652 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 653 | DEBUG("ft1000_hw:ft1000_reset_card: call dsp_reload\n"); |
| 654 | dsp_reload(ft1000dev); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 655 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 656 | DEBUG("dsp reload successful\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 657 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 658 | mdelay(10); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 659 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 660 | /* Initialize DSP heartbeat area */ |
| 661 | ft1000_write_dpram16(ft1000dev, FT1000_MAG_HI_HO, ho_mag, |
| 662 | FT1000_MAG_HI_HO_INDX); |
| 663 | ft1000_read_dpram16(ft1000dev, FT1000_MAG_HI_HO, (u8 *) &tempword, |
| 664 | FT1000_MAG_HI_HO_INDX); |
| 665 | DEBUG("ft1000_hw:ft1000_reset_card:hi_ho value = 0x%x\n", tempword); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 666 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 667 | info->CardReady = 1; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 668 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 669 | info->fCondResetPend = 0; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 670 | |
Marek Belisko | 3071c12 | 2011-03-10 11:51:19 +0100 | [diff] [blame] | 671 | return TRUE; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 672 | } |
| 673 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 674 | static const struct net_device_ops ftnet_ops = |
| 675 | { |
Marek Belisko | cb3aa5d | 2011-03-10 11:51:20 +0100 | [diff] [blame] | 676 | .ndo_open = &ft1000_open, |
| 677 | .ndo_stop = &ft1000_close, |
| 678 | .ndo_start_xmit = &ft1000_start_xmit, |
| 679 | .ndo_get_stats = &ft1000_netdev_stats, |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 680 | }; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 681 | |
| 682 | |
| 683 | //--------------------------------------------------------------------------- |
| 684 | // Function: init_ft1000_netdev |
| 685 | // |
| 686 | // Parameters: ft1000dev - device structure |
| 687 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 688 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 689 | // Returns: STATUS_SUCCESS - success |
| 690 | // STATUS_FAILURE - failure |
| 691 | // |
| 692 | // Description: This function initialize the network device |
| 693 | // |
| 694 | // Notes: |
| 695 | // |
| 696 | //--------------------------------------------------------------------------- |
Marek Belisko | f135da0 | 2011-03-10 11:51:22 +0100 | [diff] [blame] | 697 | int init_ft1000_netdev(struct ft1000_device *ft1000dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 698 | { |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 699 | struct net_device *netdev; |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 700 | struct ft1000_info *pInfo = NULL; |
Marek Belisko | 29437ab | 2010-10-16 22:37:25 +0200 | [diff] [blame] | 701 | struct dpram_blk *pdpram_blk; |
Marek Belisko | f9d1737 | 2010-10-14 14:14:33 +0200 | [diff] [blame] | 702 | int i, ret_val; |
Vasiliy Kulikov | b7378b9 | 2010-10-03 21:58:46 +0400 | [diff] [blame] | 703 | struct list_head *cur, *tmp; |
Marek Belisko | f9d1737 | 2010-10-14 14:14:33 +0200 | [diff] [blame] | 704 | char card_nr[2]; |
Marek Belisko | 448d401 | 2010-12-13 10:39:20 +0100 | [diff] [blame] | 705 | unsigned long gCardIndex = 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 706 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 707 | DEBUG("Enter init_ft1000_netdev...\n"); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 708 | |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 709 | netdev = alloc_etherdev(sizeof(struct ft1000_info)); |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 710 | if (!netdev) { |
| 711 | DEBUG("init_ft1000_netdev: can not allocate network device\n"); |
| 712 | return -ENOMEM; |
| 713 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 714 | |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 715 | pInfo = netdev_priv(netdev); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 716 | |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 717 | memset(pInfo, 0, sizeof(struct ft1000_info)); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 718 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 719 | dev_alloc_name(netdev, netdev->name); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 720 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 721 | DEBUG("init_ft1000_netdev: network device name is %s\n", netdev->name); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 722 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 723 | if (strncmp(netdev->name, "eth", 3) == 0) { |
Marek Belisko | f9d1737 | 2010-10-14 14:14:33 +0200 | [diff] [blame] | 724 | card_nr[0] = netdev->name[3]; |
| 725 | card_nr[1] = '\0'; |
| 726 | ret_val = strict_strtoul(card_nr, 10, &gCardIndex); |
| 727 | if (ret_val) { |
| 728 | printk(KERN_ERR "Can't parse netdev\n"); |
Marek Belisko | 78890fd | 2010-10-15 08:57:25 +0200 | [diff] [blame] | 729 | goto err_net; |
Marek Belisko | f9d1737 | 2010-10-14 14:14:33 +0200 | [diff] [blame] | 730 | } |
| 731 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 732 | pInfo->CardNumber = gCardIndex; |
| 733 | DEBUG("card number = %d\n", pInfo->CardNumber); |
| 734 | } else { |
| 735 | printk(KERN_ERR "ft1000: Invalid device name\n"); |
Marek Belisko | 78890fd | 2010-10-15 08:57:25 +0200 | [diff] [blame] | 736 | ret_val = -ENXIO; |
| 737 | goto err_net; |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 738 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 739 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 740 | memset(&pInfo->stats, 0, sizeof(struct net_device_stats)); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 741 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 742 | spin_lock_init(&pInfo->dpram_lock); |
| 743 | pInfo->pFt1000Dev = ft1000dev; |
| 744 | pInfo->DrvErrNum = 0; |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 745 | pInfo->registered = 1; |
| 746 | pInfo->ft1000_reset = ft1000_reset; |
| 747 | pInfo->mediastate = 0; |
| 748 | pInfo->fifo_cnt = 0; |
| 749 | pInfo->DeviceCreated = FALSE; |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 750 | pInfo->CardReady = 0; |
| 751 | pInfo->DSP_TIME[0] = 0; |
| 752 | pInfo->DSP_TIME[1] = 0; |
| 753 | pInfo->DSP_TIME[2] = 0; |
| 754 | pInfo->DSP_TIME[3] = 0; |
| 755 | pInfo->fAppMsgPend = 0; |
| 756 | pInfo->fCondResetPend = 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 757 | pInfo->usbboot = 0; |
| 758 | pInfo->dspalive = 0; |
Marek Belisko | eb21c15 | 2010-11-02 13:44:08 +0100 | [diff] [blame] | 759 | memset(&pInfo->tempbuf[0], 0, sizeof(pInfo->tempbuf)); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 760 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 761 | INIT_LIST_HEAD(&pInfo->prov_list); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 762 | |
Marek Belisko | 9119dee | 2010-12-09 11:26:46 +0100 | [diff] [blame] | 763 | INIT_LIST_HEAD(&pInfo->nodes.list); |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 764 | |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 765 | netdev->netdev_ops = &ftnet_ops; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 766 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 767 | ft1000dev->net = netdev; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 768 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 769 | DEBUG("Initialize free_buff_lock and freercvpool\n"); |
| 770 | spin_lock_init(&free_buff_lock); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 771 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 772 | /* initialize a list of buffers to be use for queuing |
| 773 | * up receive command data |
| 774 | */ |
| 775 | INIT_LIST_HEAD(&freercvpool); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 776 | |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 777 | /* create list of free buffers */ |
| 778 | for (i = 0; i < NUM_OF_FREE_BUFFERS; i++) { |
| 779 | /* Get memory for DPRAM_DATA link list */ |
Marek Belisko | 29437ab | 2010-10-16 22:37:25 +0200 | [diff] [blame] | 780 | pdpram_blk = kmalloc(sizeof(struct dpram_blk), GFP_KERNEL); |
Marek Belisko | 78890fd | 2010-10-15 08:57:25 +0200 | [diff] [blame] | 781 | if (pdpram_blk == NULL) { |
| 782 | ret_val = -ENOMEM; |
| 783 | goto err_free; |
| 784 | } |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 785 | /* Get a block of memory to store command data */ |
| 786 | pdpram_blk->pbuffer = kmalloc(MAX_CMD_SQSIZE, GFP_KERNEL); |
Marek Belisko | 78890fd | 2010-10-15 08:57:25 +0200 | [diff] [blame] | 787 | if (pdpram_blk->pbuffer == NULL) { |
| 788 | ret_val = -ENOMEM; |
| 789 | kfree(pdpram_blk); |
| 790 | goto err_free; |
| 791 | } |
Marek Belisko | 6c284c7 | 2011-03-10 11:51:21 +0100 | [diff] [blame] | 792 | /* link provisioning data */ |
| 793 | list_add_tail(&pdpram_blk->list, &freercvpool); |
| 794 | } |
| 795 | numofmsgbuf = NUM_OF_FREE_BUFFERS; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 796 | |
Marek Belisko | 78890fd | 2010-10-15 08:57:25 +0200 | [diff] [blame] | 797 | return 0; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 798 | |
Vasiliy Kulikov | b7378b9 | 2010-10-03 21:58:46 +0400 | [diff] [blame] | 799 | err_free: |
Dan Carpenter | 1055cc9 | 2010-10-15 05:40:42 +0200 | [diff] [blame] | 800 | list_for_each_safe(cur, tmp, &freercvpool) { |
Marek Belisko | 29437ab | 2010-10-16 22:37:25 +0200 | [diff] [blame] | 801 | pdpram_blk = list_entry(cur, struct dpram_blk, list); |
Vasiliy Kulikov | b7378b9 | 2010-10-03 21:58:46 +0400 | [diff] [blame] | 802 | list_del(&pdpram_blk->list); |
| 803 | kfree(pdpram_blk->pbuffer); |
| 804 | kfree(pdpram_blk); |
| 805 | } |
Marek Belisko | 78890fd | 2010-10-15 08:57:25 +0200 | [diff] [blame] | 806 | err_net: |
| 807 | free_netdev(netdev); |
| 808 | return ret_val; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 809 | } |
| 810 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 811 | //--------------------------------------------------------------------------- |
| 812 | // Function: reg_ft1000_netdev |
| 813 | // |
| 814 | // Parameters: ft1000dev - device structure |
| 815 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 816 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 817 | // Returns: STATUS_SUCCESS - success |
| 818 | // STATUS_FAILURE - failure |
| 819 | // |
| 820 | // Description: This function register the network driver |
| 821 | // |
| 822 | // Notes: |
| 823 | // |
| 824 | //--------------------------------------------------------------------------- |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 825 | int reg_ft1000_netdev(struct ft1000_device *ft1000dev, |
| 826 | struct usb_interface *intf) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 827 | { |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 828 | struct net_device *netdev; |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 829 | struct ft1000_info *pInfo; |
Marek Belisko | 7dc5911 | 2010-10-15 10:51:22 +0200 | [diff] [blame] | 830 | int rc; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 831 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 832 | netdev = ft1000dev->net; |
| 833 | pInfo = netdev_priv(ft1000dev->net); |
| 834 | DEBUG("Enter reg_ft1000_netdev...\n"); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 835 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 836 | ft1000_read_register(ft1000dev, &pInfo->AsicID, FT1000_REG_ASIC_ID); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 837 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 838 | usb_set_intfdata(intf, pInfo); |
| 839 | SET_NETDEV_DEV(netdev, &intf->dev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 840 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 841 | rc = register_netdev(netdev); |
| 842 | if (rc) { |
| 843 | DEBUG("reg_ft1000_netdev: could not register network device\n"); |
| 844 | free_netdev(netdev); |
| 845 | return rc; |
| 846 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 847 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 848 | ft1000_create_dev(ft1000dev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 849 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 850 | DEBUG("reg_ft1000_netdev returned\n"); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 851 | |
Marek Belisko | 05a7c39 | 2011-03-10 11:51:23 +0100 | [diff] [blame] | 852 | pInfo->CardReady = 1; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 853 | |
Marek Belisko | aaf0885 | 2010-10-15 09:41:45 +0200 | [diff] [blame] | 854 | return 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 855 | } |
| 856 | |
Arnd Bergmann | 2a953cf | 2010-09-30 10:24:10 +0200 | [diff] [blame] | 857 | static int ft1000_reset(struct net_device *dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 858 | { |
Marek Belisko | 2dd9017 | 2011-03-10 11:51:24 +0100 | [diff] [blame] | 859 | ft1000_reset_card(dev); |
| 860 | return 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 861 | } |
| 862 | |
| 863 | //--------------------------------------------------------------------------- |
| 864 | // Function: ft1000_usb_transmit_complete |
| 865 | // |
| 866 | // Parameters: urb - transmitted usb urb |
| 867 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 868 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 869 | // Returns: none |
| 870 | // |
| 871 | // Description: This is the callback function when a urb is transmitted |
| 872 | // |
| 873 | // Notes: |
| 874 | // |
| 875 | //--------------------------------------------------------------------------- |
| 876 | static void ft1000_usb_transmit_complete(struct urb *urb) |
| 877 | { |
| 878 | |
Marek Belisko | 251c72f | 2011-03-10 11:51:25 +0100 | [diff] [blame] | 879 | struct ft1000_device *ft1000dev = urb->context; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 880 | |
Marek Belisko | 251c72f | 2011-03-10 11:51:25 +0100 | [diff] [blame] | 881 | if (urb->status) |
| 882 | pr_err("%s: TX status %d\n", ft1000dev->net->name, urb->status); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 883 | |
Marek Belisko | 251c72f | 2011-03-10 11:51:25 +0100 | [diff] [blame] | 884 | netif_wake_queue(ft1000dev->net); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 885 | } |
| 886 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 887 | //--------------------------------------------------------------------------- |
| 888 | // |
| 889 | // Function: ft1000_copy_down_pkt |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 890 | // Description: This function will take an ethernet packet and convert it to |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 891 | // a Flarion packet prior to sending it to the ASIC Downlink |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 892 | // FIFO. |
| 893 | // Input: |
| 894 | // dev - device structure |
| 895 | // packet - address of ethernet packet |
| 896 | // len - length of IP packet |
| 897 | // Output: |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 898 | // status - FAILURE |
| 899 | // SUCCESS |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 900 | // |
| 901 | //--------------------------------------------------------------------------- |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 902 | static int ft1000_copy_down_pkt(struct net_device *netdev, u8 * packet, u16 len) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 903 | { |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 904 | struct ft1000_info *pInfo = netdev_priv(netdev); |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 905 | struct ft1000_device *pFt1000Dev = pInfo->pFt1000Dev; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 906 | |
Marek Belisko | d2b0745 | 2010-11-02 13:44:10 +0100 | [diff] [blame] | 907 | int count, ret; |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 908 | u8 *t; |
Marek Belisko | d2b0745 | 2010-11-02 13:44:10 +0100 | [diff] [blame] | 909 | struct pseudo_hdr hdr; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 910 | |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 911 | if (!pInfo->CardReady) { |
| 912 | DEBUG("ft1000_copy_down_pkt::Card Not Ready\n"); |
| 913 | return -ENODEV; |
| 914 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 915 | |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 916 | count = sizeof(struct pseudo_hdr) + len; |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 917 | if (count > MAX_BUF_SIZE) { |
| 918 | DEBUG("Error:ft1000_copy_down_pkt:Message Size Overflow!\n"); |
| 919 | DEBUG("size = %d\n", count); |
| 920 | return -EINVAL; |
| 921 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 922 | |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 923 | if (count % 4) |
| 924 | count = count + (4 - (count % 4)); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 925 | |
Marek Belisko | d2b0745 | 2010-11-02 13:44:10 +0100 | [diff] [blame] | 926 | memset(&hdr, 0, sizeof(struct pseudo_hdr)); |
| 927 | |
| 928 | hdr.length = ntohs(count); |
| 929 | hdr.source = 0x10; |
| 930 | hdr.destination = 0x20; |
| 931 | hdr.portdest = 0x20; |
| 932 | hdr.portsrc = 0x10; |
| 933 | hdr.sh_str_id = 0x91; |
| 934 | hdr.control = 0x00; |
| 935 | |
| 936 | hdr.checksum = hdr.length ^ hdr.source ^ hdr.destination ^ |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 937 | hdr.portdest ^ hdr.portsrc ^ hdr.sh_str_id ^ hdr.control; |
Marek Belisko | d2b0745 | 2010-11-02 13:44:10 +0100 | [diff] [blame] | 938 | |
| 939 | memcpy(&pFt1000Dev->tx_buf[0], &hdr, sizeof(hdr)); |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 940 | memcpy(&(pFt1000Dev->tx_buf[sizeof(struct pseudo_hdr)]), packet, len); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 941 | |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 942 | netif_stop_queue(netdev); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 943 | |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 944 | usb_fill_bulk_urb(pFt1000Dev->tx_urb, |
| 945 | pFt1000Dev->dev, |
| 946 | usb_sndbulkpipe(pFt1000Dev->dev, |
| 947 | pFt1000Dev->bulk_out_endpointAddr), |
| 948 | pFt1000Dev->tx_buf, count, |
| 949 | ft1000_usb_transmit_complete, (void *)pFt1000Dev); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 950 | |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 951 | t = (u8 *) pFt1000Dev->tx_urb->transfer_buffer; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 952 | |
Marek Belisko | 35e9403 | 2010-11-02 14:51:44 +0100 | [diff] [blame] | 953 | ret = usb_submit_urb(pFt1000Dev->tx_urb, GFP_ATOMIC); |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 954 | |
Marek Belisko | 35e9403 | 2010-11-02 14:51:44 +0100 | [diff] [blame] | 955 | if (ret) { |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 956 | DEBUG("ft1000 failed tx_urb %d\n", ret); |
Marek Belisko | 35e9403 | 2010-11-02 14:51:44 +0100 | [diff] [blame] | 957 | return ret; |
| 958 | } else { |
| 959 | pInfo->stats.tx_packets++; |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 960 | pInfo->stats.tx_bytes += (len + 14); |
Marek Belisko | 35e9403 | 2010-11-02 14:51:44 +0100 | [diff] [blame] | 961 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 962 | |
Marek Belisko | 35e9403 | 2010-11-02 14:51:44 +0100 | [diff] [blame] | 963 | return 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 964 | } |
| 965 | |
Marek Belisko | d8dfaf4 | 2011-03-10 11:51:26 +0100 | [diff] [blame] | 966 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 967 | //--------------------------------------------------------------------------- |
| 968 | // Function: ft1000_start_xmit |
| 969 | // |
| 970 | // Parameters: skb - socket buffer to be sent |
| 971 | // dev - network device |
| 972 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 973 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 974 | // Returns: none |
| 975 | // |
| 976 | // Description: transmit a ethernet packet |
| 977 | // |
| 978 | // Notes: |
| 979 | // |
| 980 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 981 | static int ft1000_start_xmit(struct sk_buff *skb, struct net_device *dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 982 | { |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 983 | struct ft1000_info *pInfo = netdev_priv(dev); |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 984 | struct ft1000_device *pFt1000Dev = pInfo->pFt1000Dev; |
| 985 | u8 *pdata; |
| 986 | int maxlen, pipe; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 987 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 988 | if (skb == NULL) { |
| 989 | DEBUG("ft1000_hw: ft1000_start_xmit:skb == NULL!!!\n"); |
| 990 | return NETDEV_TX_OK; |
| 991 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 992 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 993 | if (pFt1000Dev->status & FT1000_STATUS_CLOSING) { |
| 994 | DEBUG("network driver is closed, return\n"); |
| 995 | goto err; |
| 996 | } |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 997 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 998 | pipe = |
| 999 | usb_sndbulkpipe(pFt1000Dev->dev, pFt1000Dev->bulk_out_endpointAddr); |
| 1000 | maxlen = usb_maxpacket(pFt1000Dev->dev, pipe, usb_pipeout(pipe)); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1001 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 1002 | pdata = (u8 *) skb->data; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1003 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 1004 | if (pInfo->mediastate == 0) { |
| 1005 | /* Drop packet is mediastate is down */ |
| 1006 | DEBUG("ft1000_hw:ft1000_start_xmit:mediastate is down\n"); |
| 1007 | goto err; |
| 1008 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1009 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 1010 | if ((skb->len < ENET_HEADER_SIZE) || (skb->len > ENET_MAX_SIZE)) { |
| 1011 | /* Drop packet which has invalid size */ |
| 1012 | DEBUG("ft1000_hw:ft1000_start_xmit:invalid ethernet length\n"); |
| 1013 | goto err; |
| 1014 | } |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1015 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 1016 | ft1000_copy_down_pkt(dev, (pdata + ENET_HEADER_SIZE - 2), |
| 1017 | skb->len - ENET_HEADER_SIZE + 2); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1018 | |
Marek Belisko | 3b3291e | 2010-11-02 14:51:45 +0100 | [diff] [blame] | 1019 | err: |
| 1020 | dev_kfree_skb(skb); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1021 | |
Marek Belisko | 3b3291e | 2010-11-02 14:51:45 +0100 | [diff] [blame] | 1022 | return NETDEV_TX_OK; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1023 | } |
| 1024 | |
Marek Belisko | e31e338 | 2011-03-10 11:51:27 +0100 | [diff] [blame] | 1025 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1026 | //--------------------------------------------------------------------------- |
| 1027 | // |
| 1028 | // Function: ft1000_copy_up_pkt |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 1029 | // Description: This function will take a packet from the FIFO up link and |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1030 | // convert it into an ethernet packet and deliver it to the IP stack |
| 1031 | // Input: |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 1032 | // urb - the receiving usb urb |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1033 | // |
| 1034 | // Output: |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1035 | // status - FAILURE |
| 1036 | // SUCCESS |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1037 | // |
| 1038 | //--------------------------------------------------------------------------- |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1039 | static int ft1000_copy_up_pkt(struct urb *urb) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1040 | { |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 1041 | struct ft1000_info *info = urb->context; |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1042 | struct ft1000_device *ft1000dev = info->pFt1000Dev; |
| 1043 | struct net_device *net = ft1000dev->net; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1044 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1045 | u16 tempword; |
| 1046 | u16 len; |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1047 | u16 lena; |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1048 | struct sk_buff *skb; |
| 1049 | u16 i; |
| 1050 | u8 *pbuffer = NULL; |
| 1051 | u8 *ptemp = NULL; |
| 1052 | u16 *chksum; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1053 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1054 | if (ft1000dev->status & FT1000_STATUS_CLOSING) { |
| 1055 | DEBUG("network driver is closed, return\n"); |
| 1056 | return STATUS_SUCCESS; |
| 1057 | } |
| 1058 | // Read length |
| 1059 | len = urb->transfer_buffer_length; |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1060 | lena = urb->actual_length; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1061 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1062 | chksum = (u16 *) ft1000dev->rx_buf; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1063 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1064 | tempword = *chksum++; |
| 1065 | for (i = 1; i < 7; i++) |
| 1066 | tempword ^= *chksum++; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1067 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1068 | if (tempword != *chksum) { |
| 1069 | info->stats.rx_errors++; |
| 1070 | ft1000_submit_rx_urb(info); |
| 1071 | return STATUS_FAILURE; |
| 1072 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1073 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1074 | skb = dev_alloc_skb(len + 12 + 2); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1075 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1076 | if (skb == NULL) { |
| 1077 | DEBUG("ft1000_copy_up_pkt: No Network buffers available\n"); |
| 1078 | info->stats.rx_errors++; |
| 1079 | ft1000_submit_rx_urb(info); |
| 1080 | return STATUS_FAILURE; |
| 1081 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1082 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1083 | pbuffer = (u8 *) skb_put(skb, len + 12); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1084 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1085 | /* subtract the number of bytes read already */ |
| 1086 | ptemp = pbuffer; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1087 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1088 | /* fake MAC address */ |
| 1089 | *pbuffer++ = net->dev_addr[0]; |
| 1090 | *pbuffer++ = net->dev_addr[1]; |
| 1091 | *pbuffer++ = net->dev_addr[2]; |
| 1092 | *pbuffer++ = net->dev_addr[3]; |
| 1093 | *pbuffer++ = net->dev_addr[4]; |
| 1094 | *pbuffer++ = net->dev_addr[5]; |
| 1095 | *pbuffer++ = 0x00; |
| 1096 | *pbuffer++ = 0x07; |
| 1097 | *pbuffer++ = 0x35; |
| 1098 | *pbuffer++ = 0xff; |
| 1099 | *pbuffer++ = 0xff; |
| 1100 | *pbuffer++ = 0xfe; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1101 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1102 | memcpy(pbuffer, ft1000dev->rx_buf + sizeof(struct pseudo_hdr), |
| 1103 | len - sizeof(struct pseudo_hdr)); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1104 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1105 | skb->dev = net; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1106 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1107 | skb->protocol = eth_type_trans(skb, net); |
| 1108 | skb->ip_summed = CHECKSUM_UNNECESSARY; |
| 1109 | netif_rx(skb); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1110 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1111 | info->stats.rx_packets++; |
| 1112 | /* Add on 12 bytes for MAC address which was removed */ |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1113 | info->stats.rx_bytes += (lena + 12); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1114 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1115 | ft1000_submit_rx_urb(info); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1116 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1117 | return SUCCESS; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1118 | } |
| 1119 | |
Marek Belisko | bee1b21 | 2011-03-10 11:51:29 +0100 | [diff] [blame] | 1120 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1121 | //--------------------------------------------------------------------------- |
| 1122 | // |
| 1123 | // Function: ft1000_submit_rx_urb |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 1124 | // Description: the receiving function of the network driver |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1125 | // |
| 1126 | // Input: |
| 1127 | // info - a private structure contains the device information |
| 1128 | // |
| 1129 | // Output: |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1130 | // status - FAILURE |
| 1131 | // SUCCESS |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1132 | // |
| 1133 | //--------------------------------------------------------------------------- |
Marek Belisko | 1a88a06 | 2010-10-16 22:37:27 +0200 | [diff] [blame] | 1134 | static int ft1000_submit_rx_urb(struct ft1000_info *info) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1135 | { |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1136 | int result; |
| 1137 | struct ft1000_device *pFt1000Dev = info->pFt1000Dev; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1138 | |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1139 | if (pFt1000Dev->status & FT1000_STATUS_CLOSING) { |
| 1140 | DEBUG("network driver is closed, return\n"); |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1141 | return -ENODEV; |
| 1142 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1143 | |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1144 | usb_fill_bulk_urb(pFt1000Dev->rx_urb, |
| 1145 | pFt1000Dev->dev, |
| 1146 | usb_rcvbulkpipe(pFt1000Dev->dev, |
| 1147 | pFt1000Dev->bulk_in_endpointAddr), |
| 1148 | pFt1000Dev->rx_buf, MAX_BUF_SIZE, |
| 1149 | (usb_complete_t) ft1000_copy_up_pkt, info); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1150 | |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1151 | result = usb_submit_urb(pFt1000Dev->rx_urb, GFP_ATOMIC); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1152 | |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1153 | if (result) { |
| 1154 | pr_err("ft1000_submit_rx_urb: submitting rx_urb %d failed\n", |
| 1155 | result); |
| 1156 | return result; |
| 1157 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1158 | |
Marek Belisko | d778086 | 2010-11-02 14:51:46 +0100 | [diff] [blame] | 1159 | return 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1160 | } |
| 1161 | |
Marek Belisko | 6b2a66f | 2011-03-10 11:51:28 +0100 | [diff] [blame] | 1162 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1163 | //--------------------------------------------------------------------------- |
| 1164 | // Function: ft1000_open |
| 1165 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1166 | // Parameters: |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1167 | // dev - network device |
| 1168 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1169 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1170 | // Returns: none |
| 1171 | // |
| 1172 | // Description: open the network driver |
| 1173 | // |
| 1174 | // Notes: |
| 1175 | // |
| 1176 | //--------------------------------------------------------------------------- |
Marek Belisko | a01ffcd | 2011-03-10 11:51:30 +0100 | [diff] [blame] | 1177 | static int ft1000_open(struct net_device *dev) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1178 | { |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1179 | struct ft1000_info *pInfo = netdev_priv(dev); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1180 | struct timeval tv; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1181 | |
Marek Belisko | a01ffcd | 2011-03-10 11:51:30 +0100 | [diff] [blame] | 1182 | DEBUG("ft1000_open is called for card %d\n", pInfo->CardNumber); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1183 | |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1184 | pInfo->stats.rx_bytes = 0; |
| 1185 | pInfo->stats.tx_bytes = 0; |
| 1186 | pInfo->stats.rx_packets = 0; |
| 1187 | pInfo->stats.tx_packets = 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1188 | do_gettimeofday(&tv); |
Marek Belisko | a01ffcd | 2011-03-10 11:51:30 +0100 | [diff] [blame] | 1189 | pInfo->ConTm = tv.tv_sec; |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1190 | pInfo->ProgConStat = 0; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1191 | |
Marek Belisko | a01ffcd | 2011-03-10 11:51:30 +0100 | [diff] [blame] | 1192 | netif_start_queue(dev); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1193 | |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1194 | netif_carrier_on(dev); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1195 | |
Devendra Naga | 06e34df | 2012-06-19 21:53:32 +0530 | [diff] [blame] | 1196 | return ft1000_submit_rx_urb(pInfo); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1197 | } |
| 1198 | |
| 1199 | //--------------------------------------------------------------------------- |
| 1200 | // Function: ft1000_close |
| 1201 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1202 | // Parameters: |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1203 | // net - network device |
| 1204 | // |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1205 | // |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1206 | // Returns: none |
| 1207 | // |
| 1208 | // Description: close the network driver |
| 1209 | // |
| 1210 | // Notes: |
| 1211 | // |
| 1212 | //--------------------------------------------------------------------------- |
| 1213 | int ft1000_close(struct net_device *net) |
| 1214 | { |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1215 | struct ft1000_info *pInfo = netdev_priv(net); |
Marek Belisko | a007e84 | 2011-03-10 11:51:31 +0100 | [diff] [blame] | 1216 | struct ft1000_device *ft1000dev = pInfo->pFt1000Dev; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1217 | |
Marek Belisko | a007e84 | 2011-03-10 11:51:31 +0100 | [diff] [blame] | 1218 | ft1000dev->status |= FT1000_STATUS_CLOSING; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1219 | |
Marek Belisko | a007e84 | 2011-03-10 11:51:31 +0100 | [diff] [blame] | 1220 | DEBUG("ft1000_close: pInfo=%p, ft1000dev=%p\n", pInfo, ft1000dev); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1221 | netif_carrier_off(net); |
Marek Belisko | a007e84 | 2011-03-10 11:51:31 +0100 | [diff] [blame] | 1222 | netif_stop_queue(net); |
Marek Belisko | a007e84 | 2011-03-10 11:51:31 +0100 | [diff] [blame] | 1223 | ft1000dev->status &= ~FT1000_STATUS_CLOSING; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1224 | |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1225 | pInfo->ProgConStat = 0xff; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1226 | |
Marek Belisko | a007e84 | 2011-03-10 11:51:31 +0100 | [diff] [blame] | 1227 | return 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1228 | } |
| 1229 | |
| 1230 | static struct net_device_stats *ft1000_netdev_stats(struct net_device *dev) |
| 1231 | { |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1232 | struct ft1000_info *info = netdev_priv(dev); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1233 | |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1234 | return &(info->stats); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1235 | } |
| 1236 | |
| 1237 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1238 | //--------------------------------------------------------------------------- |
| 1239 | // |
| 1240 | // Function: ft1000_chkcard |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 1241 | // Description: This function will check if the device is presently available on |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1242 | // the system. |
| 1243 | // Input: |
| 1244 | // dev - device structure |
| 1245 | // Output: |
| 1246 | // status - FALSE (device is not present) |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1247 | // TRUE (device is present) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1248 | // |
| 1249 | //--------------------------------------------------------------------------- |
Marek Belisko | 53cd3aa | 2011-03-10 11:51:32 +0100 | [diff] [blame] | 1250 | static int ft1000_chkcard(struct ft1000_device *dev) |
| 1251 | { |
| 1252 | u16 tempword; |
| 1253 | u16 status; |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1254 | struct ft1000_info *info = netdev_priv(dev->net); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1255 | |
Marek Belisko | 53cd3aa | 2011-03-10 11:51:32 +0100 | [diff] [blame] | 1256 | if (info->fCondResetPend) { |
| 1257 | DEBUG |
| 1258 | ("ft1000_hw:ft1000_chkcard:Card is being reset, return FALSE\n"); |
| 1259 | return TRUE; |
| 1260 | } |
| 1261 | /* Mask register is used to check for device presence since it is never |
| 1262 | * set to zero. |
| 1263 | */ |
| 1264 | status = ft1000_read_register(dev, &tempword, FT1000_REG_SUP_IMASK); |
Marek Belisko | 53cd3aa | 2011-03-10 11:51:32 +0100 | [diff] [blame] | 1265 | if (tempword == 0) { |
| 1266 | DEBUG |
| 1267 | ("ft1000_hw:ft1000_chkcard: IMASK = 0 Card not detected\n"); |
| 1268 | return FALSE; |
| 1269 | } |
| 1270 | /* The system will return the value of 0xffff for the version register |
| 1271 | * if the device is not present. |
| 1272 | */ |
| 1273 | status = ft1000_read_register(dev, &tempword, FT1000_REG_ASIC_ID); |
Marek Belisko | 53cd3aa | 2011-03-10 11:51:32 +0100 | [diff] [blame] | 1274 | if (tempword != 0x1b01) { |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1275 | dev->status |= FT1000_STATUS_CLOSING; |
Marek Belisko | 53cd3aa | 2011-03-10 11:51:32 +0100 | [diff] [blame] | 1276 | DEBUG |
| 1277 | ("ft1000_hw:ft1000_chkcard: Version = 0xffff Card not detected\n"); |
| 1278 | return FALSE; |
| 1279 | } |
| 1280 | return TRUE; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1281 | } |
| 1282 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1283 | //--------------------------------------------------------------------------- |
| 1284 | // |
| 1285 | // Function: ft1000_receive_cmd |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 1286 | // Description: This function will read a message from the dpram area. |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1287 | // Input: |
| 1288 | // dev - network device structure |
| 1289 | // pbuffer - caller supply address to buffer |
| 1290 | // pnxtph - pointer to next pseudo header |
| 1291 | // Output: |
| 1292 | // Status = 0 (unsuccessful) |
| 1293 | // = 1 (successful) |
| 1294 | // |
| 1295 | //--------------------------------------------------------------------------- |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1296 | static bool ft1000_receive_cmd(struct ft1000_device *dev, u16 *pbuffer, |
| 1297 | int maxsz, u16 *pnxtph) |
| 1298 | { |
| 1299 | u16 size, ret; |
| 1300 | u16 *ppseudohdr; |
| 1301 | int i; |
| 1302 | u16 tempword; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1303 | |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1304 | ret = |
| 1305 | ft1000_read_dpram16(dev, FT1000_MAG_PH_LEN, (u8 *) &size, |
| 1306 | FT1000_MAG_PH_LEN_INDX); |
| 1307 | size = ntohs(size) + PSEUDOSZ; |
| 1308 | if (size > maxsz) { |
| 1309 | DEBUG("FT1000:ft1000_receive_cmd:Invalid command length = %d\n", |
| 1310 | size); |
| 1311 | return FALSE; |
| 1312 | } else { |
| 1313 | ppseudohdr = (u16 *) pbuffer; |
| 1314 | ft1000_write_register(dev, FT1000_DPRAM_MAG_RX_BASE, |
| 1315 | FT1000_REG_DPRAM_ADDR); |
| 1316 | ret = |
| 1317 | ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAH); |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1318 | pbuffer++; |
| 1319 | ft1000_write_register(dev, FT1000_DPRAM_MAG_RX_BASE + 1, |
| 1320 | FT1000_REG_DPRAM_ADDR); |
| 1321 | for (i = 0; i <= (size >> 2); i++) { |
| 1322 | ret = |
| 1323 | ft1000_read_register(dev, pbuffer, |
| 1324 | FT1000_REG_MAG_DPDATAL); |
| 1325 | pbuffer++; |
| 1326 | ret = |
| 1327 | ft1000_read_register(dev, pbuffer, |
| 1328 | FT1000_REG_MAG_DPDATAH); |
| 1329 | pbuffer++; |
| 1330 | } |
| 1331 | /* copy odd aligned word */ |
| 1332 | ret = |
| 1333 | ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAL); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1334 | |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1335 | pbuffer++; |
| 1336 | ret = |
| 1337 | ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAH); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1338 | |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1339 | pbuffer++; |
| 1340 | if (size & 0x0001) { |
| 1341 | /* copy odd byte from fifo */ |
| 1342 | ret = |
| 1343 | ft1000_read_register(dev, &tempword, |
| 1344 | FT1000_REG_DPRAM_DATA); |
| 1345 | *pbuffer = ntohs(tempword); |
| 1346 | } |
| 1347 | /* Check if pseudo header checksum is good |
| 1348 | * Calculate pseudo header checksum |
| 1349 | */ |
| 1350 | tempword = *ppseudohdr++; |
| 1351 | for (i = 1; i < 7; i++) |
| 1352 | tempword ^= *ppseudohdr++; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1353 | |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1354 | if ((tempword != *ppseudohdr)) |
| 1355 | return FALSE; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1356 | |
Marek Belisko | 8b2dab1 | 2011-03-10 11:51:33 +0100 | [diff] [blame] | 1357 | return TRUE; |
| 1358 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1359 | } |
| 1360 | |
Arnd Bergmann | 2a953cf | 2010-09-30 10:24:10 +0200 | [diff] [blame] | 1361 | static int ft1000_dsp_prov(void *arg) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1362 | { |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1363 | struct ft1000_device *dev = (struct ft1000_device *)arg; |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1364 | struct ft1000_info *info = netdev_priv(dev->net); |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1365 | u16 tempword; |
| 1366 | u16 len; |
| 1367 | u16 i = 0; |
Marek Belisko | e27d96d | 2010-10-15 14:13:01 +0200 | [diff] [blame] | 1368 | struct prov_record *ptr; |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 1369 | struct pseudo_hdr *ppseudo_hdr; |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1370 | u16 *pmsg; |
| 1371 | u16 status; |
| 1372 | u16 TempShortBuf[256]; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1373 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1374 | DEBUG("*** DspProv Entered\n"); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1375 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1376 | while (list_empty(&info->prov_list) == 0) { |
| 1377 | DEBUG("DSP Provisioning List Entry\n"); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1378 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1379 | /* Check if doorbell is available */ |
| 1380 | DEBUG("check if doorbell is cleared\n"); |
| 1381 | status = |
| 1382 | ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); |
| 1383 | if (status) { |
| 1384 | DEBUG("ft1000_dsp_prov::ft1000_read_register error\n"); |
| 1385 | break; |
| 1386 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1387 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1388 | while (tempword & FT1000_DB_DPRAM_TX) { |
| 1389 | mdelay(10); |
| 1390 | i++; |
| 1391 | if (i == 10) { |
| 1392 | DEBUG("FT1000:ft1000_dsp_prov:message drop\n"); |
| 1393 | return STATUS_FAILURE; |
| 1394 | } |
| 1395 | ft1000_read_register(dev, &tempword, |
| 1396 | FT1000_REG_DOORBELL); |
| 1397 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1398 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1399 | if (!(tempword & FT1000_DB_DPRAM_TX)) { |
| 1400 | DEBUG("*** Provision Data Sent to DSP\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1401 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1402 | /* Send provisioning data */ |
| 1403 | ptr = |
| 1404 | list_entry(info->prov_list.next, struct prov_record, |
| 1405 | list); |
| 1406 | len = *(u16 *) ptr->pprov_data; |
| 1407 | len = htons(len); |
| 1408 | len += PSEUDOSZ; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1409 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1410 | pmsg = (u16 *) ptr->pprov_data; |
| 1411 | ppseudo_hdr = (struct pseudo_hdr *)pmsg; |
| 1412 | /* Insert slow queue sequence number */ |
| 1413 | ppseudo_hdr->seq_num = info->squeseqnum++; |
| 1414 | ppseudo_hdr->portsrc = 0; |
| 1415 | /* Calculate new checksum */ |
| 1416 | ppseudo_hdr->checksum = *pmsg++; |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1417 | for (i = 1; i < 7; i++) { |
| 1418 | ppseudo_hdr->checksum ^= *pmsg++; |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1419 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1420 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1421 | TempShortBuf[0] = 0; |
| 1422 | TempShortBuf[1] = htons(len); |
| 1423 | memcpy(&TempShortBuf[2], ppseudo_hdr, len); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1424 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1425 | status = |
| 1426 | ft1000_write_dpram32(dev, 0, |
| 1427 | (u8 *) &TempShortBuf[0], |
| 1428 | (unsigned short)(len + 2)); |
| 1429 | status = |
| 1430 | ft1000_write_register(dev, FT1000_DB_DPRAM_TX, |
| 1431 | FT1000_REG_DOORBELL); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1432 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1433 | list_del(&ptr->list); |
| 1434 | kfree(ptr->pprov_data); |
| 1435 | kfree(ptr); |
| 1436 | } |
| 1437 | msleep(10); |
| 1438 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1439 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1440 | DEBUG("DSP Provisioning List Entry finished\n"); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1441 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1442 | msleep(100); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1443 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1444 | info->fProvComplete = 1; |
| 1445 | info->CardReady = 1; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1446 | |
Marek Belisko | fc796a6 | 2011-03-10 11:51:34 +0100 | [diff] [blame] | 1447 | return STATUS_SUCCESS; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1448 | } |
| 1449 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1450 | static int ft1000_proc_drvmsg(struct ft1000_device *dev, u16 size) |
| 1451 | { |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1452 | struct ft1000_info *info = netdev_priv(dev->net); |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1453 | u16 msgtype; |
| 1454 | u16 tempword; |
Marek Belisko | 1b8a301 | 2010-10-15 14:12:58 +0200 | [diff] [blame] | 1455 | struct media_msg *pmediamsg; |
Marek Belisko | 369e857 | 2010-10-15 14:12:59 +0200 | [diff] [blame] | 1456 | struct dsp_init_msg *pdspinitmsg; |
Marek Belisko | e09aee2 | 2010-10-15 14:13:03 +0200 | [diff] [blame] | 1457 | struct drv_msg *pdrvmsg; |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1458 | u16 i; |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 1459 | struct pseudo_hdr *ppseudo_hdr; |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1460 | u16 *pmsg; |
| 1461 | u16 status; |
| 1462 | union { |
| 1463 | u8 byte[2]; |
| 1464 | u16 wrd; |
| 1465 | } convert; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1466 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1467 | char *cmdbuffer = kmalloc(1600, GFP_KERNEL); |
| 1468 | if (!cmdbuffer) |
| 1469 | return STATUS_FAILURE; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1470 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1471 | status = ft1000_read_dpram32(dev, 0x200, cmdbuffer, size); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1472 | |
| 1473 | #ifdef JDEBUG |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1474 | DEBUG("ft1000_proc_drvmsg:cmdbuffer\n"); |
| 1475 | for (i = 0; i < size; i += 5) { |
| 1476 | if ((i + 5) < size) |
| 1477 | DEBUG("0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", cmdbuffer[i], |
| 1478 | cmdbuffer[i + 1], cmdbuffer[i + 2], |
| 1479 | cmdbuffer[i + 3], cmdbuffer[i + 4]); |
| 1480 | else { |
| 1481 | for (j = i; j < size; j++) |
| 1482 | DEBUG("0x%x ", cmdbuffer[j]); |
| 1483 | DEBUG("\n"); |
| 1484 | break; |
| 1485 | } |
| 1486 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1487 | #endif |
Marek Belisko | e09aee2 | 2010-10-15 14:13:03 +0200 | [diff] [blame] | 1488 | pdrvmsg = (struct drv_msg *)&cmdbuffer[2]; |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1489 | msgtype = ntohs(pdrvmsg->type); |
| 1490 | DEBUG("ft1000_proc_drvmsg:Command message type = 0x%x\n", msgtype); |
| 1491 | switch (msgtype) { |
| 1492 | case MEDIA_STATE:{ |
| 1493 | DEBUG |
| 1494 | ("ft1000_proc_drvmsg:Command message type = MEDIA_STATE"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1495 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1496 | pmediamsg = (struct media_msg *)&cmdbuffer[0]; |
| 1497 | if (info->ProgConStat != 0xFF) { |
| 1498 | if (pmediamsg->state) { |
| 1499 | DEBUG("Media is up\n"); |
| 1500 | if (info->mediastate == 0) { |
| 1501 | if (info->NetDevRegDone) { |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1502 | netif_wake_queue(dev-> |
| 1503 | net); |
| 1504 | } |
| 1505 | info->mediastate = 1; |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1506 | } |
| 1507 | } else { |
| 1508 | DEBUG("Media is down\n"); |
| 1509 | if (info->mediastate == 1) { |
| 1510 | info->mediastate = 0; |
| 1511 | if (info->NetDevRegDone) { |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1512 | } |
| 1513 | info->ConTm = 0; |
| 1514 | } |
| 1515 | } |
| 1516 | } else { |
| 1517 | DEBUG("Media is down\n"); |
| 1518 | if (info->mediastate == 1) { |
| 1519 | info->mediastate = 0; |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1520 | info->ConTm = 0; |
| 1521 | } |
| 1522 | } |
| 1523 | break; |
| 1524 | } |
| 1525 | case DSP_INIT_MSG:{ |
| 1526 | DEBUG |
| 1527 | ("ft1000_proc_drvmsg:Command message type = DSP_INIT_MSG"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1528 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1529 | pdspinitmsg = (struct dsp_init_msg *)&cmdbuffer[2]; |
| 1530 | memcpy(info->DspVer, pdspinitmsg->DspVer, DSPVERSZ); |
| 1531 | DEBUG("DSPVER = 0x%2x 0x%2x 0x%2x 0x%2x\n", |
| 1532 | info->DspVer[0], info->DspVer[1], info->DspVer[2], |
| 1533 | info->DspVer[3]); |
| 1534 | memcpy(info->HwSerNum, pdspinitmsg->HwSerNum, |
| 1535 | HWSERNUMSZ); |
| 1536 | memcpy(info->Sku, pdspinitmsg->Sku, SKUSZ); |
| 1537 | memcpy(info->eui64, pdspinitmsg->eui64, EUISZ); |
| 1538 | DEBUG("EUI64=%2x.%2x.%2x.%2x.%2x.%2x.%2x.%2x\n", |
| 1539 | info->eui64[0], info->eui64[1], info->eui64[2], |
| 1540 | info->eui64[3], info->eui64[4], info->eui64[5], |
| 1541 | info->eui64[6], info->eui64[7]); |
| 1542 | dev->net->dev_addr[0] = info->eui64[0]; |
| 1543 | dev->net->dev_addr[1] = info->eui64[1]; |
| 1544 | dev->net->dev_addr[2] = info->eui64[2]; |
| 1545 | dev->net->dev_addr[3] = info->eui64[5]; |
| 1546 | dev->net->dev_addr[4] = info->eui64[6]; |
| 1547 | dev->net->dev_addr[5] = info->eui64[7]; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1548 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1549 | if (ntohs(pdspinitmsg->length) == |
| 1550 | (sizeof(struct dsp_init_msg) - 20)) { |
| 1551 | memcpy(info->ProductMode, |
| 1552 | pdspinitmsg->ProductMode, MODESZ); |
| 1553 | memcpy(info->RfCalVer, pdspinitmsg->RfCalVer, |
| 1554 | CALVERSZ); |
| 1555 | memcpy(info->RfCalDate, pdspinitmsg->RfCalDate, |
| 1556 | CALDATESZ); |
| 1557 | DEBUG("RFCalVer = 0x%2x 0x%2x\n", |
| 1558 | info->RfCalVer[0], info->RfCalVer[1]); |
| 1559 | } |
| 1560 | break; |
| 1561 | } |
| 1562 | case DSP_PROVISION:{ |
| 1563 | DEBUG |
| 1564 | ("ft1000_proc_drvmsg:Command message type = DSP_PROVISION\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1565 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1566 | /* kick off dspprov routine to start provisioning |
| 1567 | * Send provisioning data to DSP |
| 1568 | */ |
| 1569 | if (list_empty(&info->prov_list) == 0) { |
| 1570 | info->fProvComplete = 0; |
| 1571 | status = ft1000_dsp_prov(dev); |
| 1572 | if (status != STATUS_SUCCESS) |
| 1573 | goto out; |
| 1574 | } else { |
| 1575 | info->fProvComplete = 1; |
| 1576 | status = |
| 1577 | ft1000_write_register(dev, FT1000_DB_HB, |
| 1578 | FT1000_REG_DOORBELL); |
| 1579 | DEBUG |
| 1580 | ("FT1000:drivermsg:No more DSP provisioning data in dsp image\n"); |
| 1581 | } |
| 1582 | DEBUG("ft1000_proc_drvmsg:DSP PROVISION is done\n"); |
| 1583 | break; |
| 1584 | } |
| 1585 | case DSP_STORE_INFO:{ |
| 1586 | DEBUG |
| 1587 | ("ft1000_proc_drvmsg:Command message type = DSP_STORE_INFO"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1588 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1589 | DEBUG("FT1000:drivermsg:Got DSP_STORE_INFO\n"); |
| 1590 | tempword = ntohs(pdrvmsg->length); |
| 1591 | info->DSPInfoBlklen = tempword; |
| 1592 | if (tempword < (MAX_DSP_SESS_REC - 4)) { |
| 1593 | pmsg = (u16 *) &pdrvmsg->data[0]; |
| 1594 | for (i = 0; i < ((tempword + 1) / 2); i++) { |
| 1595 | DEBUG |
| 1596 | ("FT1000:drivermsg:dsp info data = 0x%x\n", |
| 1597 | *pmsg); |
| 1598 | info->DSPInfoBlk[i + 10] = *pmsg++; |
| 1599 | } |
| 1600 | } else { |
| 1601 | info->DSPInfoBlklen = 0; |
| 1602 | } |
| 1603 | break; |
| 1604 | } |
| 1605 | case DSP_GET_INFO:{ |
| 1606 | DEBUG("FT1000:drivermsg:Got DSP_GET_INFO\n"); |
| 1607 | /* copy dsp info block to dsp */ |
| 1608 | info->DrvMsgPend = 1; |
| 1609 | /* allow any outstanding ioctl to finish */ |
| 1610 | mdelay(10); |
| 1611 | status = |
| 1612 | ft1000_read_register(dev, &tempword, |
| 1613 | FT1000_REG_DOORBELL); |
| 1614 | if (tempword & FT1000_DB_DPRAM_TX) { |
| 1615 | mdelay(10); |
| 1616 | status = |
| 1617 | ft1000_read_register(dev, &tempword, |
| 1618 | FT1000_REG_DOORBELL); |
| 1619 | if (tempword & FT1000_DB_DPRAM_TX) { |
| 1620 | mdelay(10); |
| 1621 | status = |
| 1622 | ft1000_read_register(dev, &tempword, |
| 1623 | FT1000_REG_DOORBELL); |
| 1624 | if (tempword & FT1000_DB_DPRAM_TX) |
| 1625 | break; |
| 1626 | } |
| 1627 | } |
| 1628 | /* Put message into Slow Queue |
| 1629 | * Form Pseudo header |
| 1630 | */ |
| 1631 | pmsg = (u16 *) info->DSPInfoBlk; |
| 1632 | *pmsg++ = 0; |
| 1633 | *pmsg++ = |
| 1634 | htons(info->DSPInfoBlklen + 20 + |
| 1635 | info->DSPInfoBlklen); |
| 1636 | ppseudo_hdr = |
| 1637 | (struct pseudo_hdr *)(u16 *) &info->DSPInfoBlk[2]; |
| 1638 | ppseudo_hdr->length = |
| 1639 | htons(info->DSPInfoBlklen + 4 + |
| 1640 | info->DSPInfoBlklen); |
| 1641 | ppseudo_hdr->source = 0x10; |
| 1642 | ppseudo_hdr->destination = 0x20; |
| 1643 | ppseudo_hdr->portdest = 0; |
| 1644 | ppseudo_hdr->portsrc = 0; |
| 1645 | ppseudo_hdr->sh_str_id = 0; |
| 1646 | ppseudo_hdr->control = 0; |
| 1647 | ppseudo_hdr->rsvd1 = 0; |
| 1648 | ppseudo_hdr->rsvd2 = 0; |
| 1649 | ppseudo_hdr->qos_class = 0; |
| 1650 | /* Insert slow queue sequence number */ |
| 1651 | ppseudo_hdr->seq_num = info->squeseqnum++; |
| 1652 | /* Insert application id */ |
| 1653 | ppseudo_hdr->portsrc = 0; |
| 1654 | /* Calculate new checksum */ |
| 1655 | ppseudo_hdr->checksum = *pmsg++; |
| 1656 | for (i = 1; i < 7; i++) |
| 1657 | ppseudo_hdr->checksum ^= *pmsg++; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1658 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1659 | info->DSPInfoBlk[10] = 0x7200; |
| 1660 | info->DSPInfoBlk[11] = htons(info->DSPInfoBlklen); |
| 1661 | status = |
| 1662 | ft1000_write_dpram32(dev, 0, |
| 1663 | (u8 *) &info->DSPInfoBlk[0], |
| 1664 | (unsigned short)(info-> |
| 1665 | DSPInfoBlklen |
| 1666 | + 22)); |
| 1667 | status = |
| 1668 | ft1000_write_register(dev, FT1000_DB_DPRAM_TX, |
| 1669 | FT1000_REG_DOORBELL); |
| 1670 | info->DrvMsgPend = 0; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1671 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1672 | break; |
| 1673 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1674 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1675 | case GET_DRV_ERR_RPT_MSG:{ |
| 1676 | DEBUG("FT1000:drivermsg:Got GET_DRV_ERR_RPT_MSG\n"); |
| 1677 | /* copy driver error message to dsp */ |
| 1678 | info->DrvMsgPend = 1; |
| 1679 | /* allow any outstanding ioctl to finish */ |
| 1680 | mdelay(10); |
| 1681 | status = |
| 1682 | ft1000_read_register(dev, &tempword, |
| 1683 | FT1000_REG_DOORBELL); |
| 1684 | if (tempword & FT1000_DB_DPRAM_TX) { |
| 1685 | mdelay(10); |
| 1686 | status = |
| 1687 | ft1000_read_register(dev, &tempword, |
| 1688 | FT1000_REG_DOORBELL); |
| 1689 | if (tempword & FT1000_DB_DPRAM_TX) |
| 1690 | mdelay(10); |
| 1691 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1692 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1693 | if ((tempword & FT1000_DB_DPRAM_TX) == 0) { |
| 1694 | /* Put message into Slow Queue |
| 1695 | * Form Pseudo header |
| 1696 | */ |
| 1697 | pmsg = (u16 *) &tempbuffer[0]; |
| 1698 | ppseudo_hdr = (struct pseudo_hdr *)pmsg; |
| 1699 | ppseudo_hdr->length = htons(0x0012); |
| 1700 | ppseudo_hdr->source = 0x10; |
| 1701 | ppseudo_hdr->destination = 0x20; |
| 1702 | ppseudo_hdr->portdest = 0; |
| 1703 | ppseudo_hdr->portsrc = 0; |
| 1704 | ppseudo_hdr->sh_str_id = 0; |
| 1705 | ppseudo_hdr->control = 0; |
| 1706 | ppseudo_hdr->rsvd1 = 0; |
| 1707 | ppseudo_hdr->rsvd2 = 0; |
| 1708 | ppseudo_hdr->qos_class = 0; |
| 1709 | /* Insert slow queue sequence number */ |
| 1710 | ppseudo_hdr->seq_num = info->squeseqnum++; |
| 1711 | /* Insert application id */ |
| 1712 | ppseudo_hdr->portsrc = 0; |
| 1713 | /* Calculate new checksum */ |
| 1714 | ppseudo_hdr->checksum = *pmsg++; |
| 1715 | for (i = 1; i < 7; i++) |
| 1716 | ppseudo_hdr->checksum ^= *pmsg++; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1717 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1718 | pmsg = (u16 *) &tempbuffer[16]; |
| 1719 | *pmsg++ = htons(RSP_DRV_ERR_RPT_MSG); |
| 1720 | *pmsg++ = htons(0x000e); |
| 1721 | *pmsg++ = htons(info->DSP_TIME[0]); |
| 1722 | *pmsg++ = htons(info->DSP_TIME[1]); |
| 1723 | *pmsg++ = htons(info->DSP_TIME[2]); |
| 1724 | *pmsg++ = htons(info->DSP_TIME[3]); |
| 1725 | convert.byte[0] = info->DspVer[0]; |
| 1726 | convert.byte[1] = info->DspVer[1]; |
| 1727 | *pmsg++ = convert.wrd; |
| 1728 | convert.byte[0] = info->DspVer[2]; |
| 1729 | convert.byte[1] = info->DspVer[3]; |
| 1730 | *pmsg++ = convert.wrd; |
| 1731 | *pmsg++ = htons(info->DrvErrNum); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1732 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1733 | card_send_command(dev, |
| 1734 | (unsigned char *)&tempbuffer[0], |
| 1735 | (u16) (0x0012 + PSEUDOSZ)); |
| 1736 | info->DrvErrNum = 0; |
| 1737 | } |
| 1738 | info->DrvMsgPend = 0; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1739 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1740 | break; |
| 1741 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1742 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1743 | default: |
| 1744 | break; |
| 1745 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1746 | |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1747 | status = STATUS_SUCCESS; |
Arnd Bergmann | 2a953cf | 2010-09-30 10:24:10 +0200 | [diff] [blame] | 1748 | out: |
Marek Belisko | 6d2b672 | 2011-03-10 11:51:35 +0100 | [diff] [blame] | 1749 | kfree(cmdbuffer); |
| 1750 | DEBUG("return from ft1000_proc_drvmsg\n"); |
| 1751 | return status; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1752 | } |
| 1753 | |
Devendra Naga | aab0489 | 2012-07-01 23:31:35 +0530 | [diff] [blame] | 1754 | int ft1000_poll(void* dev_id) |
| 1755 | { |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1756 | struct ft1000_device *dev = (struct ft1000_device *)dev_id; |
Joe Perches | e33196e | 2010-11-15 13:12:32 -0800 | [diff] [blame] | 1757 | struct ft1000_info *info = netdev_priv(dev->net); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1758 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1759 | u16 tempword; |
| 1760 | u16 status; |
| 1761 | u16 size; |
| 1762 | int i; |
Marek Belisko | fc549a0 | 2010-11-03 11:19:50 +0100 | [diff] [blame] | 1763 | u16 data; |
| 1764 | u16 modulo; |
| 1765 | u16 portid; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1766 | u16 nxtph; |
Marek Belisko | 29437ab | 2010-10-16 22:37:25 +0200 | [diff] [blame] | 1767 | struct dpram_blk *pdpram_blk; |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 1768 | struct pseudo_hdr *ppseudo_hdr; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1769 | unsigned long flags; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1770 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1771 | if (ft1000_chkcard(dev) == FALSE) { |
| 1772 | DEBUG("ft1000_poll::ft1000_chkcard: failed\n"); |
| 1773 | return STATUS_FAILURE; |
| 1774 | } |
| 1775 | |
| 1776 | status = ft1000_read_register (dev, &tempword, FT1000_REG_DOORBELL); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1777 | |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1778 | if ( !status ) |
| 1779 | { |
| 1780 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1781 | if (tempword & FT1000_DB_DPRAM_RX) { |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1782 | |
Marek Belisko | e2cb7da | 2010-11-03 11:19:47 +0100 | [diff] [blame] | 1783 | status = ft1000_read_dpram16(dev, 0x200, (u8 *)&data, 0); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1784 | size = ntohs(data) + 16 + 2; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1785 | if (size % 4) { |
| 1786 | modulo = 4 - (size % 4); |
| 1787 | size = size + modulo; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1788 | } |
Marek Belisko | e2cb7da | 2010-11-03 11:19:47 +0100 | [diff] [blame] | 1789 | status = ft1000_read_dpram16(dev, 0x201, (u8 *)&portid, 1); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1790 | portid &= 0xff; |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1791 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1792 | if (size < MAX_CMD_SQSIZE) { |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1793 | switch (portid) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1794 | { |
| 1795 | case DRIVERID: |
| 1796 | DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid DRIVERID\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1797 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1798 | status = ft1000_proc_drvmsg (dev, size); |
| 1799 | if (status != STATUS_SUCCESS ) |
| 1800 | return status; |
| 1801 | break; |
| 1802 | case DSPBCMSGID: |
| 1803 | // This is a dsp broadcast message |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1804 | // Check which application has registered for dsp broadcast messages |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1805 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1806 | for (i=0; i<MAX_NUM_APP; i++) { |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1807 | if ( (info->app_info[i].DspBCMsgFlag) && (info->app_info[i].fileobject) && |
| 1808 | (info->app_info[i].NumOfMsg < MAX_MSG_LIMIT) ) |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1809 | { |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1810 | nxtph = FT1000_DPRAM_RX_BASE + 2; |
| 1811 | pdpram_blk = ft1000_get_buffer (&freercvpool); |
| 1812 | if (pdpram_blk != NULL) { |
| 1813 | if ( ft1000_receive_cmd(dev, pdpram_blk->pbuffer, MAX_CMD_SQSIZE, &nxtph) ) { |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 1814 | ppseudo_hdr = (struct pseudo_hdr *)pdpram_blk->pbuffer; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1815 | // Put message into the appropriate application block |
| 1816 | info->app_info[i].nRxMsg++; |
| 1817 | spin_lock_irqsave(&free_buff_lock, flags); |
| 1818 | list_add_tail(&pdpram_blk->list, &info->app_info[i].app_sqlist); |
| 1819 | info->app_info[i].NumOfMsg++; |
| 1820 | spin_unlock_irqrestore(&free_buff_lock, flags); |
| 1821 | wake_up_interruptible(&info->app_info[i].wait_dpram_msg); |
| 1822 | } |
| 1823 | else { |
| 1824 | info->app_info[i].nRxMsgMiss++; |
| 1825 | // Put memory back to free pool |
| 1826 | ft1000_free_buffer(pdpram_blk, &freercvpool); |
| 1827 | DEBUG("pdpram_blk::ft1000_get_buffer NULL\n"); |
| 1828 | } |
| 1829 | } |
| 1830 | else { |
| 1831 | DEBUG("Out of memory in free receive command pool\n"); |
| 1832 | info->app_info[i].nRxMsgMiss++; |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1833 | } |
| 1834 | } |
| 1835 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1836 | break; |
| 1837 | default: |
| 1838 | pdpram_blk = ft1000_get_buffer (&freercvpool); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1839 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1840 | if (pdpram_blk != NULL) { |
| 1841 | if ( ft1000_receive_cmd(dev, pdpram_blk->pbuffer, MAX_CMD_SQSIZE, &nxtph) ) { |
Marek Belisko | b13e39b | 2010-10-15 14:13:02 +0200 | [diff] [blame] | 1842 | ppseudo_hdr = (struct pseudo_hdr *)pdpram_blk->pbuffer; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1843 | // Search for correct application block |
| 1844 | for (i=0; i<MAX_NUM_APP; i++) { |
| 1845 | if (info->app_info[i].app_id == ppseudo_hdr->portdest) { |
| 1846 | break; |
| 1847 | } |
| 1848 | } |
| 1849 | |
Dan Carpenter | fcbf77b | 2010-10-15 05:42:00 +0200 | [diff] [blame] | 1850 | if (i == MAX_NUM_APP) { |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1851 | DEBUG("FT1000:ft1000_parse_dpram_msg: No application matching id = %d\n", ppseudo_hdr->portdest); |
| 1852 | // Put memory back to free pool |
| 1853 | ft1000_free_buffer(pdpram_blk, &freercvpool); |
| 1854 | } |
| 1855 | else { |
| 1856 | if (info->app_info[i].NumOfMsg > MAX_MSG_LIMIT) { |
| 1857 | // Put memory back to free pool |
| 1858 | ft1000_free_buffer(pdpram_blk, &freercvpool); |
| 1859 | } |
| 1860 | else { |
| 1861 | info->app_info[i].nRxMsg++; |
| 1862 | // Put message into the appropriate application block |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1863 | list_add_tail(&pdpram_blk->list, &info->app_info[i].app_sqlist); |
| 1864 | info->app_info[i].NumOfMsg++; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1865 | } |
| 1866 | } |
| 1867 | } |
| 1868 | else { |
| 1869 | // Put memory back to free pool |
| 1870 | ft1000_free_buffer(pdpram_blk, &freercvpool); |
| 1871 | } |
| 1872 | } |
| 1873 | else { |
| 1874 | DEBUG("Out of memory in free receive command pool\n"); |
| 1875 | } |
| 1876 | break; |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1877 | } |
| 1878 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1879 | else { |
| 1880 | DEBUG("FT1000:dpc:Invalid total length for SlowQ = %d\n", size); |
| 1881 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1882 | status = ft1000_write_register (dev, FT1000_DB_DPRAM_RX, FT1000_REG_DOORBELL); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1883 | } |
| 1884 | else if (tempword & FT1000_DSP_ASIC_RESET) { |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1885 | |
| 1886 | // Let's reset the ASIC from the Host side as well |
| 1887 | status = ft1000_write_register (dev, ASIC_RESET_BIT, FT1000_REG_RESET); |
| 1888 | status = ft1000_read_register (dev, &tempword, FT1000_REG_RESET); |
| 1889 | i = 0; |
| 1890 | while (tempword & ASIC_RESET_BIT) { |
| 1891 | status = ft1000_read_register (dev, &tempword, FT1000_REG_RESET); |
| 1892 | msleep(10); |
| 1893 | i++; |
| 1894 | if (i==100) |
| 1895 | break; |
| 1896 | } |
| 1897 | if (i==100) { |
| 1898 | DEBUG("Unable to reset ASIC\n"); |
| 1899 | return STATUS_SUCCESS; |
| 1900 | } |
| 1901 | msleep(10); |
| 1902 | // Program WMARK register |
| 1903 | status = ft1000_write_register (dev, 0x600, FT1000_REG_MAG_WATERMARK); |
| 1904 | // clear ASIC reset doorbell |
| 1905 | status = ft1000_write_register (dev, FT1000_DSP_ASIC_RESET, FT1000_REG_DOORBELL); |
| 1906 | msleep(10); |
| 1907 | } |
| 1908 | else if (tempword & FT1000_ASIC_RESET_REQ) { |
| 1909 | DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_ASIC_RESET_REQ\n"); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1910 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1911 | // clear ASIC reset request from DSP |
| 1912 | status = ft1000_write_register (dev, FT1000_ASIC_RESET_REQ, FT1000_REG_DOORBELL); |
| 1913 | status = ft1000_write_register (dev, HOST_INTF_BE, FT1000_REG_SUP_CTRL); |
| 1914 | // copy dsp session record from Adapter block |
Marek Belisko | e2cb7da | 2010-11-03 11:19:47 +0100 | [diff] [blame] | 1915 | status = ft1000_write_dpram32 (dev, 0, (u8 *)&info->DSPSess.Rec[0], 1024); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1916 | // Program WMARK register |
| 1917 | status = ft1000_write_register (dev, 0x600, FT1000_REG_MAG_WATERMARK); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1918 | // ring doorbell to tell DSP that ASIC is out of reset |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1919 | status = ft1000_write_register (dev, FT1000_ASIC_RESET_DSP, FT1000_REG_DOORBELL); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1920 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1921 | else if (tempword & FT1000_DB_COND_RESET) { |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1922 | DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_COND_RESET\n"); |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1923 | |
| 1924 | if (info->fAppMsgPend == 0) { |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1925 | // Reset ASIC and DSP |
| 1926 | |
Marek Belisko | e2cb7da | 2010-11-03 11:19:47 +0100 | [diff] [blame] | 1927 | status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER0, (u8 *)&(info->DSP_TIME[0]), FT1000_MAG_DSP_TIMER0_INDX); |
| 1928 | status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER1, (u8 *)&(info->DSP_TIME[1]), FT1000_MAG_DSP_TIMER1_INDX); |
| 1929 | status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER2, (u8 *)&(info->DSP_TIME[2]), FT1000_MAG_DSP_TIMER2_INDX); |
| 1930 | status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER3, (u8 *)&(info->DSP_TIME[3]), FT1000_MAG_DSP_TIMER3_INDX); |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1931 | info->CardReady = 0; |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1932 | info->DrvErrNum = DSP_CONDRESET_INFO; |
| 1933 | DEBUG("ft1000_hw:DSP conditional reset requested\n"); |
| 1934 | info->ft1000_reset(dev->net); |
| 1935 | } |
| 1936 | else { |
| 1937 | info->fProvComplete = 0; |
| 1938 | info->fCondResetPend = 1; |
| 1939 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1940 | |
| 1941 | ft1000_write_register(dev, FT1000_DB_COND_RESET, FT1000_REG_DOORBELL); |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1942 | } |
Greg Kroah-Hartman | bf3146c | 2010-09-22 08:34:49 -0700 | [diff] [blame] | 1943 | |
Marek Belisko | 19cb284 | 2011-03-28 13:10:27 +0200 | [diff] [blame] | 1944 | } |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1945 | |
Marek Belisko | f7c1be0 | 2010-09-22 07:56:27 +0200 | [diff] [blame] | 1946 | return STATUS_SUCCESS; |
| 1947 | |
| 1948 | } |