carlfw/src/cmd.c

   1 /*
   2  * carl9170 firmware - used by the ar9170 wireless device
   3  *
   4  * Code to handle commands from the host driver.
   5  *
   6  * Copyright (c) 2000-2005 ZyDAS Technology Corporation
   7  * Copyright (c) 2007-2009 Atheros Communications, Inc.
   8  * Copyright    2009    Johannes Berg <johannes@sipsolutions.net>
   9  * Copyright 2009-2011  Christian Lamparter <chunkeey@googlemail.com>
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License as published by
  13  * the Free Software Foundation; either version 2 of the License, or
  14  * (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  * GNU General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License along
  22  * with this program; if not, write to the Free Software Foundation, Inc.,
  23  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  24  */
  25
  26 #include "carl9170.h"
  27 #include "io.h"
  28 #include "cam.h"
  29 #include "rf.h"
  30 #include "printf.h"
  31 #include "timer.h"
  32 #include "wl.h"
  33 #include "wol.h"
  34
  35 void handle_cmd(struct carl9170_rsp *resp)
  36 {
  37         struct carl9170_cmd *cmd = &dma_mem.reserved.cmd.cmd;
  38         unsigned int i;
  39
  40         /* copies cmd, len and extra fields */
  41         resp->hdr.len = cmd->hdr.len;
  42         resp->hdr.cmd = cmd->hdr.cmd;
  43         resp->hdr.ext = cmd->hdr.ext;
  44         resp->hdr.seq |= cmd->hdr.seq;
  45
  46         switch (cmd->hdr.cmd & ~CARL9170_CMD_ASYNC_FLAG) {
  47         case CARL9170_CMD_RREG:
  48                 for (i = 0; i < (cmd->hdr.len / 4); i++)
  49                         resp->rreg_res.vals[i] = get(cmd->rreg.regs[i]);
  50                 break;
  51
  52         case CARL9170_CMD_WREG:
  53                 resp->hdr.len = 0;
  54                 for (i = 0; i < (cmd->hdr.len / 8); i++)
  55                         set(cmd->wreg.regs[i].addr, cmd->wreg.regs[i].val);
  56                 break;
  57
  58         case CARL9170_CMD_ECHO:
  59                 memcpy(resp->echo.vals, cmd->echo.vals, cmd->hdr.len);
  60                 break;
  61
  62         case CARL9170_CMD_SWRST:
  63 #ifdef CONFIG_CARL9170FW_FW_MAC_RESET
  64                 /*
  65                  * Command has no payload, so the response
  66                  * has no payload either.
  67                  * resp->hdr.len = 0;
  68                  */
  69                 fw.wlan.mac_reset = CARL9170_MAC_RESET_FORCE;
  70 #endif /* CONFIG_CARL9170FW_FW_MAC_RESET */
  71                 break;
  72
  73         case CARL9170_CMD_REBOOT:
  74                 /*
  75                  * resp->len = 0;
  76                  */
  77                 fw.reboot = 1;
  78                 break;
  79
  80         case CARL9170_CMD_READ_TSF:
  81                 resp->hdr.len = 8;
  82                 read_tsf((uint32_t *)resp->tsf.tsf);
  83                 break;
  84
  85         case CARL9170_CMD_RX_FILTER:
  86                 resp->hdr.len = 0;
  87                 fw.wlan.rx_filter = cmd->rx_filter.rx_filter;
  88                 break;
  89
  90         case CARL9170_CMD_WOL:
  91                 wol_cmd(&cmd->wol);
  92                 break;
  93
  94         case CARL9170_CMD_TALLY:
  95                 resp->hdr.len = sizeof(struct carl9170_tally_rsp);
  96                 memcpy(&resp->tally, &fw.tally, sizeof(struct carl9170_tally_rsp));
  97                 resp->tally.tick = fw.ticks_per_usec;
  98                 memset(&fw.tally, 0, sizeof(struct carl9170_tally_rsp));
  99                 break;
 100
 101 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
 102         case CARL9170_CMD_BCN_CTRL:
 103                 resp->hdr.len = 0;
 104
 105                 if (cmd->bcn_ctrl.mode & CARL9170_BCN_CTRL_CAB_TRIGGER) {
 106                         wlan_modify_beacon(cmd->bcn_ctrl.vif_id,
 107                                 cmd->bcn_ctrl.bcn_addr, cmd->bcn_ctrl.bcn_len);
 108                         set(AR9170_MAC_REG_BCN_ADDR, cmd->bcn_ctrl.bcn_addr);
 109                         set(AR9170_MAC_REG_BCN_LENGTH, cmd->bcn_ctrl.bcn_len);
 110                         set(AR9170_MAC_REG_BCN_CTRL, AR9170_BCN_CTRL_READY);
 111                 } else {
 112                         wlan_cab_flush_queue(cmd->bcn_ctrl.vif_id);
 113                         fw.wlan.cab_flush_trigger[cmd->bcn_ctrl.vif_id] = CARL9170_CAB_TRIGGER_EMPTY;
 114                 }
 115                 break;
 116 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
 117
 118 #ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
 119         case CARL9170_CMD_EKEY:
 120                 resp->hdr.len = 0;
 121                 set_key(&cmd->setkey);
 122                 break;
 123
 124         case CARL9170_CMD_DKEY:
 125                 resp->hdr.len = 0;
 126                 disable_key(&cmd->disablekey);
 127                 break;
 128 #endif /* CONFIG_CARL9170FW_SECURIT_ENGINE */
 129
 130 #ifdef CONFIG_CARL9170FW_RADIO_FUNCTIONS
 131         case CARL9170_CMD_FREQUENCY:
 132         case CARL9170_CMD_RF_INIT:
 133                 rf_cmd(cmd, resp);
 134                 break;
 135
 136         case CARL9170_CMD_FREQ_START:
 137                 /*
 138                  * resp->hdr.len = 0;
 139                  */
 140                 rf_notify_set_channel();
 141                 break;
 142
 143         case CARL9170_CMD_PSM:
 144                 resp->hdr.len = 0;
 145                 fw.phy.psm.state = le32_to_cpu(cmd->psm.state);
 146                 rf_psm();
 147                 break;
 148 #endif /* CONFIG_CARL9170FW_RADIO_FUNCTIOS */
 149
 150         default:
 151                 BUG("Unknown command %x\n", cmd->hdr.cmd);
 152                 break;
 153         }
 154 }