staging/bcm: move BCM_LED_THREAD_STATE_CHANGE_REQ case out to its own function.
[cascardo/linux.git] / drivers / staging / bcm / Bcmchar.c
index f1b6de0..c0b2997 100644 (file)
@@ -150,414 +150,462 @@ static ssize_t bcm_char_read(struct file *filp, char __user *buf, size_t size,
        return PktLen;
 }
 
-static long bcm_char_ioctl(struct file *filp, UINT cmd, ULONG arg)
+static int bcm_char_ioctl_reg_read_private(void __user *argp, struct bcm_mini_adapter *Adapter)
 {
-       struct bcm_tarang_data *pTarang = filp->private_data;
-       void __user *argp = (void __user *)arg;
-       struct bcm_mini_adapter *Adapter = pTarang->Adapter;
-       INT Status = STATUS_FAILURE;
-       int timeout = 0;
+       struct bcm_rdm_buffer sRdmBuffer = {0};
        struct bcm_ioctl_buffer IoBuffer;
+       PCHAR temp_buff;
+       INT Status = STATUS_FAILURE;
+       UINT Bufflen;
+       u16 temp_value;
        int bytes;
 
-       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL,
-                       "Parameters Passed to control IOCTL cmd=0x%X arg=0x%lX",
-                       cmd, arg);
-
-       if (_IOC_TYPE(cmd) != BCM_IOCTL)
+       /* Copy Ioctl Buffer structure */
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
                return -EFAULT;
-       if (_IOC_DIR(cmd) & _IOC_READ)
-               Status = !access_ok(VERIFY_WRITE, argp, _IOC_SIZE(cmd));
-       else if (_IOC_DIR(cmd) & _IOC_WRITE)
-               Status = !access_ok(VERIFY_READ, argp, _IOC_SIZE(cmd));
-       else if (_IOC_NONE == (_IOC_DIR(cmd) & _IOC_NONE))
-               Status = STATUS_SUCCESS;
 
-       if (Status)
-               return -EFAULT;
+       if (IoBuffer.InputLength > sizeof(sRdmBuffer))
+               return -EINVAL;
 
