carl9170 toolchain: update to gcc 9.1.0
[carl9170fw.git] / carlfw / src / hostif.c
index 0e7cbf2a23d572b614e095d6e65c5b2071c3b5a4..06726dbdf7d9c6e47b9556ef0a550c4b6c61a205 100644 (file)
@@ -6,7 +6,7 @@
  * Copyright (c) 2000-2005 ZyDAS Technology Corporation
  * Copyright (c) 2007-2009 Atheros Communications, Inc.
  * Copyright   2009    Johannes Berg <johannes@sipsolutions.net>
- * Copyright 2009-2011 Christian Lamparter <chunkeey@googlemail.com>
+ * Copyright 2009-2012 Christian Lamparter <chunkeey@googlemail.com>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
  * GNU General Public License for more details.
  *
  * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ * with this program; If not, see <http://www.gnu.org/licenses/>.
  */
 
 #include "carl9170.h"
 #include "hostif.h"
 #include "printf.h"
 #include "wl.h"
+#include "io.h"
+#include "cam.h"
+#include "rf.h"
+#include "timer.h"
+#include "wol.h"
 
 static bool length_check(struct dma_desc *desc)
 {
@@ -96,13 +100,8 @@ static void handle_upload(void)
                        fw.usb.int_desc = desc;
                        fw.usb.int_desc_available = 1;
                } else {
-#ifdef CONFIG_CARL9170FW_LOOPBACK
-                       dma_reclaim(&fw.pta.down_queue, desc);
-                       down_trigger();
-#else
                        dma_reclaim(&fw.wlan.rx_queue, desc);
                        wlan_trigger(AR9170_DMA_TRIGGER_RXQ);
-#endif /* CONFIG_CARL9170FW_LOOPBACK */
                }
        }
 
@@ -134,9 +133,8 @@ static void handle_download_exception(void)
        }
 
        __for_each_desc_continue(desc, &fw.pta.down_queue) {
-               if ((desc->status & AR9170_OWN_BITS) == AR9170_OWN_BITS_SW) {
+               if ((desc->status & AR9170_OWN_BITS) == AR9170_OWN_BITS_SW)
                        dma_fix_downqueue(desc);
-               }
        }
 
 
@@ -169,3 +167,132 @@ void handle_host_interface(void)
 
 #undef HANDLER
 }
+
+void handle_cmd(struct carl9170_rsp *resp)
+{
+       struct carl9170_cmd *cmd = &dma_mem.reserved.cmd.cmd;
+       unsigned int i;
+
+       /* copies cmd, len and extra fields */
+       resp->hdr.len = cmd->hdr.len;
+       resp->hdr.cmd = cmd->hdr.cmd;
+       resp->hdr.ext = cmd->hdr.ext;
+       resp->hdr.seq |= cmd->hdr.seq;
+
+       switch (cmd->hdr.cmd & ~CARL9170_CMD_ASYNC_FLAG) {
+       case CARL9170_CMD_RREG:
+               for (i = 0; i < (cmd->hdr.len / 4); i++)
+                       resp->rreg_res.vals[i] = get(cmd->rreg.regs[i]);
+               break;
+
+       case CARL9170_CMD_WREG:
+               resp->hdr.len = 0;
+               for (i = 0; i < (cmd->hdr.len / 8); i++)
+                       set(cmd->wreg.regs[i].addr, cmd->wreg.regs[i].val);
+               break;
+
+       case CARL9170_CMD_ECHO:
+               memcpy(resp->echo.vals, cmd->echo.vals, cmd->hdr.len);
+               break;
+
+       case CARL9170_CMD_SWRST:
+#ifdef CONFIG_CARL9170FW_FW_MAC_RESET
+               /*
+                * Command has no payload, so the response
+                * has no payload either.
+                * resp->hdr.len = 0;
+                */
+               fw.wlan.mac_reset = CARL9170_MAC_RESET_FORCE;
+#endif /* CONFIG_CARL9170FW_FW_MAC_RESET */
+               break;
+
+       case CARL9170_CMD_REBOOT:
+               /*
+                * resp->len = 0;
+                */
+               fw.reboot = 1;
+               break;
+
+       case CARL9170_CMD_READ_TSF: {
+               uint32_t tmptsf[2];
+
+               read_tsf(tmptsf);
+               resp->hdr.len = 8;
+               memcpy(resp->tsf.tsf, tmptsf, sizeof(tmptsf));
+               break;
+               }
+
+       case CARL9170_CMD_RX_FILTER:
+               resp->hdr.len = 0;
+               fw.wlan.rx_filter = cmd->rx_filter.rx_filter;
+               break;
+
+       case CARL9170_CMD_WOL:
+               wol_cmd(&cmd->wol);
+               break;
+
+       case CARL9170_CMD_TALLY:
+               resp->hdr.len = sizeof(struct carl9170_tally_rsp);
+               memcpy(&resp->tally, &fw.tally, sizeof(struct carl9170_tally_rsp));
+               resp->tally.tick = fw.ticks_per_usec;
+               memset(&fw.tally, 0, sizeof(struct carl9170_tally_rsp));
+               break;
+
+       case CARL9170_CMD_WREGB:
+               resp->hdr.len = 0;
+               for (i = 0; i < MIN(cmd->wregb.count, cmd->hdr.len - 8); i++)
+                       setb(cmd->wregb.addr + i, cmd->wregb.val[i]);
+               break;
+
+       case CARL9170_CMD_BCN_CTRL:
+               resp->hdr.len = 0;
+
+               if (cmd->bcn_ctrl.mode & CARL9170_BCN_CTRL_CAB_TRIGGER) {
+                       wlan_modify_beacon(cmd->bcn_ctrl.vif_id,
+                               cmd->bcn_ctrl.bcn_addr, cmd->bcn_ctrl.bcn_len);
+                       set(AR9170_MAC_REG_BCN_ADDR, cmd->bcn_ctrl.bcn_addr);
+                       set(AR9170_MAC_REG_BCN_LENGTH, cmd->bcn_ctrl.bcn_len);
+                       set(AR9170_MAC_REG_BCN_CTRL, AR9170_BCN_CTRL_READY);
+               } else {
+                       wlan_cab_flush_queue(cmd->bcn_ctrl.vif_id);
+                       fw.wlan.cab_flush_trigger[cmd->bcn_ctrl.vif_id] = CARL9170_CAB_TRIGGER_EMPTY;
+               }
+               break;
+
+#ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
+       case CARL9170_CMD_EKEY:
+               resp->hdr.len = 0;
+               set_key(&cmd->setkey);
+               break;
+
+       case CARL9170_CMD_DKEY:
+               resp->hdr.len = 0;
+               disable_key(&cmd->disablekey);
+               break;
+#endif /* CONFIG_CARL9170FW_SECURITY_ENGINE */
+
+#ifdef CONFIG_CARL9170FW_RADIO_FUNCTIONS
+       case CARL9170_CMD_FREQUENCY:
+       case CARL9170_CMD_RF_INIT:
+               rf_cmd(cmd, resp);
+               break;
+
+       case CARL9170_CMD_FREQ_START:
+               /*
+                * resp->hdr.len = 0;
+                */
+               rf_notify_set_channel();
+               break;
+
+       case CARL9170_CMD_PSM:
+               resp->hdr.len = 0;
+               fw.phy.psm.state = le32_to_cpu(cmd->psm.state);
+               rf_psm();
+               break;
+#endif /* CONFIG_CARL9170FW_RADIO_FUNCTIONS */
+
+       default:
+               BUG("Unknown command %x\n", cmd->hdr.cmd);
+               break;
+       }
+}