diff options
Diffstat (limited to 'drivers/staging/ft1000/ft1000-usb/ft1000_hw.c')
-rw-r--r-- | drivers/staging/ft1000/ft1000-usb/ft1000_hw.c | 2326 |
1 files changed, 2326 insertions, 0 deletions
diff --git a/drivers/staging/ft1000/ft1000-usb/ft1000_hw.c b/drivers/staging/ft1000/ft1000-usb/ft1000_hw.c new file mode 100644 index 0000000..5b89ee2 --- /dev/null +++ b/drivers/staging/ft1000/ft1000-usb/ft1000_hw.c @@ -0,0 +1,2326 @@ +//===================================================== +// CopyRight (C) 2007 Qualcomm Inc. All Rights Reserved. +// +// +// This file is part of Express Card USB Driver +// +// $Id: +//==================================================== +// 20090926; aelias; removed compiler warnings & errors; ubuntu 9.04; 2.6.28-15-generic + +#include <linux/init.h> +#include <linux/kernel.h> +#include <linux/module.h> +#include <linux/netdevice.h> +#include <linux/etherdevice.h> +#include <linux/usb.h> +#include "ft1000_usb.h" +#include <linux/types.h> + +#define HARLEY_READ_REGISTER 0x0 +#define HARLEY_WRITE_REGISTER 0x01 +#define HARLEY_READ_DPRAM_32 0x02 +#define HARLEY_READ_DPRAM_LOW 0x03 +#define HARLEY_READ_DPRAM_HIGH 0x04 +#define HARLEY_WRITE_DPRAM_32 0x05 +#define HARLEY_WRITE_DPRAM_LOW 0x06 +#define HARLEY_WRITE_DPRAM_HIGH 0x07 + +#define HARLEY_READ_OPERATION 0xc1 +#define HARLEY_WRITE_OPERATION 0x41 + +//#define JDEBUG + +static int ft1000_reset(struct net_device *ft1000dev); +static int ft1000_submit_rx_urb(struct ft1000_info *info); +static int ft1000_start_xmit(struct sk_buff *skb, struct net_device *dev); +static int ft1000_open (struct net_device *dev); +static struct net_device_stats *ft1000_netdev_stats(struct net_device *dev); +static int ft1000_chkcard (struct ft1000_device *dev); + +//Jim + +static u8 tempbuffer[1600]; +static unsigned long gCardIndex; + +#define MAX_RCV_LOOP 100 + +/**************************************************************** + * ft1000_control_complete + ****************************************************************/ +static void ft1000_control_complete(struct urb *urb) +{ + struct ft1000_device *ft1000dev = (struct ft1000_device *)urb->context; + + //DEBUG("FT1000_CONTROL_COMPLETE ENTERED\n"); + if (ft1000dev == NULL ) + { + DEBUG("NULL ft1000dev, failure\n"); + return ; + } + else if ( ft1000dev->dev == NULL ) + { + DEBUG("NULL ft1000dev->dev, failure\n"); + return ; + } + + if(waitqueue_active(&ft1000dev->control_wait)) + { + wake_up(&ft1000dev->control_wait); + } + + //DEBUG("FT1000_CONTROL_COMPLETE RETURNED\n"); +} + +//--------------------------------------------------------------------------- +// Function: ft1000_control +// +// Parameters: ft1000_device - device structure +// pipe - usb control message pipe +// request - control request +// requesttype - control message request type +// value - value to be written or 0 +// index - register index +// data - data buffer to hold the read/write values +// size - data size +// timeout - control message time out value +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function sends a control message via USB interface synchronously +// +// Notes: +// +//--------------------------------------------------------------------------- +static int ft1000_control(struct ft1000_device *ft1000dev,unsigned int pipe, + u8 request, + u8 requesttype, + u16 value, + u16 index, + void *data, + u16 size, + int timeout) +{ + u16 ret; + + if (ft1000dev == NULL ) + { + DEBUG("NULL ft1000dev, failure\n"); + return -ENODEV; + } + else if ( ft1000dev->dev == NULL ) + { + DEBUG("NULL ft1000dev->dev, failure\n"); + return -ENODEV; + } + + ret = usb_control_msg(ft1000dev->dev, + pipe, + request, + requesttype, + value, + index, + data, + size, + LARGE_TIMEOUT); + + if (ret > 0) + ret = 0; + + return ret; + + +} +//--------------------------------------------------------------------------- +// Function: ft1000_read_register +// +// Parameters: ft1000_device - device structure +// Data - data buffer to hold the value read +// nRegIndex - register index +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function returns the value in a register +// +// Notes: +// +//--------------------------------------------------------------------------- + +u16 ft1000_read_register(struct ft1000_device *ft1000dev, u16* Data, u16 nRegIndx) +{ + u16 ret = STATUS_SUCCESS; + + //DEBUG("ft1000_read_register: reg index is %d\n", nRegIndx); + //DEBUG("ft1000_read_register: spin_lock locked\n"); + ret = ft1000_control(ft1000dev, + usb_rcvctrlpipe(ft1000dev->dev,0), + HARLEY_READ_REGISTER, //request --READ_REGISTER + HARLEY_READ_OPERATION, //requestType + 0, //value + nRegIndx, //index + Data, //data + 2, //data size + LARGE_TIMEOUT ); //timeout + + //DEBUG("ft1000_read_register: ret is %d \n", ret); + + //DEBUG("ft1000_read_register: data is %x \n", *Data); + + return ret; + +} + +//--------------------------------------------------------------------------- +// Function: ft1000_write_register +// +// Parameters: ft1000_device - device structure +// value - value to write into a register +// nRegIndex - register index +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function writes the value in a register +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 ft1000_write_register(struct ft1000_device *ft1000dev, USHORT value, u16 nRegIndx) +{ + u16 ret = STATUS_SUCCESS; + + //DEBUG("ft1000_write_register: value is: %d, reg index is: %d\n", value, nRegIndx); + + ret = ft1000_control(ft1000dev, + usb_sndctrlpipe(ft1000dev->dev, 0), + HARLEY_WRITE_REGISTER, //request -- WRITE_REGISTER + HARLEY_WRITE_OPERATION, //requestType + value, + nRegIndx, + NULL, + 0, + LARGE_TIMEOUT ); + + return ret; +} + +//--------------------------------------------------------------------------- +// Function: ft1000_read_dpram32 +// +// Parameters: ft1000_device - device structure +// indx - starting address to read +// buffer - data buffer to hold the data read +// cnt - number of byte read from DPRAM +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function read a number of bytes from DPRAM +// +// Notes: +// +//--------------------------------------------------------------------------- + +u16 ft1000_read_dpram32(struct ft1000_device *ft1000dev, USHORT indx, PUCHAR buffer, USHORT cnt) +{ + u16 ret = STATUS_SUCCESS; + + //DEBUG("ft1000_read_dpram32: indx: %d cnt: %d\n", indx, cnt); + ret =ft1000_control(ft1000dev, + usb_rcvctrlpipe(ft1000dev->dev,0), + HARLEY_READ_DPRAM_32, //request --READ_DPRAM_32 + HARLEY_READ_OPERATION, //requestType + 0, //value + indx, //index + buffer, //data + cnt, //data size + LARGE_TIMEOUT ); //timeout + + //DEBUG("ft1000_read_dpram32: ret is %d \n", ret); + + //DEBUG("ft1000_read_dpram32: ret=%d \n", ret); + + return ret; + +} + +//--------------------------------------------------------------------------- +// Function: ft1000_write_dpram32 +// +// Parameters: ft1000_device - device structure +// indx - starting address to write the data +// buffer - data buffer to write into DPRAM +// cnt - number of bytes to write +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function writes into DPRAM a number of bytes +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 ft1000_write_dpram32(struct ft1000_device *ft1000dev, USHORT indx, PUCHAR buffer, USHORT cnt) +{ + u16 ret = STATUS_SUCCESS; + + //DEBUG("ft1000_write_dpram32: indx: %d buffer: %x cnt: %d\n", indx, buffer, cnt); + if ( cnt % 4) + cnt += cnt - (cnt % 4); + + ret = ft1000_control(ft1000dev, + usb_sndctrlpipe(ft1000dev->dev, 0), + HARLEY_WRITE_DPRAM_32, //request -- WRITE_DPRAM_32 + HARLEY_WRITE_OPERATION, //requestType + 0, //value + indx, //index + buffer, //buffer + cnt, //buffer size + LARGE_TIMEOUT ); + + return ret; +} + +//--------------------------------------------------------------------------- +// Function: ft1000_read_dpram16 +// +// Parameters: ft1000_device - device structure +// indx - starting address to read +// buffer - data buffer to hold the data read +// hightlow - high or low 16 bit word +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function read 16 bits from DPRAM +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 ft1000_read_dpram16(struct ft1000_device *ft1000dev, USHORT indx, PUCHAR buffer, u8 highlow) +{ + u16 ret = STATUS_SUCCESS; + + //DEBUG("ft1000_read_dpram16: indx: %d hightlow: %d\n", indx, highlow); + + u8 request; + + if (highlow == 0 ) + request = HARLEY_READ_DPRAM_LOW; + else + request = HARLEY_READ_DPRAM_HIGH; + + ret = ft1000_control(ft1000dev, + usb_rcvctrlpipe(ft1000dev->dev,0), + request, //request --READ_DPRAM_H/L + HARLEY_READ_OPERATION, //requestType + 0, //value + indx, //index + buffer, //data + 2, //data size + LARGE_TIMEOUT ); //timeout + + //DEBUG("ft1000_read_dpram16: ret is %d \n", ret); + + + //DEBUG("ft1000_read_dpram16: data is %x \n", *buffer); + + return ret; + +} + +//--------------------------------------------------------------------------- +// Function: ft1000_write_dpram16 +// +// Parameters: ft1000_device - device structure +// indx - starting address to write the data +// value - 16bits value to write +// hightlow - high or low 16 bit word +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function writes into DPRAM a number of bytes +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 ft1000_write_dpram16(struct ft1000_device *ft1000dev, USHORT indx, USHORT value, u8 highlow) +{ + u16 ret = STATUS_SUCCESS; + + + + //DEBUG("ft1000_write_dpram16: indx: %d value: %d highlow: %d\n", indx, value, highlow); + + u8 request; + + + if ( highlow == 0 ) + request = HARLEY_WRITE_DPRAM_LOW; + else + request = HARLEY_WRITE_DPRAM_HIGH; + + ret = ft1000_control(ft1000dev, + usb_sndctrlpipe(ft1000dev->dev, 0), + request, //request -- WRITE_DPRAM_H/L + HARLEY_WRITE_OPERATION, //requestType + value, //value + indx, //index + NULL, //buffer + 0, //buffer size + LARGE_TIMEOUT ); + + return ret; +} + +//--------------------------------------------------------------------------- +// Function: fix_ft1000_read_dpram32 +// +// Parameters: ft1000_device - device structure +// indx - starting address to read +// buffer - data buffer to hold the data read +// +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function read DPRAM 4 words at a time +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 fix_ft1000_read_dpram32(struct ft1000_device *ft1000dev, USHORT indx, PUCHAR buffer) +{ + UCHAR buf[16]; + USHORT pos; + u16 ret = STATUS_SUCCESS; + + //DEBUG("fix_ft1000_read_dpram32: indx: %d \n", indx); + pos = (indx / 4)*4; + ret = ft1000_read_dpram32(ft1000dev, pos, buf, 16); + if (ret == STATUS_SUCCESS) + { + pos = (indx % 4)*4; + *buffer++ = buf[pos++]; + *buffer++ = buf[pos++]; + *buffer++ = buf[pos++]; + *buffer++ = buf[pos++]; + } + else + { + DEBUG("fix_ft1000_read_dpram32: DPRAM32 Read failed\n"); + *buffer++ = 0; + *buffer++ = 0; + *buffer++ = 0; + *buffer++ = 0; + + } + + //DEBUG("fix_ft1000_read_dpram32: data is %x \n", *buffer); + return ret; + +} + + +//--------------------------------------------------------------------------- +// Function: fix_ft1000_write_dpram32 +// +// Parameters: ft1000_device - device structure +// indx - starting address to write +// buffer - data buffer to write +// +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function write to DPRAM 4 words at a time +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 fix_ft1000_write_dpram32(struct ft1000_device *ft1000dev, USHORT indx, PUCHAR buffer) +{ + USHORT pos1; + USHORT pos2; + USHORT i; + UCHAR buf[32]; + UCHAR resultbuffer[32]; + PUCHAR pdata; + u16 ret = STATUS_SUCCESS; + + //DEBUG("fix_ft1000_write_dpram32: Entered:\n"); + + pos1 = (indx / 4)*4; + pdata = buffer; + ret = ft1000_read_dpram32(ft1000dev, pos1, buf, 16); + if (ret == STATUS_SUCCESS) + { + pos2 = (indx % 4)*4; + buf[pos2++] = *buffer++; + buf[pos2++] = *buffer++; + buf[pos2++] = *buffer++; + buf[pos2++] = *buffer++; + ret = ft1000_write_dpram32(ft1000dev, pos1, buf, 16); + } + else + { + DEBUG("fix_ft1000_write_dpram32: DPRAM32 Read failed\n"); + + return ret; + } + + ret = ft1000_read_dpram32(ft1000dev, pos1, (PUCHAR)&resultbuffer[0], 16); + if (ret == STATUS_SUCCESS) + { + buffer = pdata; + for (i=0; i<16; i++) + { + if (buf[i] != resultbuffer[i]){ + + ret = STATUS_FAILURE; + } + } + } + + if (ret == STATUS_FAILURE) + { + ret = ft1000_write_dpram32(ft1000dev, pos1, (PUCHAR)&tempbuffer[0], 16); + ret = ft1000_read_dpram32(ft1000dev, pos1, (PUCHAR)&resultbuffer[0], 16); + if (ret == STATUS_SUCCESS) + { + buffer = pdata; + for (i=0; i<16; i++) + { + if (tempbuffer[i] != resultbuffer[i]) + { + ret = STATUS_FAILURE; + DEBUG("fix_ft1000_write_dpram32 Failed to write\n"); + } + } + } + } + + return ret; + +} + + +//------------------------------------------------------------------------ +// +// Function: card_reset_dsp +// +// Synopsis: This function is called to reset or activate the DSP +// +// Arguments: value - reset or activate +// +// Returns: None +//----------------------------------------------------------------------- +static void card_reset_dsp (struct ft1000_device *ft1000dev, BOOLEAN value) +{ + u16 status = STATUS_SUCCESS; + USHORT tempword; + + status = ft1000_write_register (ft1000dev, HOST_INTF_BE, FT1000_REG_SUP_CTRL); + status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_SUP_CTRL); + if (value) + { + DEBUG("Reset DSP\n"); + status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_RESET); + tempword |= DSP_RESET_BIT; + status = ft1000_write_register(ft1000dev, tempword, FT1000_REG_RESET); + } + else + { + DEBUG("Activate DSP\n"); + status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_RESET); + tempword |= DSP_ENCRYPTED; + tempword &= ~DSP_UNENCRYPTED; + status = ft1000_write_register(ft1000dev, tempword, FT1000_REG_RESET); + status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_RESET); + tempword &= ~EFUSE_MEM_DISABLE; + tempword &= ~DSP_RESET_BIT; + status = ft1000_write_register(ft1000dev, tempword, FT1000_REG_RESET); + status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_RESET); + } +} + +//--------------------------------------------------------------------------- +// Function: CardSendCommand +// +// Parameters: ft1000_device - device structure +// ptempbuffer - command buffer +// size - command buffer size +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function sends a command to ASIC +// +// Notes: +// +//--------------------------------------------------------------------------- +void CardSendCommand(struct ft1000_device *ft1000dev, void *ptempbuffer, int size) +{ + unsigned short temp; + unsigned char *commandbuf; + + DEBUG("CardSendCommand: enter CardSendCommand... size=%d\n", size); + + commandbuf =(unsigned char*) kmalloc(size+2, GFP_KERNEL); + memcpy((void*)commandbuf+2, (void*)ptempbuffer, size); + + //DEBUG("CardSendCommand: Command Send\n"); + + ft1000_read_register(ft1000dev, &temp, FT1000_REG_DOORBELL); + + if (temp & 0x0100) + { + msleep(10); + } + + // check for odd word + size = size + 2; + if (size % 4) + { + // Must force to be 32 bit aligned + size += 4 - (size % 4); + } + + + //DEBUG("CardSendCommand: write dpram ... size=%d\n", size); + ft1000_write_dpram32(ft1000dev, 0,commandbuf, size); + msleep(1); + //DEBUG("CardSendCommand: write into doorbell ...\n"); + ft1000_write_register(ft1000dev, FT1000_DB_DPRAM_TX ,FT1000_REG_DOORBELL) ; + msleep(1); + + ft1000_read_register(ft1000dev, &temp, FT1000_REG_DOORBELL); + //DEBUG("CardSendCommand: read doorbell ...temp=%x\n", temp); + if ( (temp & 0x0100) == 0) + { + //DEBUG("CardSendCommand: Message sent\n"); + } + +} + + +//-------------------------------------------------------------------------- +// +// Function: dsp_reload +// +// Synopsis: This function is called to load or reload the DSP +// +// Arguments: ft1000dev - device structure +// +// Returns: None +//----------------------------------------------------------------------- +int dsp_reload(struct ft1000_device *ft1000dev) +{ + u16 status; + USHORT tempword; + ULONG templong; + + struct ft1000_info *pft1000info; + + pft1000info = netdev_priv(ft1000dev->net); + + pft1000info->CardReady = 0; + + // Program Interrupt Mask register + status = ft1000_write_register (ft1000dev, 0xffff, FT1000_REG_SUP_IMASK); + + status = ft1000_read_register (ft1000dev, &tempword, FT1000_REG_RESET); + tempword |= ASIC_RESET_BIT; + status = ft1000_write_register (ft1000dev, tempword, FT1000_REG_RESET); + msleep(1000); + status = ft1000_read_register (ft1000dev, &tempword, FT1000_REG_RESET); + DEBUG("Reset Register = 0x%x\n", tempword); + + // Toggle DSP reset + card_reset_dsp (ft1000dev, 1); + msleep(1000); + card_reset_dsp (ft1000dev, 0); + msleep(1000); + + status = ft1000_write_register (ft1000dev, HOST_INTF_BE, FT1000_REG_SUP_CTRL); + + // Let's check for FEFE + status = ft1000_read_dpram32 (ft1000dev, FT1000_MAG_DPRAM_FEFE_INDX, (PUCHAR)&templong, 4); + DEBUG("templong (fefe) = 0x%8x\n", templong); + + // call codeloader + status = scram_dnldr(ft1000dev, pFileStart, FileLength); + + if (status != STATUS_SUCCESS) + return -EIO; + + msleep(1000); + + DEBUG("dsp_reload returned\n"); + return 0; + +} + +//--------------------------------------------------------------------------- +// +// Function: ft1000_reset_asic +// Descripton: This function will call the Card Service function to reset the +// ASIC. +// Input: +// dev - device structure +// Output: +// none +// +//--------------------------------------------------------------------------- +static void ft1000_reset_asic (struct net_device *dev) +{ + struct ft1000_info *info = netdev_priv(dev); + struct ft1000_device *ft1000dev = info->pFt1000Dev; + u16 tempword; + + DEBUG("ft1000_hw:ft1000_reset_asic called\n"); + + info->ASICResetNum++; + + // Let's use the register provided by the Magnemite ASIC to reset the + // ASIC and DSP. + ft1000_write_register(ft1000dev, (DSP_RESET_BIT | ASIC_RESET_BIT), FT1000_REG_RESET ); + + mdelay(1); + + // set watermark to -1 in order to not generate an interrrupt + ft1000_write_register(ft1000dev, 0xffff, FT1000_REG_MAG_WATERMARK); + + // clear interrupts + ft1000_read_register (ft1000dev, &tempword, FT1000_REG_SUP_ISR); + DEBUG("ft1000_hw: interrupt status register = 0x%x\n",tempword); + ft1000_write_register (ft1000dev, tempword, FT1000_REG_SUP_ISR); + ft1000_read_register (ft1000dev, &tempword, FT1000_REG_SUP_ISR); + DEBUG("ft1000_hw: interrupt status register = 0x%x\n",tempword); + +} + + +//--------------------------------------------------------------------------- +// +// Function: ft1000_reset_card +// Descripton: This function will reset the card +// Input: +// dev - device structure +// Output: +// status - FALSE (card reset fail) +// TRUE (card reset successful) +// +//--------------------------------------------------------------------------- +static int ft1000_reset_card (struct net_device *dev) +{ + struct ft1000_info *info = netdev_priv(dev); + struct ft1000_device *ft1000dev = info->pFt1000Dev; + u16 tempword; + struct prov_record *ptr; + + DEBUG("ft1000_hw:ft1000_reset_card called.....\n"); + + info->fCondResetPend = 1; + info->CardReady = 0; + info->fProvComplete = 0; + + // Make sure we free any memory reserve for provisioning + while (list_empty(&info->prov_list) == 0) { + DEBUG("ft1000_hw:ft1000_reset_card:deleting provisioning record\n"); + ptr = list_entry(info->prov_list.next, struct prov_record, list); + list_del(&ptr->list); + kfree(ptr->pprov_data); + kfree(ptr); + } + + DEBUG("ft1000_hw:ft1000_reset_card: reset asic\n"); + //reset ASIC + ft1000_reset_asic(dev); + + info->DSPResetNum++; + + DEBUG("ft1000_hw:ft1000_reset_card: call dsp_reload\n"); + dsp_reload(ft1000dev); + + DEBUG("dsp reload successful\n"); + + + mdelay(10); + + // Initialize DSP heartbeat area to ho + ft1000_write_dpram16(ft1000dev, FT1000_MAG_HI_HO, ho_mag, FT1000_MAG_HI_HO_INDX); + ft1000_read_dpram16(ft1000dev, FT1000_MAG_HI_HO, (PCHAR)&tempword, FT1000_MAG_HI_HO_INDX); + DEBUG("ft1000_hw:ft1000_reset_card:hi_ho value = 0x%x\n", tempword); + + + + info->CardReady = 1; + + info->fCondResetPend = 0; + return TRUE; + +} + + +//mbelian +#ifdef HAVE_NET_DEVICE_OPS +static const struct net_device_ops ftnet_ops = +{ +.ndo_open = &ft1000_open, +.ndo_stop = &ft1000_close, +.ndo_start_xmit = &ft1000_start_xmit, +.ndo_get_stats = &ft1000_netdev_stats, +}; +#endif + + +//--------------------------------------------------------------------------- +// Function: init_ft1000_netdev +// +// Parameters: ft1000dev - device structure +// +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function initialize the network device +// +// Notes: +// +//--------------------------------------------------------------------------- +u16 init_ft1000_netdev(struct ft1000_device *ft1000dev) +{ + struct net_device *netdev; + struct ft1000_info *pInfo = NULL; + struct dpram_blk *pdpram_blk; + int i, ret_val; + struct list_head *cur, *tmp; + char card_nr[2]; + + gCardIndex=0; //mbelian + + DEBUG("Enter init_ft1000_netdev...\n"); + + + netdev = alloc_etherdev(sizeof(struct ft1000_info)); + if (!netdev ) + { + DEBUG("init_ft1000_netdev: can not allocate network device\n"); + return -ENOMEM; + } + + pInfo = (struct ft1000_info *) netdev_priv(netdev); + + //DEBUG("init_ft1000_netdev: gFt1000Info=%x, netdev=%x, ft1000dev=%x\n", gFt1000Info, netdev, ft1000dev); + + memset(pInfo, 0, sizeof(struct ft1000_info)); + + dev_alloc_name(netdev, netdev->name); + + //for the first inserted card, decide the card index beginning number, in case there are existing network interfaces + if ( gCardIndex == 0 ) + { + DEBUG("init_ft1000_netdev: network device name is %s\n", netdev->name); + + if ( strncmp(netdev->name,"eth", 3) == 0) { + card_nr[0] = netdev->name[3]; + card_nr[1] = '\0'; + ret_val = strict_strtoul(card_nr, 10, &gCardIndex); + if (ret_val) { + printk(KERN_ERR "Can't parse netdev\n"); + goto err_net; + } + + pInfo->CardNumber = gCardIndex; + DEBUG("card number = %d\n", pInfo->CardNumber); + } + else { + printk(KERN_ERR "ft1000: Invalid device name\n"); + ret_val = -ENXIO; + goto err_net; + } + } + else + { + //not the first inserted card, increase card number by 1 + pInfo->CardNumber = gCardIndex; + /*DEBUG("card number = %d\n", pInfo->CardNumber);*/ //mbelian + } + + memset(&pInfo->stats, 0, sizeof(struct net_device_stats) ); + + spin_lock_init(&pInfo->dpram_lock); + pInfo->pFt1000Dev = ft1000dev; + pInfo->DrvErrNum = 0; + pInfo->ASICResetNum = 0; + pInfo->registered = 1; + pInfo->ft1000_reset = ft1000_reset; + pInfo->mediastate = 0; + pInfo->fifo_cnt = 0; + pInfo->DeviceCreated = FALSE; + pInfo->DeviceMajor = 0; + pInfo->CurrentInterruptEnableMask = ISR_DEFAULT_MASK; + pInfo->InterruptsEnabled = FALSE; + pInfo->CardReady = 0; + pInfo->DSP_TIME[0] = 0; + pInfo->DSP_TIME[1] = 0; + pInfo->DSP_TIME[2] = 0; + pInfo->DSP_TIME[3] = 0; + pInfo->fAppMsgPend = 0; + pInfo->fCondResetPend = 0; + pInfo->usbboot = 0; + pInfo->dspalive = 0; + for (i=0;i<32 ;i++ ) + { + pInfo->tempbuf[i] = 0; + } + + INIT_LIST_HEAD(&pInfo->prov_list); + +//mbelian +#ifdef HAVE_NET_DEVICE_OPS + netdev->netdev_ops = &ftnet_ops; +#else + netdev->hard_start_xmit = &ft1000_start_xmit; + netdev->get_stats = &ft1000_netdev_stats; + netdev->open = &ft1000_open; + netdev->stop = &ft1000_close; +#endif + + ft1000dev->net = netdev; + + + +//init free_buff_lock, freercvpool, numofmsgbuf, pdpram_blk +//only init once per card +//Jim + DEBUG("Initialize free_buff_lock and freercvpool\n"); + spin_lock_init(&free_buff_lock); + + // initialize a list of buffers to be use for queuing up receive command data + INIT_LIST_HEAD (&freercvpool); + + // create list of free buffers + for (i=0; i<NUM_OF_FREE_BUFFERS; i++) { + // Get memory for DPRAM_DATA link list + pdpram_blk = kmalloc(sizeof(struct dpram_blk), GFP_KERNEL); + if (pdpram_blk == NULL) { + ret_val = -ENOMEM; + goto err_free; + } + // Get a block of memory to store command data + pdpram_blk->pbuffer = kmalloc ( MAX_CMD_SQSIZE, GFP_KERNEL ); + if (pdpram_blk->pbuffer == NULL) { + ret_val = -ENOMEM; + kfree(pdpram_blk); + goto err_free; + } + // link provisioning data + list_add_tail (&pdpram_blk->list, &freercvpool); + } + numofmsgbuf = NUM_OF_FREE_BUFFERS; + + + return 0; + + +err_free: + list_for_each_safe(cur, tmp, &freercvpool) { + pdpram_blk = list_entry(cur, struct dpram_blk, list); + list_del(&pdpram_blk->list); + kfree(pdpram_blk->pbuffer); + kfree(pdpram_blk); + } +err_net: + free_netdev(netdev); + return ret_val; +} + + + +//--------------------------------------------------------------------------- +// Function: reg_ft1000_netdev +// +// Parameters: ft1000dev - device structure +// +// +// Returns: STATUS_SUCCESS - success +// STATUS_FAILURE - failure +// +// Description: This function register the network driver +// +// Notes: +// +//--------------------------------------------------------------------------- +int reg_ft1000_netdev(struct ft1000_device *ft1000dev, struct usb_interface *intf) +{ + struct net_device *netdev; + struct ft1000_info *pInfo; + int rc; + + netdev = ft1000dev->net; + pInfo = netdev_priv(ft1000dev->net); + DEBUG("Enter reg_ft1000_netdev...\n"); + + + ft1000_read_register(ft1000dev, &pInfo->AsicID, FT1000_REG_ASIC_ID); + + usb_set_intfdata(intf, pInfo); + SET_NETDEV_DEV(netdev, &intf->dev); + + rc = register_netdev(netdev); + if (rc) + { + DEBUG("reg_ft1000_netdev: could not register network device\n"); + free_netdev(netdev); + return rc; + } + + + //Create character device, implemented by Jim + ft1000_CreateDevice(ft1000dev); + + DEBUG ("reg_ft1000_netdev returned\n"); + + pInfo->CardReady = 1; + + + return 0; +} + +static int ft1000_reset(struct net_device *dev) +{ + ft1000_reset_card(dev); + return 0; +} + +//--------------------------------------------------------------------------- +// Function: ft1000_usb_transmit_complete +// +// Parameters: urb - transmitted usb urb +// +// +// Returns: none +// +// Description: This is the callback function when a urb is transmitted +// +// Notes: +// +//--------------------------------------------------------------------------- +static void ft1000_usb_transmit_complete(struct urb *urb) +{ + + struct ft1000_device *ft1000dev = urb->context; + + //DEBUG("ft1000_usb_transmit_complete entered\n"); + + if (urb->status) + printk("%s: TX status %d\n", ft1000dev->net->name, urb->status); + + netif_wake_queue(ft1000dev->net); + + //DEBUG("Return from ft1000_usb_transmit_complete\n"); +} + + +/**************************************************************** + * ft1000_control + ****************************************************************/ +static int ft1000_read_fifo_reg(struct ft1000_device *ft1000dev,unsigned int pipe, + u8 request, + u8 requesttype, + u16 value, + u16 index, + void *data, + u16 size, + int timeout) +{ + u16 ret; + + DECLARE_WAITQUEUE(wait, current); + struct urb *urb; + struct usb_ctrlrequest *dr; + int status; + + if (ft1000dev == NULL ) + { + DEBUG("NULL ft1000dev, failure\n"); + return STATUS_FAILURE; + } + else if ( ft1000dev->dev == NULL ) + { + DEBUG("NULL ft1000dev->dev, failure\n"); + return STATUS_FAILURE; + } + + spin_lock(&ft1000dev->device_lock); + + if(in_interrupt()) + { + spin_unlock(&ft1000dev->device_lock); + return -EBUSY; + } + + urb = usb_alloc_urb(0, GFP_KERNEL); + dr = kmalloc(sizeof(struct usb_ctrlrequest), in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); + + if(!urb || !dr) + { + kfree(dr); + usb_free_urb(urb); + spin_unlock(&ft1000dev->device_lock); + return -ENOMEM; + } + + + + dr->bRequestType = requesttype; + dr->bRequest = request; + dr->wValue = value; + dr->wIndex = index; + dr->wLength = size; + + usb_fill_control_urb(urb, ft1000dev->dev, pipe, (char*)dr, (void*)data, size, (void *)ft1000_control_complete, (void*)ft1000dev); + + + init_waitqueue_head(&ft1000dev->control_wait); + + set_current_state(TASK_INTERRUPTIBLE); + + add_wait_queue(&ft1000dev->control_wait, &wait); + + + + + status = usb_submit_urb(urb, GFP_KERNEL); + + if(status) + { + usb_free_urb(urb); + kfree(dr); + remove_wait_queue(&ft1000dev->control_wait, &wait); + spin_unlock(&ft1000dev->device_lock); + return status; + } + + if(urb->status == -EINPROGRESS) + { + while(timeout && urb->status == -EINPROGRESS) + { + status = timeout = schedule_timeout(timeout); + } + } + else + { + status = 1; + } + + remove_wait_queue(&ft1000dev->control_wait, &wait); + + if(!status) + { + usb_unlink_urb(urb); + printk("ft1000 timeout\n"); + status = -ETIMEDOUT; + } + else + { + status = urb->status; + + if(urb->status) + { + printk("ft1000 control message failed (urb addr: %p) with error number: %i\n", urb, (int)status); + + usb_clear_halt(ft1000dev->dev, usb_rcvctrlpipe(ft1000dev->dev, 0)); + usb_clear_halt(ft1000dev->dev, usb_sndctrlpipe(ft1000dev->dev, 0)); + usb_unlink_urb(urb); + } + } + + + + usb_free_urb(urb); + kfree(dr); + spin_unlock(&ft1000dev->device_lock); + return ret; + + +} + +//--------------------------------------------------------------------------- +// Function: ft1000_read_fifo_len +// +// Parameters: ft1000dev - device structure +// +// +// Returns: none +// +// Description: read the fifo length register content +// +// Notes: +// +//--------------------------------------------------------------------------- +static inline u16 ft1000_read_fifo_len (struct net_device *dev) +{ + u16 temp; + u16 ret; + + struct ft1000_info *info = (struct ft1000_info *) netdev_priv(dev); + struct ft1000_device *ft1000dev = info->pFt1000Dev; +// DEBUG("ft1000_read_fifo_len: enter ft1000dev %x\n", ft1000dev); //aelias [-] reason: warning: format ???%x??? expects type ???unsigned int???, but argument 2 has type ???struct ft1000_device *??? + DEBUG("ft1000_read_fifo_len: enter ft1000dev %p\n", ft1000dev); //aelias [+] reason: up + + ret = STATUS_SUCCESS; + + ret = ft1000_read_fifo_reg(ft1000dev, + usb_rcvctrlpipe(ft1000dev->dev,0), + HARLEY_READ_REGISTER, + HARLEY_READ_OPERATION, + 0, + FT1000_REG_MAG_UFSR, + &temp, + 2, + LARGE_TIMEOUT); + + if (ret>0) + ret = STATUS_SUCCESS; + else + ret = STATUS_FAILURE; + + DEBUG("ft1000_read_fifo_len: returned %d\n", temp); + + return (temp- 16); + +} + + +//--------------------------------------------------------------------------- +// +// Function: ft1000_copy_down_pkt +// Descripton: This function will take an ethernet packet and convert it to +// a Flarion packet prior to sending it to the ASIC Downlink +// FIFO. +// Input: +// dev - device structure +// packet - address of ethernet packet +// len - length of IP packet +// Output: +// status - FAILURE +// SUCCESS +// +//--------------------------------------------------------------------------- +static int ft1000_copy_down_pkt (struct net_device *netdev, u8 *packet, u16 len) +{ + struct ft1000_info *pInfo = netdev_priv(netdev); + struct ft1000_device *pFt1000Dev = pInfo->pFt1000Dev; + + + int i, count, ret; + USHORT *pTemp; + USHORT checksum; + u8 *t; + + if (!pInfo->CardReady) + { + + DEBUG("ft1000_copy_down_pkt::Card Not Ready\n"); + return STATUS_FAILURE; + + } + + + //DEBUG("ft1000_copy_down_pkt() entered, len = %d\n", len); + + count = sizeof(struct pseudo_hdr) + len; + if(count > MAX_BUF_SIZE) + { + DEBUG("Error:ft1000_copy_down_pkt:Message Size Overflow!\n"); + DEBUG("size = %d\n", count); + return STATUS_FAILURE; + } + + if ( count % 4) + count = count + (4- (count %4) ); + + pTemp = (PUSHORT)&(pFt1000Dev->tx_buf[0]); + *pTemp ++ = ntohs(count); + *pTemp ++ = 0x1020; + *pTemp ++ = 0x2010; + *pTemp ++ = 0x9100; + *pTemp ++ = 0; + *pTemp ++ = 0; + *pTemp ++ = 0; + pTemp = (PUSHORT)&(pFt1000Dev->tx_buf[0]); + checksum = *pTemp ++; + for (i=1; i<7; i++) + { + checksum ^= *pTemp ++; + } + *pTemp++ = checksum; + memcpy(&(pFt1000Dev->tx_buf[sizeof(struct pseudo_hdr)]), packet, len); + + netif_stop_queue(netdev); + + //DEBUG ("ft1000_copy_down_pkt: count = %d\n", count); + + usb_fill_bulk_urb(pFt1000Dev->tx_urb, + pFt1000Dev->dev, + usb_sndbulkpipe(pFt1000Dev->dev, pFt1000Dev->bulk_out_endpointAddr), + pFt1000Dev->tx_buf, + count, + ft1000_usb_transmit_complete, + (void*)pFt1000Dev); + + t = (u8 *)pFt1000Dev->tx_urb->transfer_buffer; + //DEBUG("transfer_length=%d\n", pFt1000Dev->tx_urb->transfer_buffer_length); + /*for (i=0; i<count; i++ ) + { + DEBUG("%x ", *t++ ); + }*/ + + + ret = usb_submit_urb(pFt1000Dev->tx_urb, GFP_ATOMIC); + if(ret) + { + DEBUG("ft1000 failed tx_urb %d\n", ret); + + return STATUS_FAILURE; + + } + else + { + //DEBUG("ft1000 sucess tx_urb %d\n", ret); + + pInfo->stats.tx_packets++; + pInfo->stats.tx_bytes += (len+14); + } + + //DEBUG("ft1000_copy_down_pkt() exit\n"); + + return STATUS_SUCCESS; +} + +//--------------------------------------------------------------------------- +// Function: ft1000_start_xmit +// +// Parameters: skb - socket buffer to be sent +// dev - network device +// +// +// Returns: none +// +// Description: transmit a ethernet packet +// +// Notes: +// +//--------------------------------------------------------------------------- +static int ft1000_start_xmit(struct sk_buff *skb, struct net_device *dev) +{ + struct ft1000_info *pInfo = netdev_priv(dev); + struct ft1000_device *pFt1000Dev= pInfo->pFt1000Dev; + u8 *pdata; + int maxlen, pipe; + + + //DEBUG(" ft1000_start_xmit() entered\n"); + + if ( skb == NULL ) + { + DEBUG ("ft1000_hw: ft1000_start_xmit:skb == NULL!!!\n" ); + return STATUS_FAILURE; + } + + if ( pFt1000Dev->status & FT1000_STATUS_CLOSING) + { + DEBUG("network driver is closed, return\n"); + dev_kfree_skb(skb); + return STATUS_SUCCESS; + } + + //DEBUG("ft1000_start_xmit 1:length of packet = %d\n", skb->len); + pipe = usb_sndbulkpipe(pFt1000Dev->dev, pFt1000Dev->bulk_out_endpointAddr); + maxlen = usb_maxpacket(pFt1000Dev->dev, pipe, usb_pipeout(pipe)); + //DEBUG("ft1000_start_xmit 2: pipe=%d dev->maxpacket = %d\n", pipe, maxlen); + + pdata = (u8 *)skb->data; + /*for (i=0; i<skb->len; i++) + DEBUG("skb->data[%d]=%x ", i, *(skb->data+i)); + + DEBUG("\n");*/ + + + if (pInfo->mediastate == 0) + { + /* Drop packet is mediastate is down */ + DEBUG("ft1000_hw:ft1000_start_xmit:mediastate is down\n"); + dev_kfree_skb(skb); + return STATUS_SUCCESS; + } + + if ( (skb->len < ENET_HEADER_SIZE) || (skb->len > ENET_MAX_SIZE) ) + { + /* Drop packet which has invalid size */ + DEBUG("ft1000_hw:ft1000_start_xmit:invalid ethernet length\n"); + dev_kfree_skb(skb); + return STATUS_SUCCESS; + } +//mbelian + if(ft1000_copy_down_pkt (dev, (pdata+ENET_HEADER_SIZE-2), skb->len - ENET_HEADER_SIZE + 2) == STATUS_FAILURE) + { + dev_kfree_skb(skb); + return STATUS_SUCCESS; + } + + dev_kfree_skb(skb); + //DEBUG(" ft1000_start_xmit() exit\n"); + + return 0; +} + +//--------------------------------------------------------------------------- +// +// Function: ft1000_copy_up_pkt +// Descripton: This function will take a packet from the FIFO up link and +// convert it into an ethernet packet and deliver it to the IP stack +// Input: +// urb - the receving usb urb +// +// Output: +// status - FAILURE +// SUCCESS +// +//--------------------------------------------------------------------------- +static int ft1000_copy_up_pkt (struct urb *urb) +{ + struct ft1000_info *info = urb->context; + struct ft1000_device *ft1000dev = info->pFt1000Dev; + struct net_device *net = ft1000dev->net; + + u16 tempword; + u16 len; + u16 lena; //mbelian + struct sk_buff *skb; + u16 i; + u8 *pbuffer=NULL; + u8 *ptemp=NULL; + u16 *chksum; + + + //DEBUG("ft1000_copy_up_pkt entered\n"); + + if ( ft1000dev->status & FT1000_STATUS_CLOSING) + { + DEBUG("network driver is closed, return\n"); + return STATUS_SUCCESS; + } + + // Read length + len = urb->transfer_buffer_length; + lena = urb->actual_length; //mbelian + //DEBUG("ft1000_copy_up_pkt: transfer_buffer_length=%d, actual_buffer_len=%d\n", + // urb->transfer_buffer_length, urb->actual_length); + + chksum = (PUSHORT)ft1000dev->rx_buf; + + tempword = *chksum++; + for (i=1; i<7; i++) + { + tempword ^= *chksum++; + } + + if (tempword != *chksum) + { + info->stats.rx_errors ++; + ft1000_submit_rx_urb(info); + return STATUS_FAILURE; + } + + + //DEBUG("ft1000_copy_up_pkt: checksum is correct %x\n", *chksum); + + skb = dev_alloc_skb(len+12+2); + + if (skb == NULL) + { + DEBUG("ft1000_copy_up_pkt: No Network buffers available\n"); + info->stats.rx_errors++; + ft1000_submit_rx_urb(info); + return STATUS_FAILURE; + } + + pbuffer = (u8 *)skb_put(skb, len+12); + + //subtract the number of bytes read already + ptemp = pbuffer; + + // fake MAC address + *pbuffer++ = net->dev_addr[0]; + *pbuffer++ = net->dev_addr[1]; + *pbuffer++ = net->dev_addr[2]; + *pbuffer++ = net->dev_addr[3]; + *pbuffer++ = net->dev_addr[4]; + *pbuffer++ = net->dev_addr[5]; + *pbuffer++ = 0x00; + *pbuffer++ = 0x07; + *pbuffer++ = 0x35; + *pbuffer++ = 0xff; + *pbuffer++ = 0xff; + *pbuffer++ = 0xfe; + + + + + memcpy(pbuffer, ft1000dev->rx_buf+sizeof(struct pseudo_hdr), len-sizeof(struct pseudo_hdr)); + + //DEBUG("ft1000_copy_up_pkt: Data passed to Protocol layer\n"); + /*for (i=0; i<len+12; i++) + { + DEBUG("ft1000_copy_up_pkt: Protocol Data: 0x%x\n ", *ptemp++); + }*/ + + skb->dev = net; + + skb->protocol = eth_type_trans(skb, net); + skb->ip_summed = CHECKSUM_UNNECESSARY; + netif_rx(skb); + + info->stats.rx_packets++; + // Add on 12 bytes for MAC address which was removed + info->stats.rx_bytes += (lena+12); //mbelian + + ft1000_submit_rx_urb(info); + //DEBUG("ft1000_copy_up_pkt exited\n"); + return SUCCESS; +} + +//--------------------------------------------------------------------------- +// +// Function: ft1000_submit_rx_urb +// Descripton: the receiving function of the network driver +// +// Input: +// info - a private structure contains the device information +// +// Output: +// status - FAILURE +// SUCCESS +// +//--------------------------------------------------------------------------- +static int ft1000_submit_rx_urb(struct ft1000_info *info) +{ + int result; + struct ft1000_device *pFt1000Dev = info->pFt1000Dev; + + + //DEBUG ("ft1000_submit_rx_urb entered: sizeof rx_urb is %d\n", sizeof(*pFt1000Dev->rx_urb)); + if ( pFt1000Dev->status & FT1000_STATUS_CLOSING) + { + DEBUG("network driver is closed, return\n"); + //usb_kill_urb(pFt1000Dev->rx_urb); //mbelian + return STATUS_SUCCESS; + } + + usb_fill_bulk_urb(pFt1000Dev->rx_urb, + pFt1000Dev->dev, + usb_rcvbulkpipe(pFt1000Dev->dev, pFt1000Dev->bulk_in_endpointAddr), + pFt1000Dev->rx_buf, + MAX_BUF_SIZE, + (usb_complete_t)ft1000_copy_up_pkt, + info); + + + if((result = usb_submit_urb(pFt1000Dev->rx_urb, GFP_ATOMIC))) + { + printk("ft1000_submit_rx_urb: submitting rx_urb %d failed\n", result); + return STATUS_FAILURE; + } + + //DEBUG("ft1000_submit_rx_urb exit: result=%d\n", result); + + return STATUS_SUCCESS; +} + +//--------------------------------------------------------------------------- +// Function: ft1000_open +// +// Parameters: +// dev - network device +// +// +// Returns: none +// +// Description: open the network driver +// +// Notes: +// +//--------------------------------------------------------------------------- +static int ft1000_open (struct net_device *dev) +{ + struct ft1000_info *pInfo = (struct ft1000_info *)netdev_priv(dev); + struct timeval tv; //mbelian + + DEBUG("ft1000_open is called for card %d\n", pInfo->CardNumber); + //DEBUG("ft1000_open: dev->addr=%x, dev->addr_len=%d\n", dev->addr, dev->addr_len); + + pInfo->stats.rx_bytes = 0; //mbelian + pInfo->stats.tx_bytes = 0; //mbelian + pInfo->stats.rx_packets = 0; //mbelian + pInfo->stats.tx_packets = 0; //mbelian + do_gettimeofday(&tv); + pInfo->ConTm = tv.tv_sec; + pInfo->ProgConStat = 0; //mbelian + + + netif_start_queue(dev); + + netif_carrier_on(dev); //mbelian + + ft1000_submit_rx_urb(pInfo); + return 0; +} + +//--------------------------------------------------------------------------- +// Function: ft1000_close +// +// Parameters: +// net - network device +// +// +// Returns: none +// +// Description: close the network driver +// +// Notes: +// +//--------------------------------------------------------------------------- +int ft1000_close(struct net_device *net) +{ + struct ft1000_info *pInfo = (struct ft1000_info *) netdev_priv(net); + struct ft1000_device *ft1000dev = pInfo->pFt1000Dev; + + //DEBUG ("ft1000_close: netdev->refcnt=%d\n", net->refcnt); + + ft1000dev->status |= FT1000_STATUS_CLOSING; + + //DEBUG("ft1000_close: calling usb_kill_urb \n"); + + DEBUG("ft1000_close: pInfo=%p, ft1000dev=%p\n", pInfo, ft1000dev); + netif_carrier_off(net);//mbelian + netif_stop_queue(net); + //DEBUG("ft1000_close: netif_stop_queue called\n"); + ft1000dev->status &= ~FT1000_STATUS_CLOSING; + + pInfo->ProgConStat = 0xff; //mbelian + + + return 0; +} + +static struct net_device_stats *ft1000_netdev_stats(struct net_device *dev) +{ + struct ft1000_info *info = (struct ft1000_info *) netdev_priv(dev); + + return &(info->stats); //mbelian +} + + +/********************************************************************************* +Jim +*/ + + +//--------------------------------------------------------------------------- +// +// Function: ft1000_chkcard +// Descripton: This function will check if the device is presently available on +// the system. +// Input: +// dev - device structure +// Output: +// status - FALSE (device is not present) +// TRUE (device is present) +// +//--------------------------------------------------------------------------- +static int ft1000_chkcard (struct ft1000_device *dev) { + u16 tempword; + u16 status; + struct ft1000_info *info = (struct ft1000_info *) netdev_priv(dev->net); + + if (info->fCondResetPend) + { + DEBUG("ft1000_hw:ft1000_chkcard:Card is being reset, return FALSE\n"); + return TRUE; + } + + // Mask register is used to check for device presence since it is never + // set to zero. + status = ft1000_read_register(dev, &tempword, FT1000_REG_SUP_IMASK); + //DEBUG("ft1000_hw:ft1000_chkcard: read FT1000_REG_SUP_IMASK = %x\n", tempword); + if (tempword == 0) { + DEBUG("ft1000_hw:ft1000_chkcard: IMASK = 0 Card not detected\n"); + return FALSE; + } + + // The system will return the value of 0xffff for the version register + // if the device is not present. + status = ft1000_read_register(dev, &tempword, FT1000_REG_ASIC_ID); + //DEBUG("ft1000_hw:ft1000_chkcard: read FT1000_REG_ASIC_ID = %x\n", tempword); + if (tempword != 0x1b01 ){ + dev->status |= FT1000_STATUS_CLOSING; //mbelian + DEBUG("ft1000_hw:ft1000_chkcard: Version = 0xffff Card not detected\n"); + return FALSE; + } + return TRUE; +} + + + +//--------------------------------------------------------------------------- +// +// Function: ft1000_receive_cmd +// Descripton: This function will read a message from the dpram area. +// Input: +// dev - network device structure +// pbuffer - caller supply address to buffer +// pnxtph - pointer to next pseudo header +// Output: +// Status = 0 (unsuccessful) +// = 1 (successful) +// +//--------------------------------------------------------------------------- +static BOOLEAN ft1000_receive_cmd (struct ft1000_device *dev, u16 *pbuffer, int maxsz, u16 *pnxtph) { + u16 size, ret; + u16 *ppseudohdr; + int i; + u16 tempword; + + ret = ft1000_read_dpram16(dev, FT1000_MAG_PH_LEN, (PUCHAR)&size, FT1000_MAG_PH_LEN_INDX); + size = ntohs(size) + PSEUDOSZ; + if (size > maxsz) { + DEBUG("FT1000:ft1000_receive_cmd:Invalid command length = %d\n", size); + return FALSE; + } + else { + ppseudohdr = (u16 *)pbuffer; + ft1000_write_register(dev, FT1000_DPRAM_MAG_RX_BASE, FT1000_REG_DPRAM_ADDR); + ret = ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAH); + //DEBUG("ft1000_hw:received data = 0x%x\n", *pbuffer); + pbuffer++; + ft1000_write_register(dev, FT1000_DPRAM_MAG_RX_BASE+1, FT1000_REG_DPRAM_ADDR); + for (i=0; i<=(size>>2); i++) { + ret = ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAL); + pbuffer++; + ret = ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAH); + pbuffer++; + } + //copy odd aligned word + ret = ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAL); + //DEBUG("ft1000_hw:received data = 0x%x\n", *pbuffer); + pbuffer++; + ret = ft1000_read_register(dev, pbuffer, FT1000_REG_MAG_DPDATAH); + //DEBUG("ft1000_hw:received data = 0x%x\n", *pbuffer); + pbuffer++; + if (size & 0x0001) { + //copy odd byte from fifo + ret = ft1000_read_register(dev, &tempword, FT1000_REG_DPRAM_DATA); + *pbuffer = ntohs(tempword); + } + + // Check if pseudo header checksum is good + // Calculate pseudo header checksum + tempword = *ppseudohdr++; + for (i=1; i<7; i++) { + tempword ^= *ppseudohdr++; + } + if ( (tempword != *ppseudohdr) ) { + return FALSE; + } + + return TRUE; + } +} + + +static int ft1000_dsp_prov(void *arg) +{ + struct ft1000_device *dev = (struct ft1000_device *)arg; + struct ft1000_info *info = (struct ft1000_info *) netdev_priv(dev->net); + u16 tempword; + u16 len; + u16 i=0; + struct prov_record *ptr; + struct pseudo_hdr *ppseudo_hdr; + PUSHORT pmsg; + u16 status; + USHORT TempShortBuf [256]; + + DEBUG("*** DspProv Entered\n"); + + while (list_empty(&info->prov_list) == 0) + { + DEBUG("DSP Provisioning List Entry\n"); + + // Check if doorbell is available + DEBUG("check if doorbell is cleared\n"); + status = ft1000_read_register (dev, &tempword, FT1000_REG_DOORBELL); + if (status) + { + DEBUG("ft1000_dsp_prov::ft1000_read_register error\n"); + break; + } + + while (tempword & FT1000_DB_DPRAM_TX) { + mdelay(10); + i++; + if (i==10) { + DEBUG("FT1000:ft1000_dsp_prov:message drop\n"); + return STATUS_FAILURE; + } + ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); + } + + if ( !(tempword & FT1000_DB_DPRAM_TX) ) { + DEBUG("*** Provision Data Sent to DSP\n"); + + // Send provisioning data + ptr = list_entry(info->prov_list.next, struct prov_record, list); + len = *(u16 *)ptr->pprov_data; + len = htons(len); + len += PSEUDOSZ; + + pmsg = (PUSHORT)ptr->pprov_data; + ppseudo_hdr = (struct pseudo_hdr *)pmsg; + // Insert slow queue sequence number + ppseudo_hdr->seq_num = info->squeseqnum++; + ppseudo_hdr->portsrc = 0; + // Calculate new checksum + ppseudo_hdr->checksum = *pmsg++; + //DEBUG("checksum = 0x%x\n", ppseudo_hdr->checksum); + for (i=1; i<7; i++) { + ppseudo_hdr->checksum ^= *pmsg++; + //DEBUG("checksum = 0x%x\n", ppseudo_hdr->checksum); + } + + TempShortBuf[0] = 0; + TempShortBuf[1] = htons (len); + memcpy(&TempShortBuf[2], ppseudo_hdr, len); + + status = ft1000_write_dpram32 (dev, 0, (PUCHAR)&TempShortBuf[0], (unsigned short)(len+2)); + status = ft1000_write_register (dev, FT1000_DB_DPRAM_TX, FT1000_REG_DOORBELL); + + list_del(&ptr->list); + kfree(ptr->pprov_data); + kfree(ptr); + } + msleep(10); + } + + DEBUG("DSP Provisioning List Entry finished\n"); + + msleep(100); + + info->fProvComplete = 1; + info->CardReady = 1; + return STATUS_SUCCESS; + +} + + +static int ft1000_proc_drvmsg (struct ft1000_device *dev, u16 size) { + struct ft1000_info *info = (struct ft1000_info *) netdev_priv(dev->net); + u16 msgtype; + u16 tempword; + struct media_msg *pmediamsg; + struct dsp_init_msg *pdspinitmsg; + struct drv_msg *pdrvmsg; + u16 i; + struct pseudo_hdr *ppseudo_hdr; + PUSHORT pmsg; + u16 status; + union { + u8 byte[2]; + u16 wrd; + } convert; + + + char *cmdbuffer = kmalloc(1600, GFP_KERNEL); + if (!cmdbuffer) + return STATUS_FAILURE; + + status = ft1000_read_dpram32(dev, 0x200, cmdbuffer, size); + + + +#ifdef JDEBUG + DEBUG("ft1000_proc_drvmsg:cmdbuffer\n"); + for(i = 0; i < size; i+=5) + { + if( (i + 5) < size ) + 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]); + else + { + for (j = i; j < size; j++) + DEBUG("0x%x ", cmdbuffer[j]); + DEBUG("\n"); + break; + } + } +#endif + pdrvmsg = (struct drv_msg *)&cmdbuffer[2]; + msgtype = ntohs(pdrvmsg->type); + DEBUG("ft1000_proc_drvmsg:Command message type = 0x%x\n", msgtype); + switch (msgtype) { + case MEDIA_STATE: { + DEBUG("ft1000_proc_drvmsg:Command message type = MEDIA_STATE"); + + pmediamsg = (struct media_msg *)&cmdbuffer[0]; + if (info->ProgConStat != 0xFF) { + if (pmediamsg->state) { + DEBUG("Media is up\n"); + if (info->mediastate == 0) { + if ( info->NetDevRegDone ) + { + //netif_carrier_on(dev->net);//mbelian + netif_wake_queue(dev->net); + } + info->mediastate = 1; + /*do_gettimeofday(&tv); + info->ConTm = tv.tv_sec;*/ //mbelian + } + } + else { + DEBUG("Media is down\n"); + if (info->mediastate == 1) { + info->mediastate = 0; + if ( info->NetDevRegDone ) + { + //netif_carrier_off(dev->net); mbelian + //netif_stop_queue(dev->net); + } + info->ConTm = 0; + } + } + } + else { + DEBUG("Media is down\n"); + if (info->mediastate == 1) { + info->mediastate = 0; + if ( info->NetDevRegDone) + { + //netif_carrier_off(dev->net); //mbelian + //netif_stop_queue(dev->net); + } + info->ConTm = 0; + } + } + break; + } + case DSP_INIT_MSG: { + DEBUG("ft1000_proc_drvmsg:Command message type = DSP_INIT_MSG"); + + pdspinitmsg = (struct dsp_init_msg *)&cmdbuffer[2]; + memcpy(info->DspVer, pdspinitmsg->DspVer, DSPVERSZ); + DEBUG("DSPVER = 0x%2x 0x%2x 0x%2x 0x%2x\n", info->DspVer[0], info->DspVer[1], info->DspVer[2], info->DspVer[3]); + memcpy(info->HwSerNum, pdspinitmsg->HwSerNum, HWSERNUMSZ); + memcpy(info->Sku, pdspinitmsg->Sku, SKUSZ); + memcpy(info->eui64, pdspinitmsg->eui64, EUISZ); + 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]); + dev->net->dev_addr[0] = info->eui64[0]; + dev->net->dev_addr[1] = info->eui64[1]; + dev->net->dev_addr[2] = info->eui64[2]; + dev->net->dev_addr[3] = info->eui64[5]; + dev->net->dev_addr[4] = info->eui64[6]; + dev->net->dev_addr[5] = info->eui64[7]; + + if (ntohs(pdspinitmsg->length) == (sizeof(struct dsp_init_msg) - 20)) { + memcpy(info->ProductMode, pdspinitmsg->ProductMode, MODESZ); + memcpy(info->RfCalVer, pdspinitmsg->RfCalVer, CALVERSZ); + memcpy(info->RfCalDate, pdspinitmsg->RfCalDate, CALDATESZ); + DEBUG("RFCalVer = 0x%2x 0x%2x\n", info->RfCalVer[0], info->RfCalVer[1]); + } + break; + } + case DSP_PROVISION: { + DEBUG("ft1000_proc_drvmsg:Command message type = DSP_PROVISION\n"); + + // kick off dspprov routine to start provisioning + // Send provisioning data to DSP + if (list_empty(&info->prov_list) == 0) + { + info->fProvComplete = 0; + status = ft1000_dsp_prov(dev); + if (status != STATUS_SUCCESS) + goto out; + } + else { + info->fProvComplete = 1; + status = ft1000_write_register (dev, FT1000_DB_HB, FT1000_REG_DOORBELL); + DEBUG("FT1000:drivermsg:No more DSP provisioning data in dsp image\n"); + } + DEBUG("ft1000_proc_drvmsg:DSP PROVISION is done\n"); + break; + } + case DSP_STORE_INFO: { + DEBUG("ft1000_proc_drvmsg:Command message type = DSP_STORE_INFO"); + + DEBUG("FT1000:drivermsg:Got DSP_STORE_INFO\n"); + tempword = ntohs(pdrvmsg->length); + info->DSPInfoBlklen = tempword; + if (tempword < (MAX_DSP_SESS_REC-4) ) { + pmsg = (PUSHORT)&pdrvmsg->data[0]; + for (i=0; i<((tempword+1)/2); i++) { + DEBUG("FT1000:drivermsg:dsp info data = 0x%x\n", *pmsg); + info->DSPInfoBlk[i+10] = *pmsg++; + } + } + else { + info->DSPInfoBlklen = 0; + } + break; + } + case DSP_GET_INFO: { + DEBUG("FT1000:drivermsg:Got DSP_GET_INFO\n"); + // copy dsp info block to dsp + info->DrvMsgPend = 1; + // allow any outstanding ioctl to finish + mdelay(10); + status = ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); + if (tempword & FT1000_DB_DPRAM_TX) { + mdelay(10); + status = ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); + if (tempword & FT1000_DB_DPRAM_TX) { + mdelay(10); + status = ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); + if (tempword & FT1000_DB_DPRAM_TX) { + break; + } + } + } + + // Put message into Slow Queue + // Form Pseudo header + pmsg = (PUSHORT)info->DSPInfoBlk; + *pmsg++ = 0; + *pmsg++ = htons(info->DSPInfoBlklen+20+info->DSPInfoBlklen); + ppseudo_hdr = (struct pseudo_hdr *)(PUSHORT)&info->DSPInfoBlk[2]; + ppseudo_hdr->length = htons(info->DSPInfoBlklen+4+info->DSPInfoBlklen); + ppseudo_hdr->source = 0x10; + ppseudo_hdr->destination = 0x20; + ppseudo_hdr->portdest = 0; + ppseudo_hdr->portsrc = 0; + ppseudo_hdr->sh_str_id = 0; + ppseudo_hdr->control = 0; + ppseudo_hdr->rsvd1 = 0; + ppseudo_hdr->rsvd2 = 0; + ppseudo_hdr->qos_class = 0; + // Insert slow queue sequence number + ppseudo_hdr->seq_num = info->squeseqnum++; + // Insert application id + ppseudo_hdr->portsrc = 0; + // Calculate new checksum + ppseudo_hdr->checksum = *pmsg++; + for (i=1; i<7; i++) { + ppseudo_hdr->checksum ^= *pmsg++; + } + info->DSPInfoBlk[10] = 0x7200; + info->DSPInfoBlk[11] = htons(info->DSPInfoBlklen); + status = ft1000_write_dpram32 (dev, 0, (PUCHAR)&info->DSPInfoBlk[0], (unsigned short)(info->DSPInfoBlklen+22)); + status = ft1000_write_register (dev, FT1000_DB_DPRAM_TX, FT1000_REG_DOORBELL); + info->DrvMsgPend = 0; + + break; + } + + case GET_DRV_ERR_RPT_MSG: { + DEBUG("FT1000:drivermsg:Got GET_DRV_ERR_RPT_MSG\n"); + // copy driver error message to dsp + info->DrvMsgPend = 1; + // allow any outstanding ioctl to finish + mdelay(10); + status = ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); + if (tempword & FT1000_DB_DPRAM_TX) { + mdelay(10); + status = ft1000_read_register(dev, &tempword, FT1000_REG_DOORBELL); + if (tempword & FT1000_DB_DPRAM_TX) { + mdelay(10); + } + } + + if ( (tempword & FT1000_DB_DPRAM_TX) == 0) { + // Put message into Slow Queue + // Form Pseudo header + pmsg = (PUSHORT)&tempbuffer[0]; + ppseudo_hdr = (struct pseudo_hdr *)pmsg; + ppseudo_hdr->length = htons(0x0012); + ppseudo_hdr->source = 0x10; + ppseudo_hdr->destination = 0x20; + ppseudo_hdr->portdest = 0; + ppseudo_hdr->portsrc = 0; + ppseudo_hdr->sh_str_id = 0; + ppseudo_hdr->control = 0; + ppseudo_hdr->rsvd1 = 0; + ppseudo_hdr->rsvd2 = 0; + ppseudo_hdr->qos_class = 0; + // Insert slow queue sequence number + ppseudo_hdr->seq_num = info->squeseqnum++; + // Insert application id + ppseudo_hdr->portsrc = 0; + // Calculate new checksum + ppseudo_hdr->checksum = *pmsg++; + for (i=1; i<7; i++) { + ppseudo_hdr->checksum ^= *pmsg++; + } + pmsg = (PUSHORT)&tempbuffer[16]; + *pmsg++ = htons(RSP_DRV_ERR_RPT_MSG); + *pmsg++ = htons(0x000e); + *pmsg++ = htons(info->DSP_TIME[0]); + *pmsg++ = htons(info->DSP_TIME[1]); + *pmsg++ = htons(info->DSP_TIME[2]); + *pmsg++ = htons(info->DSP_TIME[3]); + convert.byte[0] = info->DspVer[0]; + convert.byte[1] = info->DspVer[1]; + *pmsg++ = convert.wrd; + convert.byte[0] = info->DspVer[2]; + convert.byte[1] = info->DspVer[3]; + *pmsg++ = convert.wrd; + *pmsg++ = htons(info->DrvErrNum); + + CardSendCommand (dev, (unsigned char*)&tempbuffer[0], (USHORT)(0x0012 + PSEUDOSZ)); + info->DrvErrNum = 0; + } + info->DrvMsgPend = 0; + + break; + } + + default: + break; + } + + + status = STATUS_SUCCESS; +out: + kfree(cmdbuffer); + DEBUG("return from ft1000_proc_drvmsg\n"); + return status; +} + + + +int ft1000_poll(void* dev_id) { + + struct ft1000_device *dev = (struct ft1000_device *)dev_id; + struct ft1000_info *info = (struct ft1000_info *) netdev_priv(dev->net); + + u16 tempword; + u16 status; + u16 size; + int i; + USHORT data; + USHORT modulo; + USHORT portid; + u16 nxtph; + struct dpram_blk *pdpram_blk; + struct pseudo_hdr *ppseudo_hdr; + unsigned long flags; + + //DEBUG("Enter ft1000_poll...\n"); + if (ft1000_chkcard(dev) == FALSE) { + DEBUG("ft1000_poll::ft1000_chkcard: failed\n"); + return STATUS_FAILURE; + } + + status = ft1000_read_register (dev, &tempword, FT1000_REG_DOORBELL); + // DEBUG("ft1000_poll: read FT1000_REG_DOORBELL message 0x%x\n", tempword); + + if ( !status ) + { + + if (tempword & FT1000_DB_DPRAM_RX) { + //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX\n"); + + status = ft1000_read_dpram16(dev, 0x200, (PUCHAR)&data, 0); + //DEBUG("ft1000_poll:FT1000_DB_DPRAM_RX:ft1000_read_dpram16:size = 0x%x\n", data); + size = ntohs(data) + 16 + 2; //wai + if (size % 4) { + modulo = 4 - (size % 4); + size = size + modulo; + } + status = ft1000_read_dpram16(dev, 0x201, (PUCHAR)&portid, 1); + portid &= 0xff; + //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid 0x%x\n", portid); + + if (size < MAX_CMD_SQSIZE) { + switch (portid) + { + case DRIVERID: + DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid DRIVERID\n"); + + status = ft1000_proc_drvmsg (dev, size); + if (status != STATUS_SUCCESS ) + return status; + break; + case DSPBCMSGID: + // This is a dsp broadcast message + // Check which application has registered for dsp broadcast messages + //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_DPRAM_RX : portid DSPBCMSGID\n"); + + for (i=0; i<MAX_NUM_APP; i++) { + if ( (info->app_info[i].DspBCMsgFlag) && (info->app_info[i].fileobject) && + (info->app_info[i].NumOfMsg < MAX_MSG_LIMIT) ) + { + //DEBUG("Dsp broadcast message detected for app id %d\n", i); + nxtph = FT1000_DPRAM_RX_BASE + 2; + pdpram_blk = ft1000_get_buffer (&freercvpool); + if (pdpram_blk != NULL) { + if ( ft1000_receive_cmd(dev, pdpram_blk->pbuffer, MAX_CMD_SQSIZE, &nxtph) ) { + ppseudo_hdr = (struct pseudo_hdr *)pdpram_blk->pbuffer; + // Put message into the appropriate application block + info->app_info[i].nRxMsg++; + spin_lock_irqsave(&free_buff_lock, flags); + list_add_tail(&pdpram_blk->list, &info->app_info[i].app_sqlist); + info->app_info[i].NumOfMsg++; + spin_unlock_irqrestore(&free_buff_lock, flags); + wake_up_interruptible(&info->app_info[i].wait_dpram_msg); + } + else { + info->app_info[i].nRxMsgMiss++; + // Put memory back to free pool + ft1000_free_buffer(pdpram_blk, &freercvpool); + DEBUG("pdpram_blk::ft1000_get_buffer NULL\n"); + } + } + else { + DEBUG("Out of memory in free receive command pool\n"); + info->app_info[i].nRxMsgMiss++; + }//endof if (pdpram_blk != NULL) + }//endof if + //else + // DEBUG("app_info mismatch\n"); + }// endof for + break; + default: + pdpram_blk = ft1000_get_buffer (&freercvpool); + //DEBUG("Memory allocated = 0x%8x\n", (u32)pdpram_blk); + if (pdpram_blk != NULL) { + if ( ft1000_receive_cmd(dev, pdpram_blk->pbuffer, MAX_CMD_SQSIZE, &nxtph) ) { + ppseudo_hdr = (struct pseudo_hdr *)pdpram_blk->pbuffer; + // Search for correct application block + for (i=0; i<MAX_NUM_APP; i++) { + if (info->app_info[i].app_id == ppseudo_hdr->portdest) { + break; + } + } + + if (i == MAX_NUM_APP) { + DEBUG("FT1000:ft1000_parse_dpram_msg: No application matching id = %d\n", ppseudo_hdr->portdest); + // Put memory back to free pool + ft1000_free_buffer(pdpram_blk, &freercvpool); + } + else { + if (info->app_info[i].NumOfMsg > MAX_MSG_LIMIT) { + // Put memory back to free pool + ft1000_free_buffer(pdpram_blk, &freercvpool); + } + else { + info->app_info[i].nRxMsg++; + // Put message into the appropriate application block + //pxu spin_lock_irqsave(&free_buff_lock, flags); + list_add_tail(&pdpram_blk->list, &info->app_info[i].app_sqlist); + info->app_info[i].NumOfMsg++; + //pxu spin_unlock_irqrestore(&free_buff_lock, flags); + //pxu wake_up_interruptible(&info->app_info[i].wait_dpram_msg); + } + } + } + else { + // Put memory back to free pool + ft1000_free_buffer(pdpram_blk, &freercvpool); + } + } + else { + DEBUG("Out of memory in free receive command pool\n"); + } + break; + } //end of switch + } //endof if (size < MAX_CMD_SQSIZE) + else { + DEBUG("FT1000:dpc:Invalid total length for SlowQ = %d\n", size); + } + status = ft1000_write_register (dev, FT1000_DB_DPRAM_RX, FT1000_REG_DOORBELL); + } + else if (tempword & FT1000_DSP_ASIC_RESET) { + //DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DSP_ASIC_RESET\n"); + + // Let's reset the ASIC from the Host side as well + status = ft1000_write_register (dev, ASIC_RESET_BIT, FT1000_REG_RESET); + status = ft1000_read_register (dev, &tempword, FT1000_REG_RESET); + i = 0; + while (tempword & ASIC_RESET_BIT) { + status = ft1000_read_register (dev, &tempword, FT1000_REG_RESET); + msleep(10); + i++; + if (i==100) + break; + } + if (i==100) { + DEBUG("Unable to reset ASIC\n"); + return STATUS_SUCCESS; + } + msleep(10); + // Program WMARK register + status = ft1000_write_register (dev, 0x600, FT1000_REG_MAG_WATERMARK); + // clear ASIC reset doorbell + status = ft1000_write_register (dev, FT1000_DSP_ASIC_RESET, FT1000_REG_DOORBELL); + msleep(10); + } + else if (tempword & FT1000_ASIC_RESET_REQ) { + DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_ASIC_RESET_REQ\n"); + + // clear ASIC reset request from DSP + status = ft1000_write_register (dev, FT1000_ASIC_RESET_REQ, FT1000_REG_DOORBELL); + status = ft1000_write_register (dev, HOST_INTF_BE, FT1000_REG_SUP_CTRL); + // copy dsp session record from Adapter block + status = ft1000_write_dpram32 (dev, 0, (PUCHAR)&info->DSPSess.Rec[0], 1024); + // Program WMARK register + status = ft1000_write_register (dev, 0x600, FT1000_REG_MAG_WATERMARK); + // ring doorbell to tell DSP that ASIC is out of reset + status = ft1000_write_register (dev, FT1000_ASIC_RESET_DSP, FT1000_REG_DOORBELL); + } + else if (tempword & FT1000_DB_COND_RESET) { + DEBUG("ft1000_poll: FT1000_REG_DOORBELL message type: FT1000_DB_COND_RESET\n"); +//By Jim +// Reset ASIC and DSP +//MAG + if (info->fAppMsgPend == 0) { + // Reset ASIC and DSP + + status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER0, (PUCHAR)&(info->DSP_TIME[0]), FT1000_MAG_DSP_TIMER0_INDX); + status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER1, (PUCHAR)&(info->DSP_TIME[1]), FT1000_MAG_DSP_TIMER1_INDX); + status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER2, (PUCHAR)&(info->DSP_TIME[2]), FT1000_MAG_DSP_TIMER2_INDX); + status = ft1000_read_dpram16(dev, FT1000_MAG_DSP_TIMER3, (PUCHAR)&(info->DSP_TIME[3]), FT1000_MAG_DSP_TIMER3_INDX); + info->CardReady = 0; + info->DrvErrNum = DSP_CONDRESET_INFO; + DEBUG("ft1000_hw:DSP conditional reset requested\n"); + info->ft1000_reset(dev->net); + } + else { + info->fProvComplete = 0; + info->fCondResetPend = 1; + } + + ft1000_write_register(dev, FT1000_DB_COND_RESET, FT1000_REG_DOORBELL); + } + + }//endof if ( !status ) + + //DEBUG("return from ft1000_poll.\n"); + return STATUS_SUCCESS; + +} + +/*end of Jim*/ |