-       if (Adapter->device_removed)
+       if (copy_from_user(&sRdmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
                return -EFAULT;
 
-       if (false == Adapter->fw_download_done) {
-               switch (cmd) {
-               case IOCTL_MAC_ADDR_REQ:
-               case IOCTL_LINK_REQ:
-               case IOCTL_CM_REQUEST:
-               case IOCTL_SS_INFO_REQ:
-               case IOCTL_SEND_CONTROL_MESSAGE:
-               case IOCTL_IDLE_REQ:
-               case IOCTL_BCM_GPIO_SET_REQUEST:
-               case IOCTL_BCM_GPIO_STATUS_REQUEST:
-                       return -EACCES;
-               default:
-                       break;
-               }
+       if (IoBuffer.OutputLength > USHRT_MAX ||
+               IoBuffer.OutputLength == 0) {
+               return -EINVAL;
        }
 
-       Status = vendorextnIoctl(Adapter, cmd, arg);
-       if (Status != CONTINUE_COMMON_PATH)
-               return Status;
+       Bufflen = IoBuffer.OutputLength;
+       temp_value = 4 - (Bufflen % 4);
+       Bufflen += temp_value % 4;
 
-       switch (cmd) {
-       /* Rdms for Swin Idle... */
-       case IOCTL_BCM_REGISTER_READ_PRIVATE: {
-               struct bcm_rdm_buffer sRdmBuffer = {0};
-               PCHAR temp_buff;
-               UINT Bufflen;
-               u16 temp_value;
+       temp_buff = kmalloc(Bufflen, GFP_KERNEL);
+       if (!temp_buff)
+               return -ENOMEM;
 
-               /* Copy Ioctl Buffer structure */
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+       bytes = rdmalt(Adapter, (UINT)sRdmBuffer.Register,
+                       (PUINT)temp_buff, Bufflen);
+       if (bytes > 0) {
+               Status = STATUS_SUCCESS;
+               if (copy_to_user(IoBuffer.OutputBuffer, temp_buff, bytes)) {
+                       kfree(temp_buff);
                        return -EFAULT;
+               }
+       } else {
+               Status = bytes;
+       }
 
-               if (IoBuffer.InputLength > sizeof(sRdmBuffer))
-                       return -EINVAL;
+       kfree(temp_buff);
+       return Status;
+}
 
-               if (copy_from_user(&sRdmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
-                       return -EFAULT;
+static int bcm_char_ioctl_reg_write_private(void __user *argp, struct bcm_mini_adapter *Adapter)
+{
+       struct bcm_wrm_buffer sWrmBuffer = {0};
+       struct bcm_ioctl_buffer IoBuffer;
+       UINT uiTempVar = 0;
+       INT Status;
 
-               if (IoBuffer.OutputLength > USHRT_MAX ||
-                       IoBuffer.OutputLength == 0) {
-                       return -EINVAL;
-               }
+       /* Copy Ioctl Buffer structure */
 
-               Bufflen = IoBuffer.OutputLength;
-               temp_value = 4 - (Bufflen % 4);
-               Bufflen += temp_value % 4;
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+               return -EFAULT;
 
-               temp_buff = kmalloc(Bufflen, GFP_KERNEL);
-               if (!temp_buff)
-                       return -ENOMEM;
+       if (IoBuffer.InputLength > sizeof(sWrmBuffer))
+               return -EINVAL;
 
-               bytes = rdmalt(Adapter, (UINT)sRdmBuffer.Register,
-                               (PUINT)temp_buff, Bufflen);
-               if (bytes > 0) {
-                       Status = STATUS_SUCCESS;
-                       if (copy_to_user(IoBuffer.OutputBuffer, temp_buff, bytes)) {
-                               kfree(temp_buff);
-                               return -EFAULT;
-                       }
-               } else {
-                       Status = bytes;
-               }
+       /* Get WrmBuffer structure */
+       if (copy_from_user(&sWrmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
+               return -EFAULT;
 
-               kfree(temp_buff);
-               break;
+       uiTempVar = sWrmBuffer.Register & EEPROM_REJECT_MASK;
+       if (!((Adapter->pstargetparams->m_u32Customize) & VSG_MODE) &&
+               ((uiTempVar == EEPROM_REJECT_REG_1) ||
+                       (uiTempVar == EEPROM_REJECT_REG_2) ||
+                       (uiTempVar == EEPROM_REJECT_REG_3) ||
+                       (uiTempVar == EEPROM_REJECT_REG_4))) {
+
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
+                               "EEPROM Access Denied, not in VSG Mode\n");
+               return -EFAULT;
        }
 
-       case IOCTL_BCM_REGISTER_WRITE_PRIVATE: {
-               struct bcm_wrm_buffer sWrmBuffer = {0};
-               UINT uiTempVar = 0;
-               /* Copy Ioctl Buffer structure */
+       Status = wrmalt(Adapter, (UINT)sWrmBuffer.Register,
+                       (PUINT)sWrmBuffer.Data, sizeof(ULONG));
 
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
-                       return -EFAULT;
+       if (Status == STATUS_SUCCESS) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL, "WRM Done\n");
+       } else {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL, "WRM Failed\n");
+               Status = -EFAULT;
+       }
+       return Status;
+}
 
-               if (IoBuffer.InputLength > sizeof(sWrmBuffer))
-                       return -EINVAL;
+static int bcm_char_ioctl_eeprom_reg_read(void __user *argp, struct bcm_mini_adapter *Adapter)
+{
+       struct bcm_rdm_buffer sRdmBuffer = {0};
+       struct bcm_ioctl_buffer IoBuffer;
+       PCHAR temp_buff = NULL;
+       UINT uiTempVar = 0;
+       INT Status;
+       int bytes;
 
-               /* Get WrmBuffer structure */
-               if (copy_from_user(&sWrmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
-                       return -EFAULT;
+       if ((Adapter->IdleMode == TRUE) ||
+               (Adapter->bShutStatus == TRUE) ||
+               (Adapter->bPreparingForLowPowerMode == TRUE)) {
 
-               uiTempVar = sWrmBuffer.Register & EEPROM_REJECT_MASK;
-               if (!((Adapter->pstargetparams->m_u32Customize) & VSG_MODE) &&
-                       ((uiTempVar == EEPROM_REJECT_REG_1) ||
-                               (uiTempVar == EEPROM_REJECT_REG_2) ||
-                               (uiTempVar == EEPROM_REJECT_REG_3) ||
-                               (uiTempVar == EEPROM_REJECT_REG_4))) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
+                               "Device in Idle Mode, Blocking Rdms\n");
+               return -EACCES;
+       }
 
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
-                                       "EEPROM Access Denied, not in VSG Mode\n");
-                       return -EFAULT;
-               }
+       /* Copy Ioctl Buffer structure */
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+               return -EFAULT;
 
-               Status = wrmalt(Adapter, (UINT)sWrmBuffer.Register,
-                               (PUINT)sWrmBuffer.Data, sizeof(ULONG));
+       if (IoBuffer.InputLength > sizeof(sRdmBuffer))
+               return -EINVAL;
 
-               if (Status == STATUS_SUCCESS) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL, "WRM Done\n");
-               } else {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL, "WRM Failed\n");
-                       Status = -EFAULT;
-               }
-               break;
+       if (copy_from_user(&sRdmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
+               return -EFAULT;
+
+       if (IoBuffer.OutputLength > USHRT_MAX ||
+               IoBuffer.OutputLength == 0) {
+               return -EINVAL;
        }
 
-       case IOCTL_BCM_REGISTER_READ:
-       case IOCTL_BCM_EEPROM_REGISTER_READ: {
-               struct bcm_rdm_buffer sRdmBuffer = {0};
-               PCHAR temp_buff = NULL;
-               UINT uiTempVar = 0;
-               if ((Adapter->IdleMode == TRUE) ||
-                       (Adapter->bShutStatus == TRUE) ||
-                       (Adapter->bPreparingForLowPowerMode == TRUE)) {
+       temp_buff = kmalloc(IoBuffer.OutputLength, GFP_KERNEL);
+       if (!temp_buff)
+               return STATUS_FAILURE;
 
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
-                                       "Device in Idle Mode, Blocking Rdms\n");
-                       return -EACCES;
-               }
+       if ((((ULONG)sRdmBuffer.Register & 0x0F000000) != 0x0F000000) ||
+               ((ULONG)sRdmBuffer.Register & 0x3)) {
 
-               /* Copy Ioctl Buffer structure */
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
-                       return -EFAULT;
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
+                               "RDM Done On invalid Address : %x Access Denied.\n",
+                               (int)sRdmBuffer.Register);
 
-               if (IoBuffer.InputLength > sizeof(sRdmBuffer))
-                       return -EINVAL;
+               kfree(temp_buff);
+               return -EINVAL;
+       }
 
-               if (copy_from_user(&sRdmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
-                       return -EFAULT;
+       uiTempVar = sRdmBuffer.Register & EEPROM_REJECT_MASK;
+       bytes = rdmaltWithLock(Adapter, (UINT)sRdmBuffer.Register,
+                              (PUINT)temp_buff, IoBuffer.OutputLength);
 
-               if (IoBuffer.OutputLength > USHRT_MAX ||
-                       IoBuffer.OutputLength == 0) {
-                       return -EINVAL;
+       if (bytes > 0) {
+               Status = STATUS_SUCCESS;
+               if (copy_to_user(IoBuffer.OutputBuffer, temp_buff, bytes)) {
+                       kfree(temp_buff);
+                       return -EFAULT;
                }
+       } else {
+               Status = bytes;
+       }
 
-               temp_buff = kmalloc(IoBuffer.OutputLength, GFP_KERNEL);
-               if (!temp_buff)
-                       return STATUS_FAILURE;
+       kfree(temp_buff);
+       return Status;
+}
 
-               if ((((ULONG)sRdmBuffer.Register & 0x0F000000) != 0x0F000000) ||
-                       ((ULONG)sRdmBuffer.Register & 0x3)) {
+static int bcm_char_ioctl_eeprom_reg_write(void __user *argp, struct bcm_mini_adapter *Adapter, UINT cmd)
+{
+       struct bcm_wrm_buffer sWrmBuffer = {0};
+       struct bcm_ioctl_buffer IoBuffer;
+       UINT uiTempVar = 0;
+       INT Status;
 
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
-                                       "RDM Done On invalid Address : %x Access Denied.\n",
-                                       (int)sRdmBuffer.Register);
+       if ((Adapter->IdleMode == TRUE) ||
+               (Adapter->bShutStatus == TRUE) ||
+               (Adapter->bPreparingForLowPowerMode == TRUE)) {
 
-                       kfree(temp_buff);
-                       return -EINVAL;
-               }
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
+                               "Device in Idle Mode, Blocking Wrms\n");
+               return -EACCES;
+       }
 
-               uiTempVar = sRdmBuffer.Register & EEPROM_REJECT_MASK;
-               bytes = rdmaltWithLock(Adapter, (UINT)sRdmBuffer.Register,
-                                      (PUINT)temp_buff, IoBuffer.OutputLength);
+       /* Copy Ioctl Buffer structure */
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+               return -EFAULT;
 
-               if (bytes > 0) {
-                       Status = STATUS_SUCCESS;
-                       if (copy_to_user(IoBuffer.OutputBuffer, temp_buff, bytes)) {
-                               kfree(temp_buff);
-                               return -EFAULT;
-                       }
-               } else {
-                       Status = bytes;
-               }
+       if (IoBuffer.InputLength > sizeof(sWrmBuffer))
+               return -EINVAL;
 
-               kfree(temp_buff);
-               break;
+       /* Get WrmBuffer structure */
+       if (copy_from_user(&sWrmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
+               return -EFAULT;
+
+       if ((((ULONG)sWrmBuffer.Register & 0x0F000000) != 0x0F000000) ||
+               ((ULONG)sWrmBuffer.Register & 0x3)) {
+
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
+                               "WRM Done On invalid Address : %x Access Denied.\n",
+                               (int)sWrmBuffer.Register);
+               return -EINVAL;
        }
-       case IOCTL_BCM_REGISTER_WRITE:
-       case IOCTL_BCM_EEPROM_REGISTER_WRITE: {
-               struct bcm_wrm_buffer sWrmBuffer = {0};
-               UINT uiTempVar = 0;
 
-               if ((Adapter->IdleMode == TRUE) ||
-                       (Adapter->bShutStatus == TRUE) ||
-                       (Adapter->bPreparingForLowPowerMode == TRUE)) {
+       uiTempVar = sWrmBuffer.Register & EEPROM_REJECT_MASK;
+       if (!((Adapter->pstargetparams->m_u32Customize) & VSG_MODE) &&
+                       ((uiTempVar == EEPROM_REJECT_REG_1) ||
+                       (uiTempVar == EEPROM_REJECT_REG_2) ||
+                       (uiTempVar == EEPROM_REJECT_REG_3) ||
+                       (uiTempVar == EEPROM_REJECT_REG_4)) &&
+                       (cmd == IOCTL_BCM_REGISTER_WRITE)) {
 
                        BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
-                                       "Device in Idle Mode, Blocking Wrms\n");
-                       return -EACCES;
-               }
-
-               /* Copy Ioctl Buffer structure */
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+                                       "EEPROM Access Denied, not in VSG Mode\n");
                        return -EFAULT;
+       }
 
-               if (IoBuffer.InputLength > sizeof(sWrmBuffer))
-                       return -EINVAL;
+       Status = wrmaltWithLock(Adapter, (UINT)sWrmBuffer.Register,
+                               (PUINT)sWrmBuffer.Data,
+                               sWrmBuffer.Length);
 
-               /* Get WrmBuffer structure */
-               if (copy_from_user(&sWrmBuffer, IoBuffer.InputBuffer, IoBuffer.InputLength))
-                       return -EFAULT;
+       if (Status == STATUS_SUCCESS) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, OSAL_DBG,
+                               DBG_LVL_ALL, "WRM Done\n");
+       } else {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL, "WRM Failed\n");
+               Status = -EFAULT;
+       }
+       return Status;
+}
 
