staging/bcm: move IOCTL_BCM_NVM_RAW_READ case out to its own function.
authorDave Jones <davej@redhat.com>
Thu, 13 Feb 2014 19:47:59 +0000 (14:47 -0500)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Thu, 13 Feb 2014 21:36:15 +0000 (13:36 -0800)
bcm_char_ioctl is one of the longest non-generated functions in the kernel,
at 1906 lines.  Splitting it up into multiple functions should simplify
this a lot.

Signed-off-by: Dave Jones <davej@fedoraproject.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
drivers/staging/bcm/Bcmchar.c

index 046e67ff2e3504abcd4fa74a64e55e4bd7ee42a7..0dc1c88c4576e55c99994d27d0317de11aad3021 100644 (file)
@@ -1886,6 +1886,97 @@ static int bcm_char_ioctl_select_dsd(void __user *argp, struct bcm_mini_adapter
        return STATUS_SUCCESS;
 }
 
+static int bcm_char_ioctl_nvm_raw_read(void __user *argp, struct bcm_mini_adapter *Adapter)
+{
+       struct bcm_nvm_readwrite stNVMRead;
+       struct bcm_ioctl_buffer IoBuffer;
+       INT NOB;
+       INT BuffSize;
+       INT ReadOffset = 0;
+       UINT ReadBytes = 0;
+       PUCHAR pReadBuff;
+       void __user *OutPutBuff;
+       INT Status = STATUS_FAILURE;
+
+       if (Adapter->eNVMType != NVM_FLASH) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "NVM TYPE is not Flash");
+               return -EINVAL;
+       }
+
+       /* Copy Ioctl Buffer structure */
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer))) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "copy_from_user 1 failed\n");
+               return -EFAULT;
+       }
+
+       if (copy_from_user(&stNVMRead, IoBuffer.OutputBuffer, sizeof(struct bcm_nvm_readwrite)))
+               return -EFAULT;
+
+       NOB = stNVMRead.uiNumBytes;
+       /* In Raw-Read max Buff size : 64MB */
+
+       if (NOB > DEFAULT_BUFF_SIZE)
+               BuffSize = DEFAULT_BUFF_SIZE;
+       else
+               BuffSize = NOB;
+
+       ReadOffset = stNVMRead.uiOffset;
+       OutPutBuff = stNVMRead.pBuffer;
+
+       pReadBuff = kzalloc(BuffSize , GFP_KERNEL);
+       if (pReadBuff == NULL) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Memory allocation failed for Flash 2.x Read Structure");
+               return -ENOMEM;
+       }
+       down(&Adapter->NVMRdmWrmLock);
+
+       if ((Adapter->IdleMode == TRUE) ||
+               (Adapter->bShutStatus == TRUE) ||
+               (Adapter->bPreparingForLowPowerMode == TRUE)) {
+
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL, "Device is in Idle/Shutdown Mode\n");
+               kfree(pReadBuff);
+               up(&Adapter->NVMRdmWrmLock);
+               return -EACCES;
+       }
+
+       Adapter->bFlashRawRead = TRUE;
+
+       while (NOB) {
+               if (NOB > DEFAULT_BUFF_SIZE)
+                       ReadBytes = DEFAULT_BUFF_SIZE;
+               else
+                       ReadBytes = NOB;
+
+               /* Reading the data from Flash 2.x */
+               Status = BeceemNVMRead(Adapter, (PUINT)pReadBuff, ReadOffset, ReadBytes);
+               if (Status) {
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Flash 2x read err with Status :%d", Status);
+                       break;
+               }
+
+               BCM_DEBUG_PRINT_BUFFER(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL, pReadBuff, ReadBytes);
+
+               Status = copy_to_user(OutPutBuff, pReadBuff, ReadBytes);
+               if (Status) {
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Copy to use failed with status :%d", Status);
+                       up(&Adapter->NVMRdmWrmLock);
+                       kfree(pReadBuff);
+                       return -EFAULT;
+               }
+               NOB = NOB - ReadBytes;
+               if (NOB) {
+                       ReadOffset = ReadOffset + ReadBytes;
+                       OutPutBuff = OutPutBuff + ReadBytes;
+               }
+       }
+       Adapter->bFlashRawRead = false;
+       up(&Adapter->NVMRdmWrmLock);
+       kfree(pReadBuff);
+       return Status;
+}
+
+
 static long bcm_char_ioctl(struct file *filp, UINT cmd, ULONG arg)
 {
        struct bcm_tarang_data *pTarang = filp->private_data;
@@ -2117,93 +2208,9 @@ static long bcm_char_ioctl(struct file *filp, UINT cmd, ULONG arg)
                Status = bcm_char_ioctl_select_dsd(argp, Adapter);
                return Status;
 
-       case IOCTL_BCM_NVM_RAW_READ: {
-               struct bcm_nvm_readwrite stNVMRead;
-               INT NOB;
-               INT BuffSize;
-               INT ReadOffset = 0;
-               UINT ReadBytes = 0;
-               PUCHAR pReadBuff;
-               void __user *OutPutBuff;
-
-               if (Adapter->eNVMType != NVM_FLASH) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "NVM TYPE is not Flash");
-                       return -EINVAL;
-               }
-
-               /* Copy Ioctl Buffer structure */
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer))) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "copy_from_user 1 failed\n");
-                       return -EFAULT;
-               }
-
-               if (copy_from_user(&stNVMRead, IoBuffer.OutputBuffer, sizeof(struct bcm_nvm_readwrite)))
-                       return -EFAULT;
-
-               NOB = stNVMRead.uiNumBytes;
-               /* In Raw-Read max Buff size : 64MB */
-
-               if (NOB > DEFAULT_BUFF_SIZE)
-                       BuffSize = DEFAULT_BUFF_SIZE;
-               else
-                       BuffSize = NOB;
-
-               ReadOffset = stNVMRead.uiOffset;
-               OutPutBuff = stNVMRead.pBuffer;
-
-               pReadBuff = kzalloc(BuffSize , GFP_KERNEL);
-               if (pReadBuff == NULL) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Memory allocation failed for Flash 2.x Read Structure");
-                       Status = -ENOMEM;
-                       break;
-               }
-               down(&Adapter->NVMRdmWrmLock);
-
-               if ((Adapter->IdleMode == TRUE) ||
-                       (Adapter->bShutStatus == TRUE) ||
-                       (Adapter->bPreparingForLowPowerMode == TRUE)) {
-
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL, "Device is in Idle/Shutdown Mode\n");
-                       kfree(pReadBuff);
-                       up(&Adapter->NVMRdmWrmLock);
-                       return -EACCES;
-               }
-
-               Adapter->bFlashRawRead = TRUE;
-
-               while (NOB) {
-                       if (NOB > DEFAULT_BUFF_SIZE)
-                               ReadBytes = DEFAULT_BUFF_SIZE;
-                       else
-                               ReadBytes = NOB;
-
-                       /* Reading the data from Flash 2.x */
-                       Status = BeceemNVMRead(Adapter, (PUINT)pReadBuff, ReadOffset, ReadBytes);
-                       if (Status) {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Flash 2x read err with Status :%d", Status);
-                               break;
-                       }
-
-                       BCM_DEBUG_PRINT_BUFFER(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL, pReadBuff, ReadBytes);
-
-                       Status = copy_to_user(OutPutBuff, pReadBuff, ReadBytes);
-                       if (Status) {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Copy to use failed with status :%d", Status);
-                               up(&Adapter->NVMRdmWrmLock);
-                               kfree(pReadBuff);
-                               return -EFAULT;
-                       }
-                       NOB = NOB - ReadBytes;
-                       if (NOB) {
-                               ReadOffset = ReadOffset + ReadBytes;
-                               OutPutBuff = OutPutBuff + ReadBytes;
-                       }
-               }
-               Adapter->bFlashRawRead = false;
-               up(&Adapter->NVMRdmWrmLock);
-               kfree(pReadBuff);
-               break;
-       }
+       case IOCTL_BCM_NVM_RAW_READ:
+               Status = bcm_char_ioctl_nvm_raw_read(argp, Adapter);
+               return Status;
 
        case IOCTL_BCM_CNTRLMSG_MASK: {
                ULONG RxCntrlMsgBitMask = 0;