carl9170 firmware: revamp Content After Beacon handling
[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 #ifdef CONFIG_CARL9170FW_FW_MAC_RESET
63                 /*
64                  * Command has no payload, so the response
65                  * has no payload either.
66                  * resp->hdr.len = 0;
67                  */
68                 fw.wlan.mac_reset = CARL9170_MAC_RESET_FORCE;
69 #endif /* CONFIG_CARL9170FW_FW_MAC_RESET */
70                 break;
71
72         case CARL9170_CMD_REBOOT:
73                 /*
74                  * resp->len = 0;
75                  */
76                 fw.reboot = 1;
77                 break;
78
79         case CARL9170_CMD_READ_TSF:
80                 resp->hdr.len = 8;
81                 read_tsf((uint32_t *)resp->tsf.tsf);
82                 break;
83
84 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
85         case CARL9170_CMD_FLUSH_CAB:
86                 resp->hdr.len = 0;
87
88                 if (cmd->cab_flush.mode & CARL9170_CAB_FLUSH_CAB_TRIGGER) {
89                         wlan_cab_modify_dtim_beacon(cmd->cab_flush.vif_id);
90                         set(AR9170_MAC_REG_BCN_CTRL, AR9170_BCN_CTRL_READY);
91                 } else {
92                         wlan_cab_flush_queue(cmd->cab_flush.vif_id);
93                         fw.wlan.cab_flush_trigger[i] = CARL9170_CAB_TRIGGER_EMPTY;
94                 }
95                 break;
96 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
97
98 #ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
99         case CARL9170_CMD_EKEY:
100                 resp->hdr.len = 0;
101                 set_key(&cmd->setkey);
102                 break;
103
104         case CARL9170_CMD_DKEY:
105                 resp->hdr.len = 0;
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                 BUG("Unknown command %x\n", cmd->hdr.cmd);
134                 break;
135         }
136 }