1 //=====================================================
2 // CopyRight (C) 2007 Qualcomm Inc. All Rights Reserved.
5 // This file is part of Express Card USB Driver
8 //====================================================
9 // 20090926; aelias; removed compiler warnings & errors; ubuntu 9.04; 2.6.28-15-generic
11 #include <linux/init.h>
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/netdevice.h>
15 #include <linux/etherdevice.h>
16 #include <linux/usb.h>
17 #include "ft1000_usb.h"
18 #include <linux/types.h>
20 #define HARLEY_READ_REGISTER 0x0
21 #define HARLEY_WRITE_REGISTER 0x01
22 #define HARLEY_READ_DPRAM_32 0x02
23 #define HARLEY_READ_DPRAM_LOW 0x03
24 #define HARLEY_READ_DPRAM_HIGH 0x04
25 #define HARLEY_WRITE_DPRAM_32 0x05
26 #define HARLEY_WRITE_DPRAM_LOW 0x06
27 #define HARLEY_WRITE_DPRAM_HIGH 0x07
29 #define HARLEY_READ_OPERATION 0xc1
30 #define HARLEY_WRITE_OPERATION 0x41
34 static int ft1000_reset(struct net_device
*ft1000dev
);
35 static int ft1000_submit_rx_urb(struct ft1000_info
*info
);
36 static int ft1000_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
);
37 static int ft1000_open (struct net_device
*dev
);
38 static struct net_device_stats
*ft1000_netdev_stats(struct net_device
*dev
);
39 static int ft1000_chkcard (struct ft1000_device
*dev
);
43 static u8 tempbuffer
[1600];
45 #define MAX_RCV_LOOP 100
47 //---------------------------------------------------------------------------
48 // Function: ft1000_control
50 // Parameters: ft1000_device - device structure
51 // pipe - usb control message pipe
52 // request - control request
53 // requesttype - control message request type
54 // value - value to be written or 0
55 // index - register index
56 // data - data buffer to hold the read/write values
58 // timeout - control message time out value
60 // Returns: STATUS_SUCCESS - success
61 // STATUS_FAILURE - failure
63 // Description: This function sends a control message via USB interface synchronously
67 //---------------------------------------------------------------------------
68 static int ft1000_control(struct ft1000_device
*ft1000dev
, unsigned int pipe
,
69 u8 request
, u8 requesttype
, u16 value
, u16 index
,
70 void *data
, u16 size
, int timeout
)
74 if ((ft1000dev
== NULL
) || (ft1000dev
->dev
== NULL
)) {
75 DEBUG("ft1000dev or ft1000dev->dev == NULL, failure\n");
79 ret
= usb_control_msg(ft1000dev
->dev
, pipe
, request
, requesttype
,
80 value
, index
, data
, size
, LARGE_TIMEOUT
);
88 //---------------------------------------------------------------------------
89 // Function: ft1000_read_register
91 // Parameters: ft1000_device - device structure
92 // Data - data buffer to hold the value read
93 // nRegIndex - register index
95 // Returns: STATUS_SUCCESS - success
96 // STATUS_FAILURE - failure
98 // Description: This function returns the value in a register
102 //---------------------------------------------------------------------------
104 int ft1000_read_register(struct ft1000_device
*ft1000dev
, u16
* Data
,
107 int ret
= STATUS_SUCCESS
;
109 ret
= ft1000_control(ft1000dev
,
110 usb_rcvctrlpipe(ft1000dev
->dev
, 0),
111 HARLEY_READ_REGISTER
,
112 HARLEY_READ_OPERATION
,
122 //---------------------------------------------------------------------------
123 // Function: ft1000_write_register
125 // Parameters: ft1000_device - device structure
126 // value - value to write into a register
127 // nRegIndex - register index
129 // Returns: STATUS_SUCCESS - success
130 // STATUS_FAILURE - failure
132 // Description: This function writes the value in a register
136 //---------------------------------------------------------------------------
137 int ft1000_write_register(struct ft1000_device
*ft1000dev
, u16 value
,
140 int ret
= STATUS_SUCCESS
;
142 ret
= ft1000_control(ft1000dev
,
143 usb_sndctrlpipe(ft1000dev
->dev
, 0),
144 HARLEY_WRITE_REGISTER
,
145 HARLEY_WRITE_OPERATION
,
155 //---------------------------------------------------------------------------
156 // Function: ft1000_read_dpram32
158 // Parameters: ft1000_device - device structure
159 // indx - starting address to read
160 // buffer - data buffer to hold the data read
161 // cnt - number of byte read from DPRAM
163 // Returns: STATUS_SUCCESS - success
164 // STATUS_FAILURE - failure
166 // Description: This function read a number of bytes from DPRAM
170 //---------------------------------------------------------------------------
172 int ft1000_read_dpram32(struct ft1000_device
*ft1000dev
, u16 indx
, u8
*buffer
, u16 cnt
)
174 int ret
= STATUS_SUCCESS
;
176 //DEBUG("ft1000_read_dpram32: indx: %d cnt: %d\n", indx, cnt);
177 ret
=ft1000_control(ft1000dev
,
178 usb_rcvctrlpipe(ft1000dev
->dev
,0),
179 HARLEY_READ_DPRAM_32
, //request --READ_DPRAM_32
180 HARLEY_READ_OPERATION
, //requestType
185 LARGE_TIMEOUT
); //timeout
187 //DEBUG("ft1000_read_dpram32: ret is %d \n", ret);
189 //DEBUG("ft1000_read_dpram32: ret=%d \n", ret);
195 //---------------------------------------------------------------------------
196 // Function: ft1000_write_dpram32
198 // Parameters: ft1000_device - device structure
199 // indx - starting address to write the data
200 // buffer - data buffer to write into DPRAM
201 // cnt - number of bytes to write
203 // Returns: STATUS_SUCCESS - success
204 // STATUS_FAILURE - failure
206 // Description: This function writes into DPRAM a number of bytes
210 //---------------------------------------------------------------------------
211 int ft1000_write_dpram32(struct ft1000_device
*ft1000dev
, u16 indx
, u8
*buffer
, u16 cnt
)
213 int ret
= STATUS_SUCCESS
;
215 //DEBUG("ft1000_write_dpram32: indx: %d buffer: %x cnt: %d\n", indx, buffer, cnt);
217 cnt
+= cnt
- (cnt
% 4);
219 ret
= ft1000_control(ft1000dev
,
220 usb_sndctrlpipe(ft1000dev
->dev
, 0),
221 HARLEY_WRITE_DPRAM_32
, //request -- WRITE_DPRAM_32
222 HARLEY_WRITE_OPERATION
, //requestType
232 //---------------------------------------------------------------------------
233 // Function: ft1000_read_dpram16
235 // Parameters: ft1000_device - device structure
236 // indx - starting address to read
237 // buffer - data buffer to hold the data read
238 // hightlow - high or low 16 bit word
240 // Returns: STATUS_SUCCESS - success
241 // STATUS_FAILURE - failure
243 // Description: This function read 16 bits from DPRAM
247 //---------------------------------------------------------------------------
248 int ft1000_read_dpram16(struct ft1000_device
*ft1000dev
, u16 indx
, u8
*buffer
, u8 highlow
)
250 int ret
= STATUS_SUCCESS
;
252 //DEBUG("ft1000_read_dpram16: indx: %d hightlow: %d\n", indx, highlow);
257 request
= HARLEY_READ_DPRAM_LOW
;
259 request
= HARLEY_READ_DPRAM_HIGH
;
261 ret
= ft1000_control(ft1000dev
,
262 usb_rcvctrlpipe(ft1000dev
->dev
,0),
263 request
, //request --READ_DPRAM_H/L
264 HARLEY_READ_OPERATION
, //requestType
269 LARGE_TIMEOUT
); //timeout
271 //DEBUG("ft1000_read_dpram16: ret is %d \n", ret);
274 //DEBUG("ft1000_read_dpram16: data is %x \n", *buffer);
280 //---------------------------------------------------------------------------
281 // Function: ft1000_write_dpram16
283 // Parameters: ft1000_device - device structure
284 // indx - starting address to write the data
285 // value - 16bits value to write
286 // hightlow - high or low 16 bit word
288 // Returns: STATUS_SUCCESS - success
289 // STATUS_FAILURE - failure
291 // Description: This function writes into DPRAM a number of bytes
295 //---------------------------------------------------------------------------
296 int ft1000_write_dpram16(struct ft1000_device
*ft1000dev
, u16 indx
, u16 value
, u8 highlow
)
298 int ret
= STATUS_SUCCESS
;
302 //DEBUG("ft1000_write_dpram16: indx: %d value: %d highlow: %d\n", indx, value, highlow);
308 request
= HARLEY_WRITE_DPRAM_LOW
;
310 request
= HARLEY_WRITE_DPRAM_HIGH
;
312 ret
= ft1000_control(ft1000dev
,
313 usb_sndctrlpipe(ft1000dev
->dev
, 0),
314 request
, //request -- WRITE_DPRAM_H/L
315 HARLEY_WRITE_OPERATION
, //requestType
325 //---------------------------------------------------------------------------
326 // Function: fix_ft1000_read_dpram32
328 // Parameters: ft1000_device - device structure
329 // indx - starting address to read
330 // buffer - data buffer to hold the data read
333 // Returns: STATUS_SUCCESS - success
334 // STATUS_FAILURE - failure
336 // Description: This function read DPRAM 4 words at a time
340 //---------------------------------------------------------------------------
341 int fix_ft1000_read_dpram32(struct ft1000_device
*ft1000dev
, u16 indx
, u8
*buffer
)
345 int ret
= STATUS_SUCCESS
;
347 //DEBUG("fix_ft1000_read_dpram32: indx: %d \n", indx);
349 ret
= ft1000_read_dpram32(ft1000dev
, pos
, buf
, 16);
350 if (ret
== STATUS_SUCCESS
)
353 *buffer
++ = buf
[pos
++];
354 *buffer
++ = buf
[pos
++];
355 *buffer
++ = buf
[pos
++];
356 *buffer
++ = buf
[pos
++];
360 DEBUG("fix_ft1000_read_dpram32: DPRAM32 Read failed\n");
368 //DEBUG("fix_ft1000_read_dpram32: data is %x \n", *buffer);
374 //---------------------------------------------------------------------------
375 // Function: fix_ft1000_write_dpram32
377 // Parameters: ft1000_device - device structure
378 // indx - starting address to write
379 // buffer - data buffer to write
382 // Returns: STATUS_SUCCESS - success
383 // STATUS_FAILURE - failure
385 // Description: This function write to DPRAM 4 words at a time
389 //---------------------------------------------------------------------------
390 int fix_ft1000_write_dpram32(struct ft1000_device
*ft1000dev
, u16 indx
, u8
*buffer
)
398 int ret
= STATUS_SUCCESS
;
400 //DEBUG("fix_ft1000_write_dpram32: Entered:\n");
404 ret
= ft1000_read_dpram32(ft1000dev
, pos1
, buf
, 16);
405 if (ret
== STATUS_SUCCESS
)
408 buf
[pos2
++] = *buffer
++;
409 buf
[pos2
++] = *buffer
++;
410 buf
[pos2
++] = *buffer
++;
411 buf
[pos2
++] = *buffer
++;
412 ret
= ft1000_write_dpram32(ft1000dev
, pos1
, buf
, 16);
416 DEBUG("fix_ft1000_write_dpram32: DPRAM32 Read failed\n");
421 ret
= ft1000_read_dpram32(ft1000dev
, pos1
, (u8
*)&resultbuffer
[0], 16);
422 if (ret
== STATUS_SUCCESS
)
427 if (buf
[i
] != resultbuffer
[i
]){
429 ret
= STATUS_FAILURE
;
434 if (ret
== STATUS_FAILURE
)
436 ret
= ft1000_write_dpram32(ft1000dev
, pos1
, (u8
*)&tempbuffer
[0], 16);
437 ret
= ft1000_read_dpram32(ft1000dev
, pos1
, (u8
*)&resultbuffer
[0], 16);
438 if (ret
== STATUS_SUCCESS
)
443 if (tempbuffer
[i
] != resultbuffer
[i
])
445 ret
= STATUS_FAILURE
;
446 DEBUG("fix_ft1000_write_dpram32 Failed to write\n");
457 //------------------------------------------------------------------------
459 // Function: card_reset_dsp
461 // Synopsis: This function is called to reset or activate the DSP
463 // Arguments: value - reset or activate
466 //-----------------------------------------------------------------------
467 static void card_reset_dsp (struct ft1000_device
*ft1000dev
, bool value
)
469 u16 status
= STATUS_SUCCESS
;
472 status
= ft1000_write_register (ft1000dev
, HOST_INTF_BE
, FT1000_REG_SUP_CTRL
);
473 status
= ft1000_read_register(ft1000dev
, &tempword
, FT1000_REG_SUP_CTRL
);
476 DEBUG("Reset DSP\n");
477 status
= ft1000_read_register(ft1000dev
, &tempword
, FT1000_REG_RESET
);
478 tempword
|= DSP_RESET_BIT
;
479 status
= ft1000_write_register(ft1000dev
, tempword
, FT1000_REG_RESET
);
483 DEBUG("Activate DSP\n");
484 status
= ft1000_read_register(ft1000dev
, &tempword
, FT1000_REG_RESET
);
485 tempword
|= DSP_ENCRYPTED
;
486 tempword
&= ~DSP_UNENCRYPTED
;
487 status
= ft1000_write_register(ft1000dev
, tempword
, FT1000_REG_RESET
);
488 status
= ft1000_read_register(ft1000dev
, &tempword
, FT1000_REG_RESET
);
489 tempword
&= ~EFUSE_MEM_DISABLE
;
490 tempword
&= ~DSP_RESET_BIT
;
491 status
= ft1000_write_register(ft1000dev
, tempword
, FT1000_REG_RESET
);
492 status
= ft1000_read_register(ft1000dev
, &tempword
, FT1000_REG_RESET
);
496 //---------------------------------------------------------------------------
497 // Function: CardSendCommand
499 // Parameters: ft1000_device - device structure
500 // ptempbuffer - command buffer
501 // size - command buffer size
503 // Returns: STATUS_SUCCESS - success
504 // STATUS_FAILURE - failure
506 // Description: This function sends a command to ASIC
510 //---------------------------------------------------------------------------
511 void CardSendCommand(struct ft1000_device
*ft1000dev
, void *ptempbuffer
, int size
)
514 unsigned char *commandbuf
;
516 DEBUG("CardSendCommand: enter CardSendCommand... size=%d\n", size
);
518 commandbuf
=(unsigned char*) kmalloc(size
+2, GFP_KERNEL
);
519 memcpy((void*)commandbuf
+2, (void*)ptempbuffer
, size
);
521 //DEBUG("CardSendCommand: Command Send\n");
523 ft1000_read_register(ft1000dev
, &temp
, FT1000_REG_DOORBELL
);
530 // check for odd word
534 // Must force to be 32 bit aligned
535 size
+= 4 - (size
% 4);
539 //DEBUG("CardSendCommand: write dpram ... size=%d\n", size);
540 ft1000_write_dpram32(ft1000dev
, 0,commandbuf
, size
);
542 //DEBUG("CardSendCommand: write into doorbell ...\n");
543 ft1000_write_register(ft1000dev
, FT1000_DB_DPRAM_TX
,FT1000_REG_DOORBELL
) ;
546 ft1000_read_register(ft1000dev
, &temp
, FT1000_REG_DOORBELL
);
547 //DEBUG("CardSendCommand: read doorbell ...temp=%x\n", temp);
548 if ( (temp
& 0x0100) == 0)
550 //DEBUG("CardSendCommand: Message sent\n");
556 //--------------------------------------------------------------------------
558 // Function: dsp_reload
560 // Synopsis: This function is called to load or reload the DSP
562 // Arguments: ft1000dev - device structure
565 //-----------------------------------------------------------------------
566 int dsp_reload(struct ft1000_device
*ft1000dev
)
572 struct ft1000_info
*pft1000info
;
574 pft1000info
= netdev_priv(ft1000dev
->net
);
576 pft1000info
->CardReady
= 0;
578 // Program Interrupt Mask register
579 status
= ft1000_write_register (ft1000dev
, 0xffff, FT1000_REG_SUP_IMASK
);
581 status
= ft1000_read_register (ft1000dev
, &tempword
, FT1000_REG_RESET
);
582 tempword
|= ASIC_RESET_BIT
;
583 status
= ft1000_write_register (ft1000dev
, tempword
, FT1000_REG_RESET
);
585 status
= ft1000_read_register (ft1000dev
, &tempword
, FT1000_REG_RESET
);
586 DEBUG("Reset Register = 0x%x\n", tempword
);
589 card_reset_dsp (ft1000dev
, 1);
591 card_reset_dsp (ft1000dev
, 0);
594 status
= ft1000_write_register (ft1000dev
, HOST_INTF_BE
, FT1000_REG_SUP_CTRL
);
596 // Let's check for FEFE
597 status
= ft1000_read_dpram32 (ft1000dev
, FT1000_MAG_DPRAM_FEFE_INDX
, (u8
*)&templong
, 4);
598 DEBUG("templong (fefe) = 0x%8x\n", templong
);
601 status
= scram_dnldr(ft1000dev
, pFileStart
, FileLength
);
603 if (status
!= STATUS_SUCCESS
)
608 DEBUG("dsp_reload returned\n");
613 //---------------------------------------------------------------------------
615 // Function: ft1000_reset_asic
616 // Descripton: This function will call the Card Service function to reset the
619 // dev - device structure
623 //---------------------------------------------------------------------------
624 static void ft1000_reset_asic (struct net_device
*dev
)
626 struct ft1000_info
*info
= netdev_priv(dev
);
627 struct ft1000_device
*ft1000dev
= info
->pFt1000Dev
;
630 DEBUG("ft1000_hw:ft1000_reset_asic called\n");
632 info
->ASICResetNum
++;
634 // Let's use the register provided by the Magnemite ASIC to reset the
636 ft1000_write_register(ft1000dev
, (DSP_RESET_BIT
| ASIC_RESET_BIT
), FT1000_REG_RESET
);
640 // set watermark to -1 in order to not generate an interrrupt
641 ft1000_write_register(ft1000dev
, 0xffff, FT1000_REG_MAG_WATERMARK
);
644 ft1000_read_register (ft1000dev
, &tempword
, FT1000_REG_SUP_ISR
);
645 DEBUG("ft1000_hw: interrupt status register = 0x%x\n",tempword
);
646 ft1000_write_register (ft1000dev
, tempword
, FT1000_REG_SUP_ISR
);
647 ft1000_read_register (ft1000dev
, &tempword
, FT1000_REG_SUP_ISR
);
648 DEBUG("ft1000_hw: interrupt status register = 0x%x\n",tempword
);
653 //---------------------------------------------------------------------------
655 // Function: ft1000_reset_card
656 // Descripton: This function will reset the card
658 // dev - device structure
660 // status - FALSE (card reset fail)
661 // TRUE (card reset successful)
663 //---------------------------------------------------------------------------
664 static int ft1000_reset_card (struct net_device
*dev
)
666 struct ft1000_info
*info
= netdev_priv(dev
);
667 struct ft1000_device
*ft1000dev
= info
->pFt1000Dev
;
669 struct prov_record
*ptr
;
671 DEBUG("ft1000_hw:ft1000_reset_card called.....\n");
673 info
->fCondResetPend
= 1;
675 info
->fProvComplete
= 0;
677 // Make sure we free any memory reserve for provisioning
678 while (list_empty(&info
->prov_list
) == 0) {
679 DEBUG("ft1000_hw:ft1000_reset_card:deleting provisioning record\n");
680 ptr
= list_entry(info
->prov_list
.next
, struct prov_record
, list
);
681 list_del(&ptr
->list
);
682 kfree(ptr
->pprov_data
);
686 DEBUG("ft1000_hw:ft1000_reset_card: reset asic\n");
688 ft1000_reset_asic(dev
);
692 DEBUG("ft1000_hw:ft1000_reset_card: call dsp_reload\n");
693 dsp_reload(ft1000dev
);
695 DEBUG("dsp reload successful\n");
700 // Initialize DSP heartbeat area to ho
701 ft1000_write_dpram16(ft1000dev
, FT1000_MAG_HI_HO
, ho_mag
, FT1000_MAG_HI_HO_INDX
);
702 ft1000_read_dpram16(ft1000dev
, FT1000_MAG_HI_HO
, (u8
*)&tempword
, FT1000_MAG_HI_HO_INDX
);
703 DEBUG("ft1000_hw:ft1000_reset_card:hi_ho value = 0x%x\n", tempword
);
709 info
->fCondResetPend
= 0;
716 #ifdef HAVE_NET_DEVICE_OPS
717 static const struct net_device_ops ftnet_ops
=
719 .ndo_open
= &ft1000_open
,
720 .ndo_stop
= &ft1000_close
,
721 .ndo_start_xmit
= &ft1000_start_xmit
,
722 .ndo_get_stats
= &ft1000_netdev_stats
,
727 //---------------------------------------------------------------------------
728 // Function: init_ft1000_netdev
730 // Parameters: ft1000dev - device structure
733 // Returns: STATUS_SUCCESS - success
734 // STATUS_FAILURE - failure
736 // Description: This function initialize the network device
740 //---------------------------------------------------------------------------
741 u16
init_ft1000_netdev(struct ft1000_device
*ft1000dev
)
743 struct net_device
*netdev
;
744 struct ft1000_info
*pInfo
= NULL
;
745 struct dpram_blk
*pdpram_blk
;
747 struct list_head
*cur
, *tmp
;
749 unsigned long gCardIndex
= 0;
751 DEBUG("Enter init_ft1000_netdev...\n");
754 netdev
= alloc_etherdev(sizeof(struct ft1000_info
));
757 DEBUG("init_ft1000_netdev: can not allocate network device\n");
761 pInfo
= netdev_priv(netdev
);
763 //DEBUG("init_ft1000_netdev: gFt1000Info=%x, netdev=%x, ft1000dev=%x\n", gFt1000Info, netdev, ft1000dev);
765 memset(pInfo
, 0, sizeof(struct ft1000_info
));
767 dev_alloc_name(netdev
, netdev
->name
);
769 DEBUG("init_ft1000_netdev: network device name is %s\n", netdev
->name
);
771 if ( strncmp(netdev
->name
,"eth", 3) == 0) {
772 card_nr
[0] = netdev
->name
[3];
774 ret_val
= strict_strtoul(card_nr
, 10, &gCardIndex
);
776 printk(KERN_ERR
"Can't parse netdev\n");
780 pInfo
->CardNumber
= gCardIndex
;
781 DEBUG("card number = %d\n", pInfo
->CardNumber
);
784 printk(KERN_ERR
"ft1000: Invalid device name\n");
789 memset(&pInfo
->stats
, 0, sizeof(struct net_device_stats
) );
791 spin_lock_init(&pInfo
->dpram_lock
);
792 pInfo
->pFt1000Dev
= ft1000dev
;
793 pInfo
->DrvErrNum
= 0;
794 pInfo
->ASICResetNum
= 0;
795 pInfo
->registered
= 1;
796 pInfo
->ft1000_reset
= ft1000_reset
;
797 pInfo
->mediastate
= 0;
799 pInfo
->DeviceCreated
= FALSE
;
800 pInfo
->CurrentInterruptEnableMask
= ISR_DEFAULT_MASK
;
801 pInfo
->InterruptsEnabled
= FALSE
;
802 pInfo
->CardReady
= 0;
803 pInfo
->DSP_TIME
[0] = 0;
804 pInfo
->DSP_TIME
[1] = 0;
805 pInfo
->DSP_TIME
[2] = 0;
806 pInfo
->DSP_TIME
[3] = 0;
807 pInfo
->fAppMsgPend
= 0;
808 pInfo
->fCondResetPend
= 0;
811 memset(&pInfo
->tempbuf
[0], 0, sizeof(pInfo
->tempbuf
));
813 INIT_LIST_HEAD(&pInfo
->prov_list
);
815 INIT_LIST_HEAD(&pInfo
->nodes
.list
);
817 #ifdef HAVE_NET_DEVICE_OPS
818 netdev
->netdev_ops
= &ftnet_ops
;
820 netdev
->hard_start_xmit
= &ft1000_start_xmit
;
821 netdev
->get_stats
= &ft1000_netdev_stats
;
822 netdev
->open
= &ft1000_open
;
823 netdev
->stop
= &ft1000_close
;
826 ft1000dev
->net
= netdev
;
830 //init free_buff_lock, freercvpool, numofmsgbuf, pdpram_blk
831 //only init once per card
833 DEBUG("Initialize free_buff_lock and freercvpool\n");
834 spin_lock_init(&free_buff_lock
);
836 // initialize a list of buffers to be use for queuing up receive command data
837 INIT_LIST_HEAD (&freercvpool
);
839 // create list of free buffers
840 for (i
=0; i
<NUM_OF_FREE_BUFFERS
; i
++) {
841 // Get memory for DPRAM_DATA link list
842 pdpram_blk
= kmalloc(sizeof(struct dpram_blk
), GFP_KERNEL
);
843 if (pdpram_blk
== NULL
) {
847 // Get a block of memory to store command data
848 pdpram_blk
->pbuffer
= kmalloc ( MAX_CMD_SQSIZE
, GFP_KERNEL
);
849 if (pdpram_blk
->pbuffer
== NULL
) {
854 // link provisioning data
855 list_add_tail (&pdpram_blk
->list
, &freercvpool
);
857 numofmsgbuf
= NUM_OF_FREE_BUFFERS
;
864 list_for_each_safe(cur
, tmp
, &freercvpool
) {
865 pdpram_blk
= list_entry(cur
, struct dpram_blk
, list
);
866 list_del(&pdpram_blk
->list
);
867 kfree(pdpram_blk
->pbuffer
);
877 //---------------------------------------------------------------------------
878 // Function: reg_ft1000_netdev
880 // Parameters: ft1000dev - device structure
883 // Returns: STATUS_SUCCESS - success
884 // STATUS_FAILURE - failure
886 // Description: This function register the network driver
890 //---------------------------------------------------------------------------
891 int reg_ft1000_netdev(struct ft1000_device
*ft1000dev
, struct usb_interface
*intf
)
893 struct net_device
*netdev
;
894 struct ft1000_info
*pInfo
;
897 netdev
= ft1000dev
->net
;
898 pInfo
= netdev_priv(ft1000dev
->net
);
899 DEBUG("Enter reg_ft1000_netdev...\n");
902 ft1000_read_register(ft1000dev
, &pInfo
->AsicID
, FT1000_REG_ASIC_ID
);
904 usb_set_intfdata(intf
, pInfo
);
905 SET_NETDEV_DEV(netdev
, &intf
->dev
);
907 rc
= register_netdev(netdev
);
910 DEBUG("reg_ft1000_netdev: could not register network device\n");
916 //Create character device, implemented by Jim
917 ft1000_create_dev(ft1000dev
);
919 DEBUG ("reg_ft1000_netdev returned\n");
921 pInfo
->CardReady
= 1;
927 static int ft1000_reset(struct net_device
*dev
)
929 ft1000_reset_card(dev
);
933 //---------------------------------------------------------------------------
934 // Function: ft1000_usb_transmit_complete
936 // Parameters: urb - transmitted usb urb
941 // Description: This is the callback function when a urb is transmitted
945 //---------------------------------------------------------------------------
946 static void ft1000_usb_transmit_complete(struct urb
*urb
)
949 struct ft1000_device
*ft1000dev
= urb
->context
;
951 //DEBUG("ft1000_usb_transmit_complete entered\n");
954 printk("%s: TX status %d\n", ft1000dev
->net
->name
, urb
->status
);
956 netif_wake_queue(ft1000dev
->net
);
958 //DEBUG("Return from ft1000_usb_transmit_complete\n");
961 //---------------------------------------------------------------------------
963 // Function: ft1000_copy_down_pkt
964 // Descripton: This function will take an ethernet packet and convert it to
965 // a Flarion packet prior to sending it to the ASIC Downlink
968 // dev - device structure
969 // packet - address of ethernet packet
970 // len - length of IP packet
975 //---------------------------------------------------------------------------
976 static int ft1000_copy_down_pkt (struct net_device
*netdev
, u8
*packet
, u16 len
)
978 struct ft1000_info
*pInfo
= netdev_priv(netdev
);
979 struct ft1000_device
*pFt1000Dev
= pInfo
->pFt1000Dev
;
984 struct pseudo_hdr hdr
;
986 if (!pInfo
->CardReady
)
989 DEBUG("ft1000_copy_down_pkt::Card Not Ready\n");
995 //DEBUG("ft1000_copy_down_pkt() entered, len = %d\n", len);
997 count
= sizeof(struct pseudo_hdr
) + len
;
998 if(count
> MAX_BUF_SIZE
)
1000 DEBUG("Error:ft1000_copy_down_pkt:Message Size Overflow!\n");
1001 DEBUG("size = %d\n", count
);
1006 count
= count
+ (4- (count
%4) );
1008 memset(&hdr
, 0, sizeof(struct pseudo_hdr
));
1010 hdr
.length
= ntohs(count
);
1012 hdr
.destination
= 0x20;
1013 hdr
.portdest
= 0x20;
1015 hdr
.sh_str_id
= 0x91;
1018 hdr
.checksum
= hdr
.length
^ hdr
.source
^ hdr
.destination
^
1019 hdr
.portdest
^ hdr
.portsrc
^ hdr
.sh_str_id
^
1022 memcpy(&pFt1000Dev
->tx_buf
[0], &hdr
, sizeof(hdr
));
1023 memcpy(&(pFt1000Dev
->tx_buf
[sizeof(struct pseudo_hdr
)]), packet
, len
);
1025 netif_stop_queue(netdev
);
1027 //DEBUG ("ft1000_copy_down_pkt: count = %d\n", count);
1029 usb_fill_bulk_urb(pFt1000Dev
->tx_urb
,
1031 usb_sndbulkpipe(pFt1000Dev
->dev
, pFt1000Dev
->bulk_out_endpointAddr
),
1034 ft1000_usb_transmit_complete
,
1037 t
= (u8
*)pFt1000Dev
->tx_urb
->transfer_buffer
;
1038 //DEBUG("transfer_length=%d\n", pFt1000Dev->tx_urb->transfer_buffer_length);
1039 /*for (i=0; i<count; i++ )
1041 DEBUG("%x ", *t++ );
1045 ret
= usb_submit_urb(pFt1000Dev
->tx_urb
, GFP_ATOMIC
);
1047 DEBUG("ft1000 failed tx_urb %d\n", ret
);
1050 pInfo
->stats
.tx_packets
++;
1051 pInfo
->stats
.tx_bytes
+= (len
+14);
1054 //DEBUG("ft1000_copy_down_pkt() exit\n");
1059 //---------------------------------------------------------------------------
1060 // Function: ft1000_start_xmit
1062 // Parameters: skb - socket buffer to be sent
1063 // dev - network device
1068 // Description: transmit a ethernet packet
1072 //---------------------------------------------------------------------------
1073 static int ft1000_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
1075 struct ft1000_info
*pInfo
= netdev_priv(dev
);
1076 struct ft1000_device
*pFt1000Dev
= pInfo
->pFt1000Dev
;
1081 //DEBUG(" ft1000_start_xmit() entered\n");
1085 DEBUG ("ft1000_hw: ft1000_start_xmit:skb == NULL!!!\n" );
1086 return NETDEV_TX_OK
;
1089 if ( pFt1000Dev
->status
& FT1000_STATUS_CLOSING
)
1091 DEBUG("network driver is closed, return\n");
1095 //DEBUG("ft1000_start_xmit 1:length of packet = %d\n", skb->len);
1096 pipe
= usb_sndbulkpipe(pFt1000Dev
->dev
, pFt1000Dev
->bulk_out_endpointAddr
);
1097 maxlen
= usb_maxpacket(pFt1000Dev
->dev
, pipe
, usb_pipeout(pipe
));
1098 //DEBUG("ft1000_start_xmit 2: pipe=%d dev->maxpacket = %d\n", pipe, maxlen);
1100 pdata
= (u8
*)skb
->data
;
1101 /*for (i=0; i<skb->len; i++)
1102 DEBUG("skb->data[%d]=%x ", i, *(skb->data+i));
1107 if (pInfo
->mediastate
== 0)
1109 /* Drop packet is mediastate is down */
1110 DEBUG("ft1000_hw:ft1000_start_xmit:mediastate is down\n");
1114 if ( (skb
->len
< ENET_HEADER_SIZE
) || (skb
->len
> ENET_MAX_SIZE
) )
1116 /* Drop packet which has invalid size */
1117 DEBUG("ft1000_hw:ft1000_start_xmit:invalid ethernet length\n");
1121 ft1000_copy_down_pkt(dev
, (pdata
+ENET_HEADER_SIZE
-2),
1122 skb
->len
- ENET_HEADER_SIZE
+ 2);
1126 //DEBUG(" ft1000_start_xmit() exit\n");
1128 return NETDEV_TX_OK
;
1131 //---------------------------------------------------------------------------
1133 // Function: ft1000_copy_up_pkt
1134 // Descripton: This function will take a packet from the FIFO up link and
1135 // convert it into an ethernet packet and deliver it to the IP stack
1137 // urb - the receving usb urb
1143 //---------------------------------------------------------------------------
1144 static int ft1000_copy_up_pkt (struct urb
*urb
)
1146 struct ft1000_info
*info
= urb
->context
;
1147 struct ft1000_device
*ft1000dev
= info
->pFt1000Dev
;
1148 struct net_device
*net
= ft1000dev
->net
;
1153 struct sk_buff
*skb
;
1160 //DEBUG("ft1000_copy_up_pkt entered\n");
1162 if ( ft1000dev
->status
& FT1000_STATUS_CLOSING
)
1164 DEBUG("network driver is closed, return\n");
1165 return STATUS_SUCCESS
;
1169 len
= urb
->transfer_buffer_length
;
1170 lena
= urb
->actual_length
; //mbelian
1171 //DEBUG("ft1000_copy_up_pkt: transfer_buffer_length=%d, actual_buffer_len=%d\n",
1172 // urb->transfer_buffer_length, urb->actual_length);
1174 chksum
= (u16
*)ft1000dev
->rx_buf
;
1176 tempword
= *chksum
++;
1179 tempword
^= *chksum
++;
1182 if (tempword
!= *chksum
)
1184 info
->stats
.rx_errors
++;
1185 ft1000_submit_rx_urb(info
);
1186 return STATUS_FAILURE
;
1190 //DEBUG("ft1000_copy_up_pkt: checksum is correct %x\n", *chksum);
1192 skb
= dev_alloc_skb(len
+12+2);
1196 DEBUG("ft1000_copy_up_pkt: No Network buffers available\n");
1197 info
->stats
.rx_errors
++;
1198 ft1000_submit_rx_urb(info
);
1199 return STATUS_FAILURE
;
1202 pbuffer
= (u8
*)skb_put(skb
, len
+12);
1204 //subtract the number of bytes read already
1208 *pbuffer
++ = net
->dev_addr
[0];
1209 *pbuffer
++ = net
->dev_addr
[1];
1210 *pbuffer
++ = net
->dev_addr
[2];
1211 *pbuffer
++ = net
->dev_addr
[3];
1212 *pbuffer
++ = net
->dev_addr
[4];
1213 *pbuffer
++ = net
->dev_addr
[5];
1224 memcpy(pbuffer
, ft1000dev
->rx_buf
+sizeof(struct pseudo_hdr
), len
-sizeof(struct pseudo_hdr
));
1226 //DEBUG("ft1000_copy_up_pkt: Data passed to Protocol layer\n");
1227 /*for (i=0; i<len+12; i++)
1229 DEBUG("ft1000_copy_up_pkt: Protocol Data: 0x%x\n ", *ptemp++);
1234 skb
->protocol
= eth_type_trans(skb
, net
);
1235 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
1238 info
->stats
.rx_packets
++;
1239 // Add on 12 bytes for MAC address which was removed
1240 info
->stats
.rx_bytes
+= (lena
+12); //mbelian
1242 ft1000_submit_rx_urb(info
);
1243 //DEBUG("ft1000_copy_up_pkt exited\n");
1247 //---------------------------------------------------------------------------
1249 // Function: ft1000_submit_rx_urb
1250 // Descripton: the receiving function of the network driver
1253 // info - a private structure contains the device information
1259 //---------------------------------------------------------------------------
1260 static int ft1000_submit_rx_urb(struct ft1000_info
*info
)
1263 struct ft1000_device
*pFt1000Dev
= info
->pFt1000Dev
;
1266 //DEBUG ("ft1000_submit_rx_urb entered: sizeof rx_urb is %d\n", sizeof(*pFt1000Dev->rx_urb));
1267 if ( pFt1000Dev
->status
& FT1000_STATUS_CLOSING
)
1269 DEBUG("network driver is closed, return\n");
1270 //usb_kill_urb(pFt1000Dev->rx_urb); //mbelian
1274 usb_fill_bulk_urb(pFt1000Dev
->rx_urb
,
1276 usb_rcvbulkpipe(pFt1000Dev
->dev
, pFt1000Dev
->bulk_in_endpointAddr
),
1279 (usb_complete_t
)ft1000_copy_up_pkt
,
1283 if((result
= usb_submit_urb(pFt1000Dev
->rx_urb
, GFP_ATOMIC
)))
1285 printk("ft1000_submit_rx_urb: submitting rx_urb %d failed\n", result
);
1289 //DEBUG("ft1000_submit_rx_urb exit: result=%d\n", result);
1294 //---------------------------------------------------------------------------
1295 // Function: ft1000_open
1298 // dev - network device
1303 // Description: open the network driver
1307 //---------------------------------------------------------------------------
1308 static int ft1000_open (struct net_device
*dev
)
1310 struct ft1000_info
*pInfo
= netdev_priv(dev
);
1311 struct timeval tv
; //mbelian
1314 DEBUG("ft1000_open is called for card %d\n", pInfo
->CardNumber
);
1315 //DEBUG("ft1000_open: dev->addr=%x, dev->addr_len=%d\n", dev->addr, dev->addr_len);
1317 pInfo
->stats
.rx_bytes
= 0; //mbelian
1318 pInfo
->stats
.tx_bytes
= 0; //mbelian
1319 pInfo
->stats
.rx_packets
= 0; //mbelian
1320 pInfo
->stats
.tx_packets
= 0; //mbelian
1321 do_gettimeofday(&tv
);
1322 pInfo
->ConTm
= tv
.tv_sec
;
1323 pInfo
->ProgConStat
= 0; //mbelian
1326 netif_start_queue(dev
);
1328 netif_carrier_on(dev
); //mbelian
1330 ret
= ft1000_submit_rx_urb(pInfo
);
1335 //---------------------------------------------------------------------------
1336 // Function: ft1000_close
1339 // net - network device
1344 // Description: close the network driver
1348 //---------------------------------------------------------------------------
1349 int ft1000_close(struct net_device
*net
)
1351 struct ft1000_info
*pInfo
= netdev_priv(net
);
1352 struct ft1000_device
*ft1000dev
= pInfo
->pFt1000Dev
;
1354 //DEBUG ("ft1000_close: netdev->refcnt=%d\n", net->refcnt);
1356 ft1000dev
->status
|= FT1000_STATUS_CLOSING
;
1358 //DEBUG("ft1000_close: calling usb_kill_urb \n");
1360 DEBUG("ft1000_close: pInfo=%p, ft1000dev=%p\n", pInfo
, ft1000dev
);
1361 netif_carrier_off(net
);//mbelian
1362 netif_stop_queue(net
);
1363 //DEBUG("ft1000_close: netif_stop_queue called\n");
1364 ft1000dev
->status
&= ~FT1000_STATUS_CLOSING
;
1366 pInfo
->ProgConStat
= 0xff; //mbelian
1372 static struct net_device_stats
*ft1000_netdev_stats(struct net_device
*dev
)
1374 struct ft1000_info
*info
= netdev_priv(dev
);
1376 return &(info
->stats
); //mbelian
1380 /*********************************************************************************
1385 //---------------------------------------------------------------------------
1387 // Function: ft1000_chkcard
1388 // Descripton: This function will check if the device is presently available on
1391 // dev - device structure
1393 // status - FALSE (device is not present)
1394 // TRUE (device is present)
1396 //---------------------------------------------------------------------------
1397 static int ft1000_chkcard (struct ft1000_device
*dev
) {
1400 struct ft1000_info
*info
= netdev_priv(dev
->net
);
1402 if (info
->fCondResetPend
)
1404 DEBUG("ft1000_hw:ft1000_chkcard:Card is being reset, return FALSE\n");
1408 // Mask register is used to check for device presence since it is never
1410 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_SUP_IMASK
);
1411 //DEBUG("ft1000_hw:ft1000_chkcard: read FT1000_REG_SUP_IMASK = %x\n", tempword);
1412 if (tempword
== 0) {
1413 DEBUG("ft1000_hw:ft1000_chkcard: IMASK = 0 Card not detected\n");
1417 // The system will return the value of 0xffff for the version register
1418 // if the device is not present.
1419 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_ASIC_ID
);
1420 //DEBUG("ft1000_hw:ft1000_chkcard: read FT1000_REG_ASIC_ID = %x\n", tempword);
1421 if (tempword
!= 0x1b01 ){
1422 dev
->status
|= FT1000_STATUS_CLOSING
; //mbelian
1423 DEBUG("ft1000_hw:ft1000_chkcard: Version = 0xffff Card not detected\n");
1431 //---------------------------------------------------------------------------
1433 // Function: ft1000_receive_cmd
1434 // Descripton: This function will read a message from the dpram area.
1436 // dev - network device structure
1437 // pbuffer - caller supply address to buffer
1438 // pnxtph - pointer to next pseudo header
1440 // Status = 0 (unsuccessful)
1443 //---------------------------------------------------------------------------
1444 static bool ft1000_receive_cmd (struct ft1000_device
*dev
, u16
*pbuffer
, int maxsz
, u16
*pnxtph
) {
1450 ret
= ft1000_read_dpram16(dev
, FT1000_MAG_PH_LEN
, (u8
*)&size
, FT1000_MAG_PH_LEN_INDX
);
1451 size
= ntohs(size
) + PSEUDOSZ
;
1453 DEBUG("FT1000:ft1000_receive_cmd:Invalid command length = %d\n", size
);
1457 ppseudohdr
= (u16
*)pbuffer
;
1458 ft1000_write_register(dev
, FT1000_DPRAM_MAG_RX_BASE
, FT1000_REG_DPRAM_ADDR
);
1459 ret
= ft1000_read_register(dev
, pbuffer
, FT1000_REG_MAG_DPDATAH
);
1460 //DEBUG("ft1000_hw:received data = 0x%x\n", *pbuffer);
1462 ft1000_write_register(dev
, FT1000_DPRAM_MAG_RX_BASE
+1, FT1000_REG_DPRAM_ADDR
);
1463 for (i
=0; i
<=(size
>>2); i
++) {
1464 ret
= ft1000_read_register(dev
, pbuffer
, FT1000_REG_MAG_DPDATAL
);
1466 ret
= ft1000_read_register(dev
, pbuffer
, FT1000_REG_MAG_DPDATAH
);
1469 //copy odd aligned word
1470 ret
= ft1000_read_register(dev
, pbuffer
, FT1000_REG_MAG_DPDATAL
);
1471 //DEBUG("ft1000_hw:received data = 0x%x\n", *pbuffer);
1473 ret
= ft1000_read_register(dev
, pbuffer
, FT1000_REG_MAG_DPDATAH
);
1474 //DEBUG("ft1000_hw:received data = 0x%x\n", *pbuffer);
1476 if (size
& 0x0001) {
1477 //copy odd byte from fifo
1478 ret
= ft1000_read_register(dev
, &tempword
, FT1000_REG_DPRAM_DATA
);
1479 *pbuffer
= ntohs(tempword
);
1482 // Check if pseudo header checksum is good
1483 // Calculate pseudo header checksum
1484 tempword
= *ppseudohdr
++;
1485 for (i
=1; i
<7; i
++) {
1486 tempword
^= *ppseudohdr
++;
1488 if ( (tempword
!= *ppseudohdr
) ) {
1497 static int ft1000_dsp_prov(void *arg
)
1499 struct ft1000_device
*dev
= (struct ft1000_device
*)arg
;
1500 struct ft1000_info
*info
= netdev_priv(dev
->net
);
1504 struct prov_record
*ptr
;
1505 struct pseudo_hdr
*ppseudo_hdr
;
1508 u16 TempShortBuf
[256];
1510 DEBUG("*** DspProv Entered\n");
1512 while (list_empty(&info
->prov_list
) == 0)
1514 DEBUG("DSP Provisioning List Entry\n");
1516 // Check if doorbell is available
1517 DEBUG("check if doorbell is cleared\n");
1518 status
= ft1000_read_register (dev
, &tempword
, FT1000_REG_DOORBELL
);
1521 DEBUG("ft1000_dsp_prov::ft1000_read_register error\n");
1525 while (tempword
& FT1000_DB_DPRAM_TX
) {
1529 DEBUG("FT1000:ft1000_dsp_prov:message drop\n");
1530 return STATUS_FAILURE
;
1532 ft1000_read_register(dev
, &tempword
, FT1000_REG_DOORBELL
);
1535 if ( !(tempword
& FT1000_DB_DPRAM_TX
) ) {
1536 DEBUG("*** Provision Data Sent to DSP\n");
1538 // Send provisioning data
1539 ptr
= list_entry(info
->prov_list
.next
, struct prov_record
, list
);
1540 len
= *(u16
*)ptr
->pprov_data
;
1544 pmsg
= (u16
*)ptr
->pprov_data
;
1545 ppseudo_hdr
= (struct pseudo_hdr
*)pmsg
;
1546 // Insert slow queue sequence number
1547 ppseudo_hdr
->seq_num
= info
->squeseqnum
++;
1548 ppseudo_hdr
->portsrc
= 0;
1549 // Calculate new checksum
1550 ppseudo_hdr
->checksum
= *pmsg
++;
1551 //DEBUG("checksum = 0x%x\n", ppseudo_hdr->checksum);
1552 for (i
=1; i
<7; i
++) {
1553 ppseudo_hdr
->checksum
^= *pmsg
++;
1554 //DEBUG("checksum = 0x%x\n", ppseudo_hdr->checksum);
1557 TempShortBuf
[0] = 0;
1558 TempShortBuf
[1] = htons (len
);
1559 memcpy(&TempShortBuf
[2], ppseudo_hdr
, len
);
1561 status
= ft1000_write_dpram32 (dev
, 0, (u8
*)&TempShortBuf
[0], (unsigned short)(len
+2));
1562 status
= ft1000_write_register (dev
, FT1000_DB_DPRAM_TX
, FT1000_REG_DOORBELL
);
1564 list_del(&ptr
->list
);
1565 kfree(ptr
->pprov_data
);
1571 DEBUG("DSP Provisioning List Entry finished\n");
1575 info
->fProvComplete
= 1;
1576 info
->CardReady
= 1;
1577 return STATUS_SUCCESS
;
1582 static int ft1000_proc_drvmsg (struct ft1000_device
*dev
, u16 size
) {
1583 struct ft1000_info
*info
= netdev_priv(dev
->net
);
1586 struct media_msg
*pmediamsg
;
1587 struct dsp_init_msg
*pdspinitmsg
;
1588 struct drv_msg
*pdrvmsg
;
1590 struct pseudo_hdr
*ppseudo_hdr
;
1599 char *cmdbuffer
= kmalloc(1600, GFP_KERNEL
);
1601 return STATUS_FAILURE
;
1603 status
= ft1000_read_dpram32(dev
, 0x200, cmdbuffer
, size
);
1608 DEBUG("ft1000_proc_drvmsg:cmdbuffer\n");
1609 for(i
= 0; i
< size
; i
+=5)
1611 if( (i
+ 5) < size
)
1612 DEBUG("0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", cmdbuffer
[i
], cmdbuffer
[i
+1], cmdbuffer
[i
+2], cmdbuffer
[i
+3], cmdbuffer
[i
+4]);
1615 for (j
= i
; j
< size
; j
++)
1616 DEBUG("0x%x ", cmdbuffer
[j
]);
1622 pdrvmsg
= (struct drv_msg
*)&cmdbuffer
[2];
1623 msgtype
= ntohs(pdrvmsg
->type
);
1624 DEBUG("ft1000_proc_drvmsg:Command message type = 0x%x\n", msgtype
);
1627 DEBUG("ft1000_proc_drvmsg:Command message type = MEDIA_STATE");
1629 pmediamsg
= (struct media_msg
*)&cmdbuffer
[0];
1630 if (info
->ProgConStat
!= 0xFF) {
1631 if (pmediamsg
->state
) {
1632 DEBUG("Media is up\n");
1633 if (info
->mediastate
== 0) {
1634 if ( info
->NetDevRegDone
)
1636 //netif_carrier_on(dev->net);//mbelian
1637 netif_wake_queue(dev
->net
);
1639 info
->mediastate
= 1;
1640 /*do_gettimeofday(&tv);
1641 info->ConTm = tv.tv_sec;*/ //mbelian
1645 DEBUG("Media is down\n");
1646 if (info
->mediastate
== 1) {
1647 info
->mediastate
= 0;
1648 if ( info
->NetDevRegDone
)
1650 //netif_carrier_off(dev->net); mbelian
1651 //netif_stop_queue(dev->net);
1658 DEBUG("Media is down\n");
1659 if (info
->mediastate
== 1) {
1660 info
->mediastate
= 0;
1661 if ( info
->NetDevRegDone
)
1663 //netif_carrier_off(dev->net); //mbelian
1664 //netif_stop_queue(dev->net);
1671 case DSP_INIT_MSG
: {
1672 DEBUG("ft1000_proc_drvmsg:Command message type = DSP_INIT_MSG");
1674 pdspinitmsg
= (struct dsp_init_msg
*)&cmdbuffer
[2];
1675 memcpy(info
->DspVer
, pdspinitmsg
->DspVer
, DSPVERSZ
);
1676 DEBUG("DSPVER = 0x%2x 0x%2x 0x%2x 0x%2x\n", info
->DspVer
[0], info
->DspVer
[1], info
->DspVer
[2], info
->DspVer
[3]);
1677 memcpy(info
->HwSerNum
, pdspinitmsg
->HwSerNum
, HWSERNUMSZ
);
1678 memcpy(info
->Sku
, pdspinitmsg
->Sku
, SKUSZ
);
1679 memcpy(info
->eui64
, pdspinitmsg
->eui64
, EUISZ
);
1680 DEBUG("EUI64=%2x.%2x.%2x.%2x.%2x.%2x.%2x.%2x\n", info
->eui64
[0],info
->eui64
[1], info
->eui64
[2], info
->eui64
[3], info
->eui64
[4], info
->eui64
[5],info
->eui64
[6], info
->eui64
[7]);
1681 dev
->net
->dev_addr
[0] = info
->eui64
[0];
1682 dev
->net
->dev_addr
[1] = info
->eui64
[1];
1683 dev
->net
->dev_addr
[2] = info
->eui64
[2];
1684 dev
->net
->dev_addr
[3] = info
->eui64
[5];
1685 dev
->net
->dev_addr
[4] = info
->eui64
[6];
1686 dev
->net
->dev_addr
[5] = info
->eui64
[7];
1688 if (ntohs(pdspinitmsg
->length
) == (sizeof(struct dsp_init_msg
) - 20)) {
1689 memcpy(info
->ProductMode
, pdspinitmsg
->ProductMode
, MODESZ
);
1690 memcpy(info
->RfCalVer
, pdspinitmsg
->RfCalVer
, CALVERSZ
);
1691 memcpy(info
->RfCalDate
, pdspinitmsg
->RfCalDate
, CALDATESZ
);
1692 DEBUG("RFCalVer = 0x%2x 0x%2x\n", info
->RfCalVer
[0], info
->RfCalVer
[1]);
1696 case DSP_PROVISION
: {
1697 DEBUG("ft1000_proc_drvmsg:Command message type = DSP_PROVISION\n");
1699 // kick off dspprov routine to start provisioning
1700 // Send provisioning data to DSP
1701 if (list_empty(&info
->prov_list
) == 0)
1703 info
->fProvComplete
= 0;
1704 status
= ft1000_dsp_prov(dev
);
1705 if (status
!= STATUS_SUCCESS
)
1709 info
->fProvComplete
= 1;
1710 status
= ft1000_write_register (dev
, FT1000_DB_HB
, FT1000_REG_DOORBELL
);
1711 DEBUG("FT1000:drivermsg:No more DSP provisioning data in dsp image\n");
1713 DEBUG("ft1000_proc_drvmsg:DSP PROVISION is done\n");
1716 case DSP_STORE_INFO
: {
1717 DEBUG("ft1000_proc_drvmsg:Command message type = DSP_STORE_INFO");
1719 DEBUG("FT1000:drivermsg:Got DSP_STORE_INFO\n");
1720 tempword
= ntohs(pdrvmsg
->length
);
1721 info
->DSPInfoBlklen
= tempword
;
1722 if (tempword
< (MAX_DSP_SESS_REC
-4) ) {
1723 pmsg
= (u16
*)&pdrvmsg
->data
[0];
1724 for (i
=0; i
<((tempword
+1)/2); i
++) {
1725 DEBUG("FT1000:drivermsg:dsp info data = 0x%x\n", *pmsg
);
1726 info
->DSPInfoBlk
[i
+10] = *pmsg
++;
1730 info
->DSPInfoBlklen
= 0;
1734 case DSP_GET_INFO
: {
1735 DEBUG("FT1000:drivermsg:Got DSP_GET_INFO\n");
1736 // copy dsp info block to dsp
1737 info
->DrvMsgPend
= 1;
1738 // allow any outstanding ioctl to finish
1740 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_DOORBELL
);
1741 if (tempword
& FT1000_DB_DPRAM_TX
) {
1743 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_DOORBELL
);
1744 if (tempword
& FT1000_DB_DPRAM_TX
) {
1746 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_DOORBELL
);
1747 if (tempword
& FT1000_DB_DPRAM_TX
) {
1753 // Put message into Slow Queue
1754 // Form Pseudo header
1755 pmsg
= (u16
*)info
->DSPInfoBlk
;
1757 *pmsg
++ = htons(info
->DSPInfoBlklen
+20+info
->DSPInfoBlklen
);
1758 ppseudo_hdr
= (struct pseudo_hdr
*)(u16
*)&info
->DSPInfoBlk
[2];
1759 ppseudo_hdr
->length
= htons(info
->DSPInfoBlklen
+4+info
->DSPInfoBlklen
);
1760 ppseudo_hdr
->source
= 0x10;
1761 ppseudo_hdr
->destination
= 0x20;
1762 ppseudo_hdr
->portdest
= 0;
1763 ppseudo_hdr
->portsrc
= 0;
1764 ppseudo_hdr
->sh_str_id
= 0;
1765 ppseudo_hdr
->control
= 0;
1766 ppseudo_hdr
->rsvd1
= 0;
1767 ppseudo_hdr
->rsvd2
= 0;
1768 ppseudo_hdr
->qos_class
= 0;
1769 // Insert slow queue sequence number
1770 ppseudo_hdr
->seq_num
= info
->squeseqnum
++;
1771 // Insert application id
1772 ppseudo_hdr
->portsrc
= 0;
1773 // Calculate new checksum
1774 ppseudo_hdr
->checksum
= *pmsg
++;
1775 for (i
=1; i
<7; i
++) {
1776 ppseudo_hdr
->checksum
^= *pmsg
++;
1778 info
->DSPInfoBlk
[10] = 0x7200;
1779 info
->DSPInfoBlk
[11] = htons(info
->DSPInfoBlklen
);
1780 status
= ft1000_write_dpram32 (dev
, 0, (u8
*)&info
->DSPInfoBlk
[0], (unsigned short)(info
->DSPInfoBlklen
+22));
1781 status
= ft1000_write_register (dev
, FT1000_DB_DPRAM_TX
, FT1000_REG_DOORBELL
);
1782 info
->DrvMsgPend
= 0;
1787 case GET_DRV_ERR_RPT_MSG
: {
1788 DEBUG("FT1000:drivermsg:Got GET_DRV_ERR_RPT_MSG\n");
1789 // copy driver error message to dsp
1790 info
->DrvMsgPend
= 1;
1791 // allow any outstanding ioctl to finish
1793 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_DOORBELL
);
1794 if (tempword
& FT1000_DB_DPRAM_TX
) {
1796 status
= ft1000_read_register(dev
, &tempword
, FT1000_REG_DOORBELL
);
1797 if (tempword
& FT1000_DB_DPRAM_TX
) {
1802 if ( (tempword
& FT1000_DB_DPRAM_TX
) == 0) {
1803 // Put message into Slow Queue
1804 // Form Pseudo header
1805 pmsg
= (u16
*)&tempbuffer
[0];
1806 ppseudo_hdr
= (struct pseudo_hdr
*)pmsg
;
1807 ppseudo_hdr
->length
= htons(0x0012);
1808 ppseudo_hdr
->source
= 0x10;
1809 ppseudo_hdr
->destination
= 0x20;
1810 ppseudo_hdr
->portdest
= 0;
1811 ppseudo_hdr
->portsrc
= 0;
1812 ppseudo_hdr
->sh_str_id
= 0;
1813 ppseudo_hdr
->control
= 0;
1814 ppseudo_hdr
->rsvd1
= 0;
1815 ppseudo_hdr
->rsvd2
= 0;
1816 ppseudo_hdr
->qos_class
= 0;
1817 // Insert slow queue sequence number
1818 ppseudo_hdr
->seq_num
= info
->squeseqnum
++;
1819 // Insert application id
1820 ppseudo_hdr
->portsrc
= 0;
1821 // Calculate new checksum
1822 ppseudo_hdr
->checksum
= *pmsg
++;
1823 for (i
=1; i
<7; i
++) {
1824 ppseudo_hdr
->checksum
^= *pmsg
++;
1826 pmsg
= (u16
*)&tempbuffer
[16];
1827 *pmsg
++ = htons(RSP_DRV_ERR_RPT_MSG
);
1828 *pmsg
++ = htons(0x000e);
1829 *pmsg
++ = htons(info
->DSP_TIME
[0]);
1830 *pmsg
++ = htons(info
->DSP_TIME
[1]);
1831 *pmsg
++ = htons(info
->DSP_TIME
[2]);
1832 *pmsg
++ = htons(info
->DSP_TIME
[3]);
1833 convert
.byte
[0] = info
->DspVer
[0];
1834 convert
.byte
[1] = info
->DspVer
[1];
1835 *pmsg
++ = convert
.wrd
;
1836 convert
.byte
[0] = info
->DspVer
[2];
1837 convert
.byte
[1] = info
->DspVer
[3];
1838 *pmsg
++ = convert
.wrd
;
1839 *pmsg
++ = htons(info
->DrvErrNum
);
1841 CardSendCommand (dev
, (unsigned char*)&tempbuffer
[0], (u16
)(0x0012 + PSEUDOSZ
));
1842 info
->DrvErrNum
= 0;
1844 info
->DrvMsgPend
= 0;
1854 status
= STATUS_SUCCESS
;
1857 DEBUG("return from ft1000_proc_drvmsg\n");
1863 int ft1000_poll(void* dev_id
) {
1865 struct ft1000_device
*dev
= (struct ft1000_device
*)dev_id
;
1866 struct ft1000_info
*info
= netdev_priv(dev
->net
);
1876 struct dpram_blk
*pdpram_blk
;
1877 struct pseudo_hdr
*ppseudo_hdr
;
1878 unsigned long flags
;
1880 //DEBUG("Enter ft1000_poll...\n");
1881 if (ft1000_chkcard(dev
) == FALSE
) {
1882 DEBUG("ft1000_poll::ft1000_chkcard: failed\n");
1883 return STATUS_FAILURE
;
1886 status
= ft1000_read_register (dev
, &tempword
, FT1000_REG_DOORBELL
);
1887 // DEBUG("ft1000_poll: read FT1000_REG_DOORBELL message 0x%x\n", tempword);
1892 if (tempword
& FT1000_DB_DPRAM_RX
) {
1893 //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX\n");
1895 status
= ft1000_read_dpram16(dev
, 0x200, (u8
*)&data
, 0);
1896 //DEBUG("ft1000_poll:FT1000_DB_DPRAM_RX:ft1000_read_dpram16:size = 0x%x\n", data);
1897 size
= ntohs(data
) + 16 + 2; //wai
1899 modulo
= 4 - (size
% 4);
1900 size
= size
+ modulo
;
1902 status
= ft1000_read_dpram16(dev
, 0x201, (u8
*)&portid
, 1);
1904 //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid 0x%x\n", portid);
1906 if (size
< MAX_CMD_SQSIZE
) {
1910 DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid DRIVERID\n");
1912 status
= ft1000_proc_drvmsg (dev
, size
);
1913 if (status
!= STATUS_SUCCESS
)
1917 // This is a dsp broadcast message
1918 // Check which application has registered for dsp broadcast messages
1919 //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid DSPBCMSGID\n");
1921 for (i
=0; i
<MAX_NUM_APP
; i
++) {
1922 if ( (info
->app_info
[i
].DspBCMsgFlag
) && (info
->app_info
[i
].fileobject
) &&
1923 (info
->app_info
[i
].NumOfMsg
< MAX_MSG_LIMIT
) )
1925 //DEBUG("Dsp broadcast message detected for app id %d\n", i);
1926 nxtph
= FT1000_DPRAM_RX_BASE
+ 2;
1927 pdpram_blk
= ft1000_get_buffer (&freercvpool
);
1928 if (pdpram_blk
!= NULL
) {
1929 if ( ft1000_receive_cmd(dev
, pdpram_blk
->pbuffer
, MAX_CMD_SQSIZE
, &nxtph
) ) {
1930 ppseudo_hdr
= (struct pseudo_hdr
*)pdpram_blk
->pbuffer
;
1931 // Put message into the appropriate application block
1932 info
->app_info
[i
].nRxMsg
++;
1933 spin_lock_irqsave(&free_buff_lock
, flags
);
1934 list_add_tail(&pdpram_blk
->list
, &info
->app_info
[i
].app_sqlist
);
1935 info
->app_info
[i
].NumOfMsg
++;
1936 spin_unlock_irqrestore(&free_buff_lock
, flags
);
1937 wake_up_interruptible(&info
->app_info
[i
].wait_dpram_msg
);
1940 info
->app_info
[i
].nRxMsgMiss
++;
1941 // Put memory back to free pool
1942 ft1000_free_buffer(pdpram_blk
, &freercvpool
);
1943 DEBUG("pdpram_blk::ft1000_get_buffer NULL\n");
1947 DEBUG("Out of memory in free receive command pool\n");
1948 info
->app_info
[i
].nRxMsgMiss
++;
1949 }//endof if (pdpram_blk != NULL)
1952 // DEBUG("app_info mismatch\n");
1956 pdpram_blk
= ft1000_get_buffer (&freercvpool
);
1957 //DEBUG("Memory allocated = 0x%8x\n", (u32)pdpram_blk);
1958 if (pdpram_blk
!= NULL
) {
1959 if ( ft1000_receive_cmd(dev
, pdpram_blk
->pbuffer
, MAX_CMD_SQSIZE
, &nxtph
) ) {
1960 ppseudo_hdr
= (struct pseudo_hdr
*)pdpram_blk
->pbuffer
;
1961 // Search for correct application block
1962 for (i
=0; i
<MAX_NUM_APP
; i
++) {
1963 if (info
->app_info
[i
].app_id
== ppseudo_hdr
->portdest
) {
1968 if (i
== MAX_NUM_APP
) {
1969 DEBUG("FT1000:ft1000_parse_dpram_msg: No application matching id = %d\n", ppseudo_hdr
->portdest
);
1970 // Put memory back to free pool
1971 ft1000_free_buffer(pdpram_blk
, &freercvpool
);
1974 if (info
->app_info
[i
].NumOfMsg
> MAX_MSG_LIMIT
) {
1975 // Put memory back to free pool
1976 ft1000_free_buffer(pdpram_blk
, &freercvpool
);
1979 info
->app_info
[i
].nRxMsg
++;
1980 // Put message into the appropriate application block
1981 //pxu spin_lock_irqsave(&free_buff_lock, flags);
1982 list_add_tail(&pdpram_blk
->list
, &info
->app_info
[i
].app_sqlist
);
1983 info
->app_info
[i
].NumOfMsg
++;
1984 //pxu spin_unlock_irqrestore(&free_buff_lock, flags);
1985 //pxu wake_up_interruptible(&info->app_info[i].wait_dpram_msg);
1990 // Put memory back to free pool
1991 ft1000_free_buffer(pdpram_blk
, &freercvpool
);
1995 DEBUG("Out of memory in free receive command pool\n");
1999 } //endof if (size < MAX_CMD_SQSIZE)
2001 DEBUG("FT1000:dpc:Invalid total length for SlowQ = %d\n", size
);
2003 status
= ft1000_write_register (dev
, FT1000_DB_DPRAM_RX
, FT1000_REG_DOORBELL
);
2005 else if (tempword
& FT1000_DSP_ASIC_RESET
) {
2006 //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DSP_ASIC_RESET\n");
2008 // Let's reset the ASIC from the Host side as well
2009 status
= ft1000_write_register (dev
, ASIC_RESET_BIT
, FT1000_REG_RESET
);
2010 status
= ft1000_read_register (dev
, &tempword
, FT1000_REG_RESET
);
2012 while (tempword
& ASIC_RESET_BIT
) {
2013 status
= ft1000_read_register (dev
, &tempword
, FT1000_REG_RESET
);
2020 DEBUG("Unable to reset ASIC\n");
2021 return STATUS_SUCCESS
;
2024 // Program WMARK register
2025 status
= ft1000_write_register (dev
, 0x600, FT1000_REG_MAG_WATERMARK
);
2026 // clear ASIC reset doorbell
2027 status
= ft1000_write_register (dev
, FT1000_DSP_ASIC_RESET
, FT1000_REG_DOORBELL
);
2030 else if (tempword
& FT1000_ASIC_RESET_REQ
) {
2031 DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_ASIC_RESET_REQ\n");
2033 // clear ASIC reset request from DSP
2034 status
= ft1000_write_register (dev
, FT1000_ASIC_RESET_REQ
, FT1000_REG_DOORBELL
);
2035 status
= ft1000_write_register (dev
, HOST_INTF_BE
, FT1000_REG_SUP_CTRL
);
2036 // copy dsp session record from Adapter block
2037 status
= ft1000_write_dpram32 (dev
, 0, (u8
*)&info
->DSPSess
.Rec
[0], 1024);
2038 // Program WMARK register
2039 status
= ft1000_write_register (dev
, 0x600, FT1000_REG_MAG_WATERMARK
);
2040 // ring doorbell to tell DSP that ASIC is out of reset
2041 status
= ft1000_write_register (dev
, FT1000_ASIC_RESET_DSP
, FT1000_REG_DOORBELL
);
2043 else if (tempword
& FT1000_DB_COND_RESET
) {
2044 DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_COND_RESET\n");
2046 // Reset ASIC and DSP
2048 if (info
->fAppMsgPend
== 0) {
2049 // Reset ASIC and DSP
2051 status
= ft1000_read_dpram16(dev
, FT1000_MAG_DSP_TIMER0
, (u8
*)&(info
->DSP_TIME
[0]), FT1000_MAG_DSP_TIMER0_INDX
);
2052 status
= ft1000_read_dpram16(dev
, FT1000_MAG_DSP_TIMER1
, (u8
*)&(info
->DSP_TIME
[1]), FT1000_MAG_DSP_TIMER1_INDX
);
2053 status
= ft1000_read_dpram16(dev
, FT1000_MAG_DSP_TIMER2
, (u8
*)&(info
->DSP_TIME
[2]), FT1000_MAG_DSP_TIMER2_INDX
);
2054 status
= ft1000_read_dpram16(dev
, FT1000_MAG_DSP_TIMER3
, (u8
*)&(info
->DSP_TIME
[3]), FT1000_MAG_DSP_TIMER3_INDX
);
2055 info
->CardReady
= 0;
2056 info
->DrvErrNum
= DSP_CONDRESET_INFO
;
2057 DEBUG("ft1000_hw:DSP conditional reset requested\n");
2058 info
->ft1000_reset(dev
->net
);
2061 info
->fProvComplete
= 0;
2062 info
->fCondResetPend
= 1;
2065 ft1000_write_register(dev
, FT1000_DB_COND_RESET
, FT1000_REG_DOORBELL
);
2068 }//endof if ( !status )
2070 //DEBUG("return from ft1000_poll.\n");
2071 return STATUS_SUCCESS
;