-               if ((((ULONG)sWrmBuffer.Register & 0x0F000000) != 0x0F000000) ||
-                       ((ULONG)sWrmBuffer.Register & 0x3)) {
+static int bcm_char_ioctl_gpio_set_request(void __user *argp, struct bcm_mini_adapter *Adapter)
+{
+       struct bcm_gpio_info gpio_info = {0};
+       struct bcm_ioctl_buffer IoBuffer;
+       UCHAR ucResetValue[4];
+       UINT value = 0;
+       UINT uiBit = 0;
+       UINT uiOperation = 0;
+       INT Status;
+       int bytes;
 
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
-                                       "WRM Done On invalid Address : %x Access Denied.\n",
-                                       (int)sWrmBuffer.Register);
-                       return -EINVAL;
-               }
+       if ((Adapter->IdleMode == TRUE) ||
+               (Adapter->bShutStatus == TRUE) ||
+               (Adapter->bPreparingForLowPowerMode == TRUE)) {
 
-               uiTempVar = sWrmBuffer.Register & EEPROM_REJECT_MASK;
-               if (!((Adapter->pstargetparams->m_u32Customize) & VSG_MODE) &&
-                               ((uiTempVar == EEPROM_REJECT_REG_1) ||
-                               (uiTempVar == EEPROM_REJECT_REG_2) ||
-                               (uiTempVar == EEPROM_REJECT_REG_3) ||
-                               (uiTempVar == EEPROM_REJECT_REG_4)) &&
-                               (cmd == IOCTL_BCM_REGISTER_WRITE)) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL,
+                               "GPIO Can't be set/clear in Low power Mode");
+               return -EACCES;
+       }
 
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0,
-                                               "EEPROM Access Denied, not in VSG Mode\n");
-                               return -EFAULT;
-               }
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+               return -EFAULT;
 
