//--------------------------------------------------------------------------- // FT1000 driver for Flarion Flash OFDM NIC Device // // Copyright (C) 2006 Flarion Technologies, All rights reserved. // // This program is free software; you can redistribute it and/or modify it // under the terms of the GNU General Public License as published by the Free // Software Foundation; either version 2 of the License, or (at your option) any // later version. This program is distributed in the hope that it will be useful, // but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY // or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for // more details. You should have received a copy of the GNU General Public // License along with this program; if not, write to the // Free Software Foundation, Inc., 59 Temple Place - // Suite 330, Boston, MA 02111-1307, USA. //--------------------------------------------------------------------------- // // File: ft1000_chdev.c // // Description: Custom character device dispatch routines. // // History: // 8/29/02 Whc Ported to Linux. // 6/05/06 Whc Porting to Linux 2.6.9 // //--------------------------------------------------------------------------- #include #include #include #include #include #include #include #include #include #include #include #include #include "ft1000_usb.h" //#include "ft1000_ioctl.h" static int ft1000_flarion_cnt = 0; //need to looking usage of ft1000Handle static int ft1000_ChOpen (struct inode *Inode, struct file *File); static unsigned int ft1000_ChPoll(struct file *file, poll_table *wait); static long ft1000_ChIoctl(struct file *File, unsigned int Command, unsigned long Argument); static int ft1000_ChRelease (struct inode *Inode, struct file *File); // Global pointer to device object static struct ft1000_device *pdevobj[MAX_NUM_CARDS + 2]; //static devfs_handle_t ft1000Handle[MAX_NUM_CARDS]; // List to free receive command buffer pool struct list_head freercvpool; // lock to arbitrate free buffer list for receive command data spinlock_t free_buff_lock; int numofmsgbuf = 0; // Global variable to indicate that all provisioning data is sent to DSP //BOOLEAN fProvComplete; // // Table of entry-point routines for char device // static struct file_operations ft1000fops = { .unlocked_ioctl = ft1000_ChIoctl, .poll = ft1000_ChPoll, .open = ft1000_ChOpen, .release = ft1000_ChRelease, .llseek = no_llseek, }; //--------------------------------------------------------------------------- // Function: exec_mknod // // Parameters: // // Returns: // // Description: // // Notes: // //--------------------------------------------------------------------------- static int exec_mknod (void *pdata) { struct ft1000_info *info; char mjnum[4]; char minornum[4]; char temp[32]; int retcode; // int i; //aelias [-] reason : unused variable char *envp[] = { "HOME=/", "PATH=/usr/bin:/bin", NULL }; char *argv[]={"-m 666",temp,"c",mjnum,minornum,NULL}; info = pdata; DEBUG("ft1000_chdev:exec_mknod is called with major number = %d\n", info->DeviceMajor); sprintf(temp, "%s%s", "/dev/", info->DeviceName) ; sprintf(mjnum, "%d", info->DeviceMajor); sprintf(minornum, "%d", info->CardNumber); //char *argv[]={"mknod","-m 666",temp,"c",mjnum,minornum,NULL}; // char *argv[]={"-m 666",temp,"c",mjnum,minornum,NULL}; //for (i=0; i<7;i++) // DEBUG("argv[%d]=%s\n", i, argv[i]); retcode = call_usermodehelper ("/bin/mknod", argv, envp, 1); if (retcode) { DEBUG("ft1000_chdev:exec_mknod failed to make the node: retcode = %d\n", retcode); } return retcode; } //--------------------------------------------------------------------------- // Function: rm_mknod // // Description: This module removes the FT1000 device file // //--------------------------------------------------------------------------- static int rm_mknod (void *pdata) { struct ft1000_info *info; //char *argv[4]={"rm", "-f", "/dev/FT1000", NULL}; int retcode; char temp[32]; char *argv[]={"rm", "-f", temp, NULL}; info = (struct ft1000_info *)pdata; DEBUG("ft1000_chdev:rm_mknod is called for device %s\n", info->DeviceName); sprintf(temp, "%s%s", "/dev/", info->DeviceName) ; // char *argv[]={"rm", "-f", temp, NULL}; retcode = call_usermodehelper ("/bin/rm", argv, NULL, 1); if (retcode) { DEBUG("ft1000_chdev:rm_mknod failed to remove the node: retcode = %d\n", retcode); } else DEBUG("ft1000_chdev:rm_mknod done!\n"); return retcode; } //--------------------------------------------------------------------------- // Function: ft1000_get_buffer // // Parameters: // // Returns: // // Description: // // Notes: // //--------------------------------------------------------------------------- struct dpram_blk *ft1000_get_buffer(struct list_head *bufflist) { unsigned long flags; struct dpram_blk *ptr; spin_lock_irqsave(&free_buff_lock, flags); // Check if buffer is available if ( list_empty(bufflist) ) { DEBUG("ft1000_get_buffer: No more buffer - %d\n", numofmsgbuf); ptr = NULL; } else { numofmsgbuf--; ptr = list_entry(bufflist->next, struct dpram_blk, list); list_del(&ptr->list); //DEBUG("ft1000_get_buffer: number of free msg buffers = %d\n", numofmsgbuf); } spin_unlock_irqrestore(&free_buff_lock, flags); return ptr; } //--------------------------------------------------------------------------- // Function: ft1000_free_buffer // // Parameters: // // Returns: // // Description: // // Notes: // //--------------------------------------------------------------------------- void ft1000_free_buffer(struct dpram_blk *pdpram_blk, struct list_head *plist) { unsigned long flags; spin_lock_irqsave(&free_buff_lock, flags); // Put memory back to list list_add_tail(&pdpram_blk->list, plist); numofmsgbuf++; //DEBUG("ft1000_free_buffer: number of free msg buffers = %d\n", numofmsgbuf); spin_unlock_irqrestore(&free_buff_lock, flags); } //--------------------------------------------------------------------------- // Function: ft1000_CreateDevice // // Parameters: dev - pointer to adapter object // // Returns: 0 if successful // // Description: Creates a private char device. // // Notes: Only called by init_module(). // //--------------------------------------------------------------------------- int ft1000_CreateDevice(struct ft1000_device *dev) { struct ft1000_info *info = netdev_priv(dev->net); int result; int i; pid_t pid; // make a new device name sprintf(info->DeviceName, "%s%d", "FT100", info->CardNumber); // Delete any existing FT1000 node pid = kernel_thread (rm_mknod,(void *)info, 0); msleep(1000); DEBUG("ft1000_CreateDevice: number of instance = %d\n", ft1000_flarion_cnt); DEBUG("DeviceCreated = %x\n", info->DeviceCreated); //save the device info to global array pdevobj[info->CardNumber] = dev; DEBUG("ft1000_CreateDevice: ******SAVED pdevobj[%d]=%p\n", info->CardNumber, pdevobj[info->CardNumber]); //aelias [+] reason:up if (info->DeviceCreated) { DEBUG("ft1000_CreateDevice: \"%s\" already registered\n", info->DeviceName); return -EIO; } // register the device DEBUG("ft1000_CreateDevice: \"%s\" device registration\n", info->DeviceName); info->DeviceMajor = 0; result = register_chrdev(info->DeviceMajor, info->DeviceName, &ft1000fops); if (result < 0) { DEBUG("ft1000_CreateDevice: unable to get major %d\n", info->DeviceMajor); return result; } DEBUG("ft1000_CreateDevice: registered char device \"%s\"\n", info->DeviceName); // save a dynamic device major number if (info->DeviceMajor == 0) { info->DeviceMajor = result; DEBUG("ft1000_PcdCreateDevice: device major = %d\n", info->DeviceMajor); } // Create a thread to call user mode app to mknod pid = kernel_thread (exec_mknod, (void *)info, 0); // initialize application information info->appcnt = 0; // if (ft1000_flarion_cnt == 0) { // // 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; ipbuffer = kmalloc ( MAX_CMD_SQSIZE, GFP_KERNEL ); // // link provisioning data // list_add_tail (&pdpram_blk->list, &freercvpool); // } // numofmsgbuf = NUM_OF_FREE_BUFFERS; // } // initialize application information info->appcnt = 0; for (i=0; iapp_info[i].nTxMsg = 0; info->app_info[i].nRxMsg = 0; info->app_info[i].nTxMsgReject = 0; info->app_info[i].nRxMsgMiss = 0; info->app_info[i].fileobject = NULL; info->app_info[i].app_id = i+1; info->app_info[i].DspBCMsgFlag = 0; info->app_info[i].NumOfMsg = 0; init_waitqueue_head(&info->app_info[i].wait_dpram_msg); INIT_LIST_HEAD (&info->app_info[i].app_sqlist); } // ft1000Handle[info->CardNumber] = devfs_register(NULL, info->DeviceName, DEVFS_FL_AUTO_DEVNUM, 0, 0, // S_IFCHR | S_IRUGO | S_IWUGO, &ft1000fops, NULL); info->DeviceCreated = TRUE; ft1000_flarion_cnt++; return result; } //--------------------------------------------------------------------------- // Function: ft1000_DestroyDeviceDEBUG // // Parameters: dev - pointer to adapter object // // Description: Destroys a private char device. // // Notes: Only called by cleanup_module(). // //--------------------------------------------------------------------------- void ft1000_DestroyDevice(struct net_device *dev) { struct ft1000_info *info = netdev_priv(dev); int result = 0; pid_t pid; int i; struct dpram_blk *pdpram_blk; struct dpram_blk *ptr; DEBUG("ft1000_chdev:ft1000_DestroyDevice called\n"); if (info->DeviceCreated) { ft1000_flarion_cnt--; unregister_chrdev(info->DeviceMajor, info->DeviceName); DEBUG("ft1000_DestroyDevice: unregistered device \"%s\", result = %d\n", info->DeviceName, result); pid = kernel_thread (rm_mknod, (void *)info, 0); // Make sure we free any memory reserve for slow Queue for (i=0; iapp_info[i].app_sqlist) == 0) { pdpram_blk = list_entry(info->app_info[i].app_sqlist.next, struct dpram_blk, list); list_del(&pdpram_blk->list); ft1000_free_buffer(pdpram_blk, &freercvpool); } wake_up_interruptible(&info->app_info[i].wait_dpram_msg); } // Remove buffer allocated for receive command data if (ft1000_flarion_cnt == 0) { while (list_empty(&freercvpool) == 0) { ptr = list_entry(freercvpool.next, struct dpram_blk, list); list_del(&ptr->list); kfree(ptr->pbuffer); kfree(ptr); } } // devfs_unregister(ft1000Handle[info->CardNumber]); info->DeviceCreated = FALSE; pdevobj[info->CardNumber] = NULL; } } //--------------------------------------------------------------------------- // Function: ft1000_ChOpen // // Parameters: // // Description: // // Notes: // //--------------------------------------------------------------------------- static int ft1000_ChOpen (struct inode *Inode, struct file *File) { struct ft1000_info *info; int i,num; DEBUG("ft1000_ChOpen called\n"); num = (MINOR(Inode->i_rdev) & 0xf); DEBUG("ft1000_ChOpen: minor number=%d\n", num); for (i=0; i<5; i++) DEBUG("pdevobj[%d]=%p\n", i, pdevobj[i]); //aelias [+] reason: down if ( pdevobj[num] != NULL ) //info = (struct ft1000_info *)(pdevobj[num]->net->priv); info = (struct ft1000_info *)netdev_priv(pdevobj[num]->net); else { DEBUG("ft1000_ChOpen: can not find device object %d\n", num); return -1; } DEBUG("f_owner = %p number of application = %d\n", (&File->f_owner), info->appcnt ); // Check if maximum number of application exceeded if (info->appcnt > MAX_NUM_APP) { DEBUG("Maximum number of application exceeded\n"); return -EACCES; } // Search for available application info block for (i=0; iapp_info[i].fileobject == NULL) ) { break; } } // Fail due to lack of application info block if (i == MAX_NUM_APP) { DEBUG("Could not find an application info block\n"); return -EACCES; } info->appcnt++; info->app_info[i].fileobject = &File->f_owner; info->app_info[i].nTxMsg = 0; info->app_info[i].nRxMsg = 0; info->app_info[i].nTxMsgReject = 0; info->app_info[i].nRxMsgMiss = 0; File->private_data = pdevobj[num]->net; nonseekable_open(Inode, File); return 0; } //--------------------------------------------------------------------------- // Function: ft1000_ChPoll // // Parameters: // // Description: // // Notes: // //--------------------------------------------------------------------------- static unsigned int ft1000_ChPoll(struct file *file, poll_table *wait) { struct net_device *dev = file->private_data; struct ft1000_info *info; int i; //DEBUG("ft1000_ChPoll called\n"); if (ft1000_flarion_cnt == 0) { DEBUG("FT1000:ft1000_ChPoll called when ft1000_flarion_cnt is zero\n"); return (-EBADF); } info = (struct ft1000_info *) netdev_priv(dev); // Search for matching file object for (i=0; iapp_info[i].fileobject == &file->f_owner) { //DEBUG("FT1000:ft1000_ChIoctl: Message is for AppId = %d\n", info->app_info[i].app_id); break; } } // Could not find application info block if (i == MAX_NUM_APP) { DEBUG("FT1000:ft1000_ChIoctl:Could not find application info block\n"); return ( -EACCES ); } if (list_empty(&info->app_info[i].app_sqlist) == 0) { DEBUG("FT1000:ft1000_ChPoll:Message detected in slow queue\n"); return(POLLIN | POLLRDNORM | POLLPRI); } poll_wait (file, &info->app_info[i].wait_dpram_msg, wait); //DEBUG("FT1000:ft1000_ChPoll:Polling for data from DSP\n"); return (0); } //--------------------------------------------------------------------------- // Function: ft1000_ChIoctl // // Parameters: // // Description: // // Notes: // //--------------------------------------------------------------------------- static long ft1000_ChIoctl (struct file *File, unsigned int Command, unsigned long Argument) { void __user *argp = (void __user *)Argument; struct net_device *dev; struct ft1000_info *info; struct ft1000_device *ft1000dev; int result=0; int cmd; int i; u16 tempword; unsigned long flags; struct timeval tv; IOCTL_GET_VER get_ver_data; IOCTL_GET_DSP_STAT get_stat_data; u8 ConnectionMsg[] = {0x00,0x44,0x10,0x20,0x80,0x00,0x00,0x00,0x00,0x00,0x03,0x00,0x00,0x00,0x93,0x64, 0x00,0x00,0x02,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x05,0x00,0x00,0x00,0x0a, 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x02,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x12,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00, 0x00,0x00,0x02,0x37,0x00,0x00,0x00,0x08,0x00,0x00,0x00,0x01,0x00,0x01,0x7f,0x00, 0x00,0x01,0x00,0x00}; unsigned short ledStat=0; unsigned short conStat=0; //DEBUG("ft1000_ChIoctl called\n"); if (ft1000_flarion_cnt == 0) { DEBUG("FT1000:ft1000_ChIoctl called when ft1000_flarion_cnt is zero\n"); return (-EBADF); } //DEBUG("FT1000:ft1000_ChIoctl:Command = 0x%x Argument = 0x%8x\n", Command, (u32)Argument); dev = File->private_data; info = (struct ft1000_info *) netdev_priv(dev); ft1000dev = info->pFt1000Dev; cmd = _IOC_NR(Command); //DEBUG("FT1000:ft1000_ChIoctl:cmd = 0x%x\n", cmd); // process the command switch (cmd) { case IOCTL_REGISTER_CMD: DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_REGISTER called\n"); result = get_user(tempword, (__u16 __user*)argp); if (result) { DEBUG("result = %d failed to get_user\n", result); break; } if (tempword == DSPBCMSGID) { // Search for matching file object for (i=0; iapp_info[i].fileobject == &File->f_owner) { info->app_info[i].DspBCMsgFlag = 1; DEBUG("FT1000:ft1000_ChIoctl:Registered for broadcast messages\n"); break; } } } break; case IOCTL_GET_VER_CMD: DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_GET_VER called\n"); get_ver_data.drv_ver = FT1000_DRV_VER; if (copy_to_user(argp, &get_ver_data, sizeof(get_ver_data)) ) { DEBUG("FT1000:ft1000_ChIoctl: copy fault occurred\n"); result = -EFAULT; break; } DEBUG("FT1000:ft1000_ChIoctl:driver version = 0x%x\n",(unsigned int)get_ver_data.drv_ver); break; case IOCTL_CONNECT: // Connect Message DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_CONNECT\n"); ConnectionMsg[79] = 0xfc; CardSendCommand(ft1000dev, (unsigned short *)ConnectionMsg, 0x4c); break; case IOCTL_DISCONNECT: // Disconnect Message DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_DISCONNECT\n"); ConnectionMsg[79] = 0xfd; CardSendCommand(ft1000dev, (unsigned short *)ConnectionMsg, 0x4c); break; case IOCTL_GET_DSP_STAT_CMD: //DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_GET_DSP_STAT called\n"); memset(&get_stat_data, 0, sizeof(get_stat_data)); memcpy(get_stat_data.DspVer, info->DspVer, DSPVERSZ); memcpy(get_stat_data.HwSerNum, info->HwSerNum, HWSERNUMSZ); memcpy(get_stat_data.Sku, info->Sku, SKUSZ); memcpy(get_stat_data.eui64, info->eui64, EUISZ); if (info->ProgConStat != 0xFF) { ft1000_read_dpram16(ft1000dev, FT1000_MAG_DSP_LED, (PUCHAR)&ledStat, FT1000_MAG_DSP_LED_INDX); get_stat_data.LedStat = ntohs(ledStat); DEBUG("FT1000:ft1000_ChIoctl: LedStat = 0x%x\n", get_stat_data.LedStat); ft1000_read_dpram16(ft1000dev, FT1000_MAG_DSP_CON_STATE, (PUCHAR)&conStat, FT1000_MAG_DSP_CON_STATE_INDX); get_stat_data.ConStat = ntohs(conStat); DEBUG("FT1000:ft1000_ChIoctl: ConStat = 0x%x\n", get_stat_data.ConStat); } else { get_stat_data.ConStat = 0x0f; } get_stat_data.nTxPkts = info->stats.tx_packets; get_stat_data.nRxPkts = info->stats.rx_packets; get_stat_data.nTxBytes = info->stats.tx_bytes; get_stat_data.nRxBytes = info->stats.rx_bytes; do_gettimeofday ( &tv ); get_stat_data.ConTm = (u32)(tv.tv_sec - info->ConTm); DEBUG("Connection Time = %d\n", (int)get_stat_data.ConTm); if (copy_to_user(argp, &get_stat_data, sizeof(get_stat_data)) ) { DEBUG("FT1000:ft1000_ChIoctl: copy fault occurred\n"); result = -EFAULT; break; } DEBUG("ft1000_chioctl: GET_DSP_STAT succeed\n"); break; case IOCTL_SET_DPRAM_CMD: { IOCTL_DPRAM_BLK *dpram_data; //IOCTL_DPRAM_COMMAND dpram_command; USHORT qtype; USHORT msgsz; struct pseudo_hdr *ppseudo_hdr; PUSHORT pmsg; USHORT total_len; USHORT app_index; u16 status; //DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_SET_DPRAM called\n"); if (ft1000_flarion_cnt == 0) { return (-EBADF); } if (info->DrvMsgPend) { return (-ENOTTY); } if ( (info->DspAsicReset) || (info->fProvComplete == 0) ) { return (-EACCES); } info->fAppMsgPend = 1; if (info->CardReady) { //DEBUG("FT1000:ft1000_ChIoctl: try to SET_DPRAM \n"); // Get the length field to see how many bytes to copy result = get_user(msgsz, (__u16 __user *)argp); msgsz = ntohs (msgsz); //DEBUG("FT1000:ft1000_ChIoctl: length of message = %d\n", msgsz); if (msgsz > MAX_CMD_SQSIZE) { DEBUG("FT1000:ft1000_ChIoctl: bad message length = %d\n", msgsz); result = -EINVAL; break; } result = -ENOMEM; dpram_data = kmalloc(msgsz + 2, GFP_KERNEL); if (!dpram_data) break; //if ( copy_from_user(&(dpram_command.dpram_blk), (PIOCTL_DPRAM_BLK)Argument, msgsz+2) ) { if ( copy_from_user(&dpram_data, argp, msgsz+2) ) { DEBUG("FT1000:ft1000_ChIoctl: copy fault occurred\n"); result = -EFAULT; } else { #if 0 // whc - for debugging only ptr = (char *)&dpram_data; for (i=0; iapp_info[i].fileobject == &File->f_owner) { break; } } if (i==MAX_NUM_APP) { DEBUG("FT1000:No matching application fileobject\n"); result = -EINVAL; kfree(dpram_data); break; } app_index = i; // Check message qtype type which is the lower byte within qos_class //qtype = ntohs(dpram_command.dpram_blk.pseudohdr.qos_class) & 0xff; qtype = ntohs(dpram_data->pseudohdr.qos_class) & 0xff; //DEBUG("FT1000_ft1000_ChIoctl: qtype = %d\n", qtype); if (qtype) { } else { // Put message into Slow Queue // Only put a message into the DPRAM if msg doorbell is available status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_DOORBELL); //DEBUG("FT1000_ft1000_ChIoctl: READ REGISTER tempword=%x\n", tempword); if (tempword & FT1000_DB_DPRAM_TX) { // Suspend for 2ms and try again due to DSP doorbell busy mdelay(2); status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_DOORBELL); if (tempword & FT1000_DB_DPRAM_TX) { // Suspend for 1ms and try again due to DSP doorbell busy mdelay(1); status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_DOORBELL); if (tempword & FT1000_DB_DPRAM_TX) { status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_DOORBELL); if (tempword & FT1000_DB_DPRAM_TX) { // Suspend for 3ms and try again due to DSP doorbell busy mdelay(3); status = ft1000_read_register(ft1000dev, &tempword, FT1000_REG_DOORBELL); if (tempword & FT1000_DB_DPRAM_TX) { DEBUG("FT1000:ft1000_ChIoctl:Doorbell not available\n"); result = -ENOTTY; kfree(dpram_data); break; } } } } } //DEBUG("FT1000_ft1000_ChIoctl: finished reading register\n"); // Make sure we are within the limits of the slow queue memory limitation if ( (msgsz < MAX_CMD_SQSIZE) && (msgsz > PSEUDOSZ) ) { // Need to put sequence number plus new checksum for message //pmsg = (PUSHORT)&dpram_command.dpram_blk.pseudohdr; pmsg = (PUSHORT)&dpram_data->pseudohdr; ppseudo_hdr = (struct pseudo_hdr *)pmsg; total_len = msgsz+2; if (total_len & 0x1) { total_len++; } // Insert slow queue sequence number ppseudo_hdr->seq_num = info->squeseqnum++; ppseudo_hdr->portsrc = info->app_info[app_index].app_id; // 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); } pmsg++; ppseudo_hdr = (struct pseudo_hdr *)pmsg; #if 0 ptr = dpram_data; DEBUG("FT1000:ft1000_ChIoctl: Command Send\n"); for (i=0; iapp_info[app_index].nTxMsg++; } else { result = -EINVAL; } } } } else { DEBUG("FT1000:ft1000_ChIoctl: Card not ready take messages\n"); result = -EACCES; } kfree(dpram_data); } break; case IOCTL_GET_DPRAM_CMD: { struct dpram_blk *pdpram_blk; IOCTL_DPRAM_BLK __user *pioctl_dpram; int msglen; //DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_GET_DPRAM called\n"); if (ft1000_flarion_cnt == 0) { return (-EBADF); } // Search for matching file object for (i=0; iapp_info[i].fileobject == &File->f_owner) { //DEBUG("FT1000:ft1000_ChIoctl: Message is for AppId = %d\n", info->app_info[i].app_id); break; } } // Could not find application info block if (i == MAX_NUM_APP) { DEBUG("FT1000:ft1000_ChIoctl:Could not find application info block\n"); result = -EBADF; break; } result = 0; pioctl_dpram = argp; if (list_empty(&info->app_info[i].app_sqlist) == 0) { //DEBUG("FT1000:ft1000_ChIoctl:Message detected in slow queue\n"); spin_lock_irqsave(&free_buff_lock, flags); pdpram_blk = list_entry(info->app_info[i].app_sqlist.next, struct dpram_blk, list); list_del(&pdpram_blk->list); info->app_info[i].NumOfMsg--; //DEBUG("FT1000:ft1000_ChIoctl:NumOfMsg for app %d = %d\n", i, info->app_info[i].NumOfMsg); spin_unlock_irqrestore(&free_buff_lock, flags); msglen = ntohs(*(u16 *)pdpram_blk->pbuffer) + PSEUDOSZ; result = get_user(msglen, &pioctl_dpram->total_len); if (result) break; msglen = htons(msglen); //DEBUG("FT1000:ft1000_ChIoctl:msg length = %x\n", msglen); if(copy_to_user (&pioctl_dpram->pseudohdr, pdpram_blk->pbuffer, msglen)) { DEBUG("FT1000:ft1000_ChIoctl: copy fault occurred\n"); result = -EFAULT; break; } ft1000_free_buffer(pdpram_blk, &freercvpool); result = msglen; } //DEBUG("FT1000:ft1000_ChIoctl: IOCTL_FT1000_GET_DPRAM no message\n"); } break; default: DEBUG("FT1000:ft1000_ChIoctl:unknown command: 0x%x\n", Command); result = -ENOTTY; break; } info->fAppMsgPend = 0; return result; } //--------------------------------------------------------------------------- // Function: ft1000_ChRelease // // Parameters: // // Description: // // Notes: // //--------------------------------------------------------------------------- static int ft1000_ChRelease (struct inode *Inode, struct file *File) { struct ft1000_info *info; struct net_device *dev; int i; struct dpram_blk *pdpram_blk; DEBUG("ft1000_ChRelease called\n"); dev = File->private_data; info = (struct ft1000_info *) netdev_priv(dev); if (ft1000_flarion_cnt == 0) { info->appcnt--; return (-EBADF); } // Search for matching file object for (i=0; iapp_info[i].fileobject == &File->f_owner) { //DEBUG("FT1000:ft1000_ChIoctl: Message is for AppId = %d\n", info->app_info[i].app_id); break; } } if (i==MAX_NUM_APP) return 0; while (list_empty(&info->app_info[i].app_sqlist) == 0) { DEBUG("Remove and free memory queue up on slow queue\n"); pdpram_blk = list_entry(info->app_info[i].app_sqlist.next, struct dpram_blk, list); list_del(&pdpram_blk->list); ft1000_free_buffer(pdpram_blk, &freercvpool); } // initialize application information info->appcnt--; DEBUG("ft1000_chdev:%s:appcnt = %d\n", __FUNCTION__, info->appcnt); info->app_info[i].fileobject = NULL; return 0; }