carl9170 firmware: Support multiple CAB queues
[carl9170fw.git] / 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, 2010 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
34 void handle_cmd(struct carl9170_rsp *resp)
35 {
36         struct carl9170_cmd *cmd = &dma_mem.reserved.cmd.cmd;
37         unsigned int i;
38
39         /* copies cmd, len and extra fields */
40         resp->hdr.len = cmd->hdr.len;
41         resp->hdr.cmd = cmd->hdr.cmd;
42         resp->hdr.ext = cmd->hdr.ext;
43         resp->hdr.seq |= cmd->hdr.seq;
44
45         switch (cmd->hdr.cmd & ~CARL9170_CMD_ASYNC_FLAG) {
46         case CARL9170_CMD_RREG:
47                 for (i = 0; i < (cmd->hdr.len / 4); i++)
48                         resp->rreg_res.vals[i] = get(cmd->rreg.regs[i]);
49                 break;
50
51         case CARL9170_CMD_WREG:
52                 resp->hdr.len = 0;
53                 for (i = 0; i < (cmd->hdr.len / 8); i++)
54                         set(cmd->wreg.regs[i].addr, cmd->wreg.regs[i].val);
55                 break;
56
57         case CARL9170_CMD_ECHO:
58                 memcpy(resp->echo.vals, cmd->echo.vals, cmd->hdr.len);
59                 break;
60
61         case CARL9170_CMD_SWRST:
62                 /*
63                  * Command has no payload, so the response
64                  * has no payload either.
65                  * resp->hdr.len = 0;
66                  */
67                 fw.wlan.mac_reset = CARL9170_MAC_RESET_FORCE;
68                 break;
69
70         case CARL9170_CMD_REBOOT:
71                 /*
72                  * resp->len = 0;
73                  */
74                 fw.reboot = 1;
75                 break;
76
77         case CARL9170_CMD_READ_TSF:
78                 resp->hdr.len = 8;
79                 read_tsf((uint32_t *)resp->tsf.tsf);
80                 break;
81
82 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
83         case CARL9170_CMD_FLUSH_CAB:
84                 resp->hdr.len = 0;
85
86                 if (cmd->cab_flush.mode & CARL9170_CAB_FLUSH_CAB_TRIGGER) {
87                         wlan_cab_modify_dtim_beacon(cmd->cab_flush.vif_id);
88                         set(AR9170_MAC_REG_BCN_CTRL, AR9170_BCN_CTRL_READY);
89                 } else {
90                         wlan_cab_flush_queue(cmd->cab_flush.vif_id);
91                         if (fw.wlan.cab_flush_vif == cmd->cab_flush.vif_id)
92                                 fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_EMPTY;
93                 }
94                 break;
95 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
96
97 #ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
98         case CARL9170_CMD_EKEY:
99                 resp->hdr.len = 1;
100                 set_key(&cmd->setkey);
101                 break;
102
103         case CARL9170_CMD_DKEY:
104                 /* Disable Key */
105                 resp->hdr.len = 1;
106                 disable_key(&cmd->disablekey);
107                 break;
108 #endif /* CONFIG_CARL9170FW_SECURIT_ENGINE */
109
110 #ifdef CONFIG_CARL9170FW_RADIO_FUNCTIONS
111         case CARL9170_CMD_FREQUENCY:
112         case CARL9170_CMD_RF_INIT:
113                 rf_cmd(cmd, resp);
114                 break;
115
116         case CARL9170_CMD_FREQ_START:
117                 /*
118                  * resp->hdr.len = 0;
119                  */
120                 rf_notify_set_channel();
121                 break;
122
123 # ifdef CONFIG_CARL9170FW_PSM
124         case CARL9170_CMD_PSM:
125                 resp->hdr.len = 0;
126                 fw.phy.psm.state = le32_to_cpu(cmd->psm.state);
127                 rf_psm();
128                 break;
129 # endif /* CONFIG_CARL9170FW_PSM */
130 #endif /* CONFIG_CARL9170FW_RADIO_FUNCTIOS */
131
132         default:
133                 break;
134         }
135 }