-               Status = wrmaltWithLock(Adapter, (UINT)sWrmBuffer.Register,
-                                       (PUINT)sWrmBuffer.Data,
-                                       sWrmBuffer.Length);
+       if (IoBuffer.InputLength > sizeof(gpio_info))
+               return -EINVAL;
+
+       if (copy_from_user(&gpio_info, IoBuffer.InputBuffer, IoBuffer.InputLength))
+               return -EFAULT;
+
+       uiBit  = gpio_info.uiGpioNumber;
+       uiOperation = gpio_info.uiGpioValue;
+       value = (1<<uiBit);
+
+       if (IsReqGpioIsLedInNVM(Adapter, value) == false) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL,
+                               "Sorry, Requested GPIO<0x%X> is not correspond to LED !!!",
+                               value);
+               return -EINVAL;
+       }
+
+       /* Set - setting 1 */
+       if (uiOperation) {
+               /* Set the gpio output register */
+               Status = wrmaltWithLock(Adapter,
+                                       BCM_GPIO_OUTPUT_SET_REG,
+                                       (PUINT)(&value), sizeof(UINT));
 
                if (Status == STATUS_SUCCESS) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, OSAL_DBG,
-                                       DBG_LVL_ALL, "WRM Done\n");
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
+                                       OSAL_DBG, DBG_LVL_ALL,
+                                       "Set the GPIO bit\n");
                } else {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL, "WRM Failed\n");
