From: Marek Belisko Date: Thu, 7 Oct 2010 12:36:37 +0000 (+0200) Subject: staging: ft1000-usb: Add correct procedure for fw image downloading. X-Git-Url: http://drtracing.org/?a=commitdiff_plain;h=ada541f0cb03eb3c39016597470bd0aaaa1c6486;p=deliverable%2Flinux.git staging: ft1000-usb: Add correct procedure for fw image downloading. call request_firmware instead of trying to open the file directly from the kernel driver. Signed-off-by: Marek Belisko Signed-off-by: Greg Kroah-Hartman --- diff --git a/drivers/staging/ft1000/ft1000-usb/ft1000_download.c b/drivers/staging/ft1000/ft1000-usb/ft1000_download.c index ba07d5d85045..1f7c7a67e1d1 100644 --- a/drivers/staging/ft1000/ft1000-usb/ft1000_download.c +++ b/drivers/staging/ft1000/ft1000-usb/ft1000_download.c @@ -132,69 +132,6 @@ typedef struct _DSP_IMAGE_INFO_V6 { unsigned short pad1; } DSP_IMAGE_INFO_V6, *PDSP_IMAGE_INFO_V6; - -//--------------------------------------------------------------------------- -// Function: getfw -// -// Parameters: char *fn - input DSP image file name -// int *pimgsz - output DSP image file size -// Returns: DSP image buffer -// -// Description: Read the DSP image file into a char buffer -// -// Notes: -// -//--------------------------------------------------------------------------- -char *getfw (char *fn, size_t *pimgsz) -{ - struct file *fd; - mm_segment_t fs = get_fs(); - loff_t pos; - char *pfwimg; - int fwimgsz; - - set_fs(get_ds()); - - fd = filp_open(fn, 0, 0); - if ( IS_ERR(fd) ) - { - DEBUG("FT1000:%s:can not open dsp image\n", __FUNCTION__); - set_fs(fs); - return NULL; - } - - fwimgsz = i_size_read(fd->f_dentry->d_inode); - *pimgsz = fwimgsz; - - if (fwimgsz <= 0) - { - DEBUG("FT1000:%s:invalid file size\n", __FUNCTION__); - filp_close(fd, current->files); - set_fs(fs); - return NULL; - } - pfwimg = (char*)vmalloc ( fwimgsz ); - if (pfwimg == NULL) { - DEBUG("FT1000:%s:can not allocate memory for dsp image\n", __FUNCTION__); - filp_close(fd, current->files); - set_fs(fs); - return NULL; - } - pos = 0; - if (vfs_read(fd, (void __user __force*)pfwimg, fwimgsz, &pos) != fwimgsz) { - vfree(pfwimg); - DEBUG("FT1000:%s:failed to read firmware image\n",__FUNCTION__); - filp_close(fd, current->files); - set_fs(fs); - return NULL; - } - - filp_close(fd, current->files); - set_fs(fs); - - return pfwimg; -} - //--------------------------------------------------------------------------- // Function: check_usb_db // diff --git a/drivers/staging/ft1000/ft1000-usb/ft1000_usb.c b/drivers/staging/ft1000/ft1000-usb/ft1000_usb.c index 4aef1c43e61f..3c9bb6d226fb 100644 --- a/drivers/staging/ft1000/ft1000-usb/ft1000_usb.c +++ b/drivers/staging/ft1000/ft1000-usb/ft1000_usb.c @@ -13,6 +13,7 @@ #include #include #include +#include #include "ft1000_usb.h" //#include @@ -88,10 +89,12 @@ static int ft1000_probe(struct usb_interface *interface, const struct usb_device struct usb_endpoint_descriptor *endpoint; struct usb_device *dev; unsigned numaltsetting; - int i; + int i, ret = 0, size; struct ft1000_device *ft1000dev; FT1000_INFO *pft1000info; + const struct firmware *dsp_fw; + if(!(ft1000dev = kmalloc(sizeof(struct ft1000_device), GFP_KERNEL))) { @@ -149,14 +152,24 @@ static int ft1000_probe(struct usb_interface *interface, const struct usb_device DEBUG("bulk_in=%d, bulk_out=%d\n", ft1000dev->bulk_in_endpointAddr, ft1000dev->bulk_out_endpointAddr); - //read DSP image - pFileStart = (void*)getfw("/etc/flarion/ft3000.img", &FileLength); + ret = request_firmware(&dsp_fw, "ft3000.img", &dev->dev); + if (ret < 0) { + printk(KERN_ERR "Error request_firmware().\n"); + goto err_fw; + } - if (pFileStart == NULL ) - { - DEBUG ("ft1000_probe: Read DSP image failed\n"); - return 0; - } + size = max_t(uint, dsp_fw->size, 4096); + pFileStart = kmalloc(size, GFP_KERNEL); + + if (!pFileStart) { + release_firmware(dsp_fw); + ret = -ENOMEM; + goto err_fw; + } + + memcpy(pFileStart, dsp_fw->data, dsp_fw->size); + FileLength = dsp_fw->size; + release_firmware(dsp_fw); //for ( i=0; i< MAX_NUM_CARDS+2; i++) // pdevobj[i] = NULL; @@ -206,6 +219,10 @@ static int ft1000_probe(struct usb_interface *interface, const struct usb_device ft1000InitProc(ft1000dev->net);// +mbelian return 0; + +err_fw: + kfree(ft1000dev); + return ret; } //--------------------------------------------------------------------------- @@ -262,7 +279,7 @@ static void ft1000_disconnect(struct usb_interface *interface) kfree(pft1000info->pFt1000Dev); //+mbelian } - + kfree(pFileStart); //terminate other kernel threads //in multiple instances case, first find the device //in the link list