libertas: clean up direct command handling

Move direct command handling through __lbs_cmd() over to using the
header as the first member of the command structure, and only define
the __lbs_cmd() callback in one place rather than 3.  Convert boot2
version command to new usage.

Signed-off-by: Dan Williams <dcbw@redhat.com>
Signed-off-by: David Woodhouse <dwmw2@infradead.org>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

diff --git a/drivers/net/wireless/libertas/cmd.c b/drivers/net/wireless/libertas/cmd.c
index 2efba5708041dea0eae043feb23c643bffc995c2..78870c7704289f40c6c5caec6d1b61c4bdc8df59 100644 (file)
--- a/drivers/net/wireless/libertas/cmd.c
+++ b/drivers/net/wireless/libertas/cmd.c
@@ -1988,12 +1988,13 @@ void lbs_ps_confirm_sleep(struct lbs_private *priv, u16 psmode)
  *                      the result code from the firmware
  */
 
-int __lbs_cmd(struct lbs_private *priv, uint16_t command, void *cmd, int cmd_size,
-             int (*callback)(struct lbs_private *, unsigned long, struct cmd_ds_command *),
+int __lbs_cmd(struct lbs_private *priv, uint16_t command,
+             struct cmd_header *in_cmd, int in_cmd_size,
+             int (*callback)(struct lbs_private *, unsigned long, struct cmd_header *),
              unsigned long callback_arg)
 {
        struct cmd_ctrl_node *cmdnode;
-       struct cmd_ds_gen *cmdptr;
+       struct cmd_header *send_cmd;
        unsigned long flags;
        int ret = 0;
 
@@ -2012,7 +2013,6 @@ int __lbs_cmd(struct lbs_private *priv, uint16_t command, void *cmd, int cmd_siz
        }
 
        cmdnode = lbs_get_cmd_ctrl_node(priv);
-
        if (cmdnode == NULL) {
                lbs_deb_host("PREP_CMD: cmdnode is NULL\n");
 
@@ -2022,18 +2022,20 @@ int __lbs_cmd(struct lbs_private *priv, uint16_t command, void *cmd, int cmd_siz
                goto done;
        }
 
-       cmdptr = (struct cmd_ds_gen *)cmdnode->bufvirtualaddr;
+       send_cmd = (struct cmd_header *) cmdnode->bufvirtualaddr;
        cmdnode->wait_option = CMD_OPTION_WAITFORRSP;
        cmdnode->callback = callback;
        cmdnode->callback_arg = callback_arg;
 
+       /* Copy the incoming command to the buffer */
+       memcpy(send_cmd, in_cmd, in_cmd_size);
+
        /* Set sequence number, clean result, move to buffer */
        priv->seqnum++;
-       cmdptr->command = cpu_to_le16(command);
-       cmdptr->size    = cpu_to_le16(cmd_size + S_DS_GEN);
-       cmdptr->seqnum = cpu_to_le16(priv->seqnum);
-       cmdptr->result = 0;
-       memcpy(cmdptr->cmdresp, cmd, cmd_size);
+       send_cmd->command = cpu_to_le16(command);
+       send_cmd->size    = cpu_to_le16(in_cmd_size);
+       send_cmd->seqnum  = cpu_to_le16(priv->seqnum);
+       send_cmd->result  = 0;
 
        lbs_deb_host("PREP_CMD: command 0x%04x\n", command);
 

diff --git a/drivers/net/wireless/libertas/cmd.h b/drivers/net/wireless/libertas/cmd.h
index 546db4996487447902cae7f0df441109792356f7..259d3e87193f18739e22d09797ec80c54932484d 100644 (file)
--- a/drivers/net/wireless/libertas/cmd.h
+++ b/drivers/net/wireless/libertas/cmd.h
@@ -7,10 +7,12 @@
 #include "dev.h"
 
 #define lbs_cmd(priv, cmdnr, cmd, callback, callback_arg) \
-       __lbs_cmd(priv, cmdnr, &cmd, sizeof(cmd), callback, callback_arg)
+       __lbs_cmd(priv, cmdnr, (struct cmd_header *) &cmd, sizeof(cmd), \
+                       callback, callback_arg)
 
-int __lbs_cmd(struct lbs_private *priv, uint16_t command, void *cmd, int cmd_size, 
-             int (*callback)(struct lbs_private *, unsigned long, struct cmd_ds_command *),
+int __lbs_cmd(struct lbs_private *priv, uint16_t command,
+             struct cmd_header *in_cmd, int in_cmd_size, 
+             int (*callback)(struct lbs_private *, unsigned long, struct cmd_header *),
              unsigned long callback_arg);
 
 #endif /* _LBS_CMD_H */

diff --git a/drivers/net/wireless/libertas/cmdresp.c b/drivers/net/wireless/libertas/cmdresp.c
index 7bad257fd9cbb22189126e28156bc0cf2655a0a0..91136697f697deed0fee1bde1a97454c591487a1 100644 (file)
--- a/drivers/net/wireless/libertas/cmdresp.c
+++ b/drivers/net/wireless/libertas/cmdresp.c
@@ -861,9 +861,10 @@ int lbs_process_rx_command(struct lbs_private *priv)
 
        spin_unlock_irqrestore(&priv->driver_lock, flags);
 
-       if (priv->cur_cmd && priv->cur_cmd->callback)
-               ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg, resp);
-       else
+       if (priv->cur_cmd && priv->cur_cmd->callback) {
+               ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg,
+                               (struct cmd_header *) resp);
+       } else
                ret = handle_cmd_response(priv, 0, resp);
 
        spin_lock_irqsave(&priv->driver_lock, flags);

diff --git a/drivers/net/wireless/libertas/hostcmd.h b/drivers/net/wireless/libertas/hostcmd.h
index ed502b74fa3c9c83264707a72af2aa79ff21812e..93ac46a05c54db724e5a5e3330823cacf35eac45 100644 (file)
--- a/drivers/net/wireless/libertas/hostcmd.h
+++ b/drivers/net/wireless/libertas/hostcmd.h
@@ -65,13 +65,20 @@ struct rxpd {
        u8 reserved[3];
 };
 
+struct cmd_header {
+       __le16 command;
+       __le16 size;
+       __le16 seqnum;
+       __le16 result;
+} __attribute__ ((packed));
+
 struct cmd_ctrl_node {
        struct list_head list;
        /* wait for finish or not */
        u16 wait_option;
        /* command response */
        void *pdata_buf;
-       int (*callback)(struct lbs_private *priv, unsigned long arg, struct cmd_ds_command *resp);
+       int (*callback)(struct lbs_private *, unsigned long, struct cmd_header *);
        unsigned long callback_arg;
        /* command data */
        u8 *bufvirtualaddr;
@@ -424,6 +431,8 @@ struct cmd_ds_802_11_monitor_mode {
 };
 
 struct cmd_ds_set_boot2_ver {
+       struct cmd_header hdr;
+
        __le16 action;
        __le16 version;
 };
@@ -678,7 +687,6 @@ struct cmd_ds_command {
                struct cmd_ds_bt_access bt;
                struct cmd_ds_fwt_access fwt;
                struct cmd_ds_mesh_access mesh;
-               struct cmd_ds_set_boot2_ver boot2_ver;
                struct cmd_ds_get_tsf gettsf;
                struct cmd_ds_802_11_subscribe_event subscribe_event;
                struct cmd_ds_802_11_beacon_control bcn_ctrl;