-                       Status = -EFAULT;
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
+                                       OSAL_DBG, DBG_LVL_ALL,
+                                       "Failed to set the %dth GPIO\n",
+                                       uiBit);
+                       return Status;
                }
-               break;
-       }
-       case IOCTL_BCM_GPIO_SET_REQUEST: {
-               UCHAR ucResetValue[4];
-               UINT value = 0;
-               UINT uiBit = 0;
-               UINT uiOperation = 0;
-               struct bcm_gpio_info gpio_info = {0};
-
-               if ((Adapter->IdleMode == TRUE) ||
-                       (Adapter->bShutStatus == TRUE) ||
-                       (Adapter->bPreparingForLowPowerMode == TRUE)) {
+       } else {
+               /* Set the gpio output register */
+               Status = wrmaltWithLock(Adapter,
+                                       BCM_GPIO_OUTPUT_CLR_REG,
+                                       (PUINT)(&value), sizeof(UINT));
 
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL,
-                                       "GPIO Can't be set/clear in Low power Mode");
-                       return -EACCES;
+               if (Status == STATUS_SUCCESS) {
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
+                                       OSAL_DBG, DBG_LVL_ALL,
+                                       "Set the GPIO bit\n");
+               } else {
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
+                                       OSAL_DBG, DBG_LVL_ALL,
+                                       "Failed to clear the %dth GPIO\n",
+                                       uiBit);
+                       return Status;
                }
