Commit 1723047d authored by David Woodhouse's avatar David Woodhouse Committed by David S. Miller

libertas: Switch to using a callback function pointer for commands

Signed-off-by: default avatarDavid Woodhouse <dwmw2@infradead.org>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent 0856e681
...@@ -1659,7 +1659,8 @@ static void cleanup_cmdnode(struct cmd_ctrl_node *ptempnode) ...@@ -1659,7 +1659,8 @@ static void cleanup_cmdnode(struct cmd_ctrl_node *ptempnode)
wake_up_interruptible(&ptempnode->cmdwait_q); wake_up_interruptible(&ptempnode->cmdwait_q);
ptempnode->wait_option = 0; ptempnode->wait_option = 0;
ptempnode->pdata_buf = NULL; ptempnode->pdata_buf = NULL;
ptempnode->pdata_size = 0; ptempnode->pdata_size = NULL;
ptempnode->callback = NULL;
if (ptempnode->bufvirtualaddr != NULL) if (ptempnode->bufvirtualaddr != NULL)
memset(ptempnode->bufvirtualaddr, 0, MRVDRV_SIZE_OF_CMD_BUFFER); memset(ptempnode->bufvirtualaddr, 0, MRVDRV_SIZE_OF_CMD_BUFFER);
...@@ -1687,7 +1688,8 @@ void lbs_set_cmd_ctrl_node(struct lbs_private *priv, ...@@ -1687,7 +1688,8 @@ void lbs_set_cmd_ctrl_node(struct lbs_private *priv,
ptempnode->wait_option = wait_option; ptempnode->wait_option = wait_option;
ptempnode->pdata_buf = pdata_buf; ptempnode->pdata_buf = pdata_buf;
ptempnode->pdata_size = 0; ptempnode->pdata_size = NULL;
ptempnode->callback = NULL;
lbs_deb_leave(LBS_DEB_HOST); lbs_deb_leave(LBS_DEB_HOST);
} }
...@@ -2012,10 +2014,26 @@ void lbs_ps_confirm_sleep(struct lbs_private *priv, u16 psmode) ...@@ -2012,10 +2014,26 @@ void lbs_ps_confirm_sleep(struct lbs_private *priv, u16 psmode)
* @return -1 in case of a higher level error, otherwise * @return -1 in case of a higher level error, otherwise
* the result code from the firmware * the result code from the firmware
*/ */
int lbs_cmd(struct lbs_private *priv,
u16 command, static int lbs_cmd_callback(uint16_t respcmd, struct cmd_ds_command *resp, struct lbs_private *priv)
void *cmd, int cmd_size, {
void *rsp, int *rsp_size) struct cmd_ds_gen *r = (struct cmd_ds_gen *)resp;
struct lbs_adapter *adapter = priv->adapter;
u16 sz = cpu_to_le16(resp->size) - S_DS_GEN;
if (sz > *adapter->cur_cmd->pdata_size) {
lbs_pr_err("response 0x%04x doesn't fit into buffer (%d > %d)\n",
respcmd, sz, *adapter->cur_cmd->pdata_size);
sz = *adapter->cur_cmd->pdata_size;
}
memcpy(adapter->cur_cmd->pdata_buf, r->cmdresp, sz);
*adapter->cur_cmd->pdata_size = sz;
return 0;
}
int lbs_cmd(struct lbs_private *priv, u16 command, void *cmd, int cmd_size,
void *rsp, int *rsp_size)
{ {
struct lbs_adapter *adapter = priv->adapter; struct lbs_adapter *adapter = priv->adapter;
struct cmd_ctrl_node *cmdnode; struct cmd_ctrl_node *cmdnode;
...@@ -2053,6 +2071,7 @@ int lbs_cmd(struct lbs_private *priv, ...@@ -2053,6 +2071,7 @@ int lbs_cmd(struct lbs_private *priv,
cmdnode->wait_option = CMD_OPTION_WAITFORRSP; cmdnode->wait_option = CMD_OPTION_WAITFORRSP;
cmdnode->pdata_buf = rsp; cmdnode->pdata_buf = rsp;
cmdnode->pdata_size = rsp_size; cmdnode->pdata_size = rsp_size;
cmdnode->callback = lbs_cmd_callback;
/* Set sequence number, clean result, move to buffer */ /* Set sequence number, clean result, move to buffer */
adapter->seqnum++; adapter->seqnum++;
......
...@@ -880,22 +880,15 @@ int lbs_process_rx_command(struct lbs_private *priv) ...@@ -880,22 +880,15 @@ int lbs_process_rx_command(struct lbs_private *priv)
goto done; goto done;
} }
if (adapter->cur_cmd->pdata_size) { spin_unlock_irqrestore(&adapter->driver_lock, flags);
struct cmd_ds_gen *r = (struct cmd_ds_gen *)resp;
u16 sz = cpu_to_le16(resp->size) - S_DS_GEN; if (adapter->cur_cmd && adapter->cur_cmd->callback)
if (sz > *adapter->cur_cmd->pdata_size) { ret = adapter->cur_cmd->callback(respcmd, resp, priv);
lbs_pr_err("response 0x%04x doesn't fit into " else
"buffer (%d > %d)\n", respcmd,
sz, *adapter->cur_cmd->pdata_size);
sz = *adapter->cur_cmd->pdata_size;
}
memcpy(adapter->cur_cmd->pdata_buf, r->cmdresp, sz);
*adapter->cur_cmd->pdata_size = sz;
} else {
spin_unlock_irqrestore(&adapter->driver_lock, flags);
ret = handle_cmd_response(respcmd, resp, priv); ret = handle_cmd_response(respcmd, resp, priv);
spin_lock_irqsave(&adapter->driver_lock, flags);
} spin_lock_irqsave(&adapter->driver_lock, flags);
if (adapter->cur_cmd) { if (adapter->cur_cmd) {
/* Clean up and Put current command back to cmdfreeq */ /* Clean up and Put current command back to cmdfreeq */
__lbs_cleanup_and_insert_cmd(priv, adapter->cur_cmd); __lbs_cleanup_and_insert_cmd(priv, adapter->cur_cmd);
......
...@@ -72,6 +72,7 @@ struct cmd_ctrl_node { ...@@ -72,6 +72,7 @@ struct cmd_ctrl_node {
/* command response */ /* command response */
void *pdata_buf; void *pdata_buf;
int *pdata_size; int *pdata_size;
int (*callback)(uint16_t respcmd, struct cmd_ds_command *resp, struct lbs_private *priv);
/* command data */ /* command data */
u8 *bufvirtualaddr; u8 *bufvirtualaddr;
/* wait queue */ /* wait queue */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment