carl9170 firmware: mac reset refactoring, take-2
[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                         if (fw.wlan.cab_flush_vif == cmd->cab_flush.vif_id)
94                                 fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_EMPTY;
95                 }
96                 break;
97 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
98
99 #ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
100         case CARL9170_CMD_EKEY:
101                 resp->hdr.len = 0;
102                 set_key(&cmd->setkey);
103                 break;
104
105         case CARL9170_CMD_DKEY:
106                 resp->hdr.len = 0;
107                 disable_key(&cmd->disablekey);
108                 break;
109 #endif /* CONFIG_CARL9170FW_SECURIT_ENGINE */
110
111 #ifdef CONFIG_CARL9170FW_RADIO_FUNCTIONS
112         case CARL9170_CMD_FREQUENCY:
113         case CARL9170_CMD_RF_INIT:
114                 rf_cmd(cmd, resp);
115                 break;
116
117         case CARL9170_CMD_FREQ_START:
118                 /*
119                  * resp->hdr.len = 0;
120                  */
121                 rf_notify_set_channel();
122                 break;
123
124 # ifdef CONFIG_CARL9170FW_PSM
125         case CARL9170_CMD_PSM:
126                 resp->hdr.len = 0;
127                 fw.phy.psm.state = le32_to_cpu(cmd->psm.state);
128                 rf_psm();
129                 break;
130 # endif /* CONFIG_CARL9170FW_PSM */
131 #endif /* CONFIG_CARL9170FW_RADIO_FUNCTIOS */
132
133         default:
134                 BUG("Unknown command %x\n", cmd->hdr.cmd);
135                 break;
136         }
137 }