+       }
 
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
-                       return -EFAULT;
+       bytes = rdmaltWithLock(Adapter, (UINT)GPIO_MODE_REGISTER,
+                              (PUINT)ucResetValue, sizeof(UINT));
+       if (bytes < 0) {
+               Status = bytes;
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL,
+                               "GPIO_MODE_REGISTER read failed");
+               return Status;
+       } else {
+               Status = STATUS_SUCCESS;
+       }
 
-               if (IoBuffer.InputLength > sizeof(gpio_info))
-                       return -EINVAL;
+       /* Set the gpio mode register to output */
+       *(UINT *)ucResetValue |= (1<<uiBit);
+       Status = wrmaltWithLock(Adapter, GPIO_MODE_REGISTER,
+                               (PUINT)ucResetValue, sizeof(UINT));
 
-               if (copy_from_user(&gpio_info, IoBuffer.InputBuffer, IoBuffer.InputLength))
-                       return -EFAULT;
+       if (Status == STATUS_SUCCESS) {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL,
+                               "Set the GPIO to output Mode\n");
+       } else {
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL,
+                               "Failed to put GPIO in Output Mode\n");
+       }
 
-               uiBit  = gpio_info.uiGpioNumber;
-               uiOperation = gpio_info.uiGpioValue;
-               value = (1<<uiBit);
+       return Status;
+}
 
-               if (IsReqGpioIsLedInNVM(Adapter, value) == false) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL,
-                                       "Sorry, Requested GPIO<0x%X> is not correspond to LED !!!",
-                                       value);
-                       Status = -EINVAL;
-                       break;
-               }
+static int bcm_char_ioctl_led_thread_state_change_req(void __user *argp, struct bcm_mini_adapter *Adapter)
+{
+       struct bcm_user_thread_req threadReq = {0};
+       struct bcm_ioctl_buffer IoBuffer;
 
-               /* Set - setting 1 */
-               if (uiOperation) {
-                       /* Set the gpio output register */
-                       Status = wrmaltWithLock(Adapter,
-                                               BCM_GPIO_OUTPUT_SET_REG,
-                                               (PUINT)(&value), sizeof(UINT));
+       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL,
+                       "User made LED thread InActive");
 
-                       if (Status == STATUS_SUCCESS) {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
-                                               OSAL_DBG, DBG_LVL_ALL,
-                                               "Set the GPIO bit\n");
-                       } else {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
-                                               OSAL_DBG, DBG_LVL_ALL,
-                                               "Failed to set the %dth GPIO\n",
-                                               uiBit);
-                               break;
-                       }
-               } else {
-                       /* Set the gpio output register */
-                       Status = wrmaltWithLock(Adapter,
-                                               BCM_GPIO_OUTPUT_CLR_REG,
-                                               (PUINT)(&value), sizeof(UINT));
+       if ((Adapter->IdleMode == TRUE) ||
+               (Adapter->bShutStatus == TRUE) ||
+               (Adapter->bPreparingForLowPowerMode == TRUE)) {
 
-                       if (Status == STATUS_SUCCESS) {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
-                                               OSAL_DBG, DBG_LVL_ALL,
-                                               "Set the GPIO bit\n");
-                       } else {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
-                                               OSAL_DBG, DBG_LVL_ALL,
-                                               "Failed to clear the %dth GPIO\n",
-                                               uiBit);
-                               break;
-                       }
-               }
+               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
+                               DBG_LVL_ALL,
+                               "GPIO Can't be set/clear in Low power Mode");
+               return -EACCES;
+       }
 
-               bytes = rdmaltWithLock(Adapter, (UINT)GPIO_MODE_REGISTER,
-                                      (PUINT)ucResetValue, sizeof(UINT));
-               if (bytes < 0) {
-                       Status = bytes;
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL,
-                                       "GPIO_MODE_REGISTER read failed");
-                       break;
-               } else {
-                       Status = STATUS_SUCCESS;
-               }
+       if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
+               return -EFAULT;
 
-               /* Set the gpio mode register to output */
-               *(UINT *)ucResetValue |= (1<<uiBit);
-               Status = wrmaltWithLock(Adapter, GPIO_MODE_REGISTER,
-                                       (PUINT)ucResetValue, sizeof(UINT));
+       if (IoBuffer.InputLength > sizeof(threadReq))
+               return -EINVAL;
 
-               if (Status == STATUS_SUCCESS) {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL,
-                                       "Set the GPIO to output Mode\n");
+       if (copy_from_user(&threadReq, IoBuffer.InputBuffer, IoBuffer.InputLength))
+               return -EFAULT;
+
+       /* if LED thread is running(Actively or Inactively) set it state to make inactive */
+       if (Adapter->LEDInfo.led_thread_running) {
+               if (threadReq.ThreadState == LED_THREAD_ACTIVATION_REQ) {
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
+                                       OSAL_DBG, DBG_LVL_ALL,
+                                       "Activating thread req");
+                       Adapter->DriverState = LED_THREAD_ACTIVE;
                } else {
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL,
-                                       "Failed to put GPIO in Output Mode\n");
-                       break;
+                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
+                                       OSAL_DBG, DBG_LVL_ALL,
+                                       "DeActivating Thread req.....");
+                       Adapter->DriverState = LED_THREAD_INACTIVE;
                }
+
+               /* signal thread. */
+               wake_up(&Adapter->LEDInfo.notify_led_event);
        }
-       break;
+       return STATUS_SUCCESS;
+}
 
-       case BCM_LED_THREAD_STATE_CHANGE_REQ: {
-               struct bcm_user_thread_req threadReq = {0};
-               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL,
-                               "User made LED thread InActive");
 
-               if ((Adapter->IdleMode == TRUE) ||
-                       (Adapter->bShutStatus == TRUE) ||
-                       (Adapter->bPreparingForLowPowerMode == TRUE)) {
+static long bcm_char_ioctl(struct file *filp, UINT cmd, ULONG arg)
+{
+       struct bcm_tarang_data *pTarang = filp->private_data;
+       void __user *argp = (void __user *)arg;
+       struct bcm_mini_adapter *Adapter = pTarang->Adapter;
+       INT Status = STATUS_FAILURE;
+       int timeout = 0;
+       struct bcm_ioctl_buffer IoBuffer;
+       int bytes;
 
-                       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG,
-                                       DBG_LVL_ALL,
-                                       "GPIO Can't be set/clear in Low power Mode");
-                       Status = -EACCES;
+       BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, OSAL_DBG, DBG_LVL_ALL,
+                       "Parameters Passed to control IOCTL cmd=0x%X arg=0x%lX",
+                       cmd, arg);
+
+       if (_IOC_TYPE(cmd) != BCM_IOCTL)
+               return -EFAULT;
+       if (_IOC_DIR(cmd) & _IOC_READ)
+               Status = !access_ok(VERIFY_WRITE, argp, _IOC_SIZE(cmd));
+       else if (_IOC_DIR(cmd) & _IOC_WRITE)
+               Status = !access_ok(VERIFY_READ, argp, _IOC_SIZE(cmd));
+       else if (_IOC_NONE == (_IOC_DIR(cmd) & _IOC_NONE))
+               Status = STATUS_SUCCESS;
+
+       if (Status)
+               return -EFAULT;
+
+       if (Adapter->device_removed)
+               return -EFAULT;
+
+       if (false == Adapter->fw_download_done) {
+               switch (cmd) {
+               case IOCTL_MAC_ADDR_REQ:
+               case IOCTL_LINK_REQ:
+               case IOCTL_CM_REQUEST:
+               case IOCTL_SS_INFO_REQ:
+               case IOCTL_SEND_CONTROL_MESSAGE:
+               case IOCTL_IDLE_REQ:
+               case IOCTL_BCM_GPIO_SET_REQUEST:
+               case IOCTL_BCM_GPIO_STATUS_REQUEST:
+                       return -EACCES;
+               default:
                        break;
                }
+       }
 
-               if (copy_from_user(&IoBuffer, argp, sizeof(struct bcm_ioctl_buffer)))
-                       return -EFAULT;
+       Status = vendorextnIoctl(Adapter, cmd, arg);
+       if (Status != CONTINUE_COMMON_PATH)
+               return Status;
 
-               if (IoBuffer.InputLength > sizeof(threadReq))
-                       return -EINVAL;
+       switch (cmd) {
+       /* Rdms for Swin Idle... */
+       case IOCTL_BCM_REGISTER_READ_PRIVATE:
+               Status = bcm_char_ioctl_reg_read_private(argp, Adapter);
+               return Status;
 
-               if (copy_from_user(&threadReq, IoBuffer.InputBuffer, IoBuffer.InputLength))
-                       return -EFAULT;
+       case IOCTL_BCM_REGISTER_WRITE_PRIVATE:
+               Status = bcm_char_ioctl_reg_write_private(argp, Adapter);
+               return Status;
 
-               /* if LED thread is running(Actively or Inactively) set it state to make inactive */
-               if (Adapter->LEDInfo.led_thread_running) {
-                       if (threadReq.ThreadState == LED_THREAD_ACTIVATION_REQ) {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
-                                               OSAL_DBG, DBG_LVL_ALL,
-                                               "Activating thread req");
-                               Adapter->DriverState = LED_THREAD_ACTIVE;
-                       } else {
-                               BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS,
-                                               OSAL_DBG, DBG_LVL_ALL,
-                                               "DeActivating Thread req.....");
-                               Adapter->DriverState = LED_THREAD_INACTIVE;
-                       }
+       case IOCTL_BCM_REGISTER_READ:
+       case IOCTL_BCM_EEPROM_REGISTER_READ:
+               Status = bcm_char_ioctl_eeprom_reg_read(argp, Adapter);
+               return Status;
 
-                       /* signal thread. */
-                       wake_up(&Adapter->LEDInfo.notify_led_event);
-               }
-       }
-       break;
+       case IOCTL_BCM_REGISTER_WRITE:
+       case IOCTL_BCM_EEPROM_REGISTER_WRITE:
+               Status = bcm_char_ioctl_eeprom_reg_write(argp, Adapter, cmd);
+               return Status;
+
+       case IOCTL_BCM_GPIO_SET_REQUEST:
+               Status = bcm_char_ioctl_gpio_set_request(argp, Adapter);
+               return Status;
+
+       case BCM_LED_THREAD_STATE_CHANGE_REQ:
+               Status = bcm_char_ioctl_led_thread_state_change_req(argp, Adapter);
+               return Status;
 
        case IOCTL_BCM_GPIO_STATUS_REQUEST: {
                ULONG uiBit = 0;