carl9170 firmware: save a few bytes on the command handler
[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                  * reboot does not return and generates no response
73                  * resp->len = 0;
74                  */
75
76                 reboot();
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                 fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_ARMED;
88                 fw.wlan.cab_flush_time = get_clock_counter() +
89                                          CARL9170_TBTT_DELTA;
90                 break;
91 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
92
93 #ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
94         case CARL9170_CMD_EKEY:
95                 resp->hdr.len = 1;
96                 set_key(&cmd->setkey);
97                 break;
98
99         case CARL9170_CMD_DKEY:
100                 /* Disable Key */
101                 resp->hdr.len = 1;
102                 disable_key(&cmd->disablekey);
103                 break;
104 #endif /* CONFIG_CARL9170FW_SECURIT_ENGINE */
105
106 #ifdef CONFIG_CARL9170FW_RADIO_FUNCTIONS
107         case CARL9170_CMD_FREQUENCY:
108         case CARL9170_CMD_RF_INIT:
109                 rf_cmd(cmd, resp);
110                 break;
111
112         case CARL9170_CMD_FREQ_START:
113                 /*
114                  * resp->hdr.len = 0;
115                  */
116                 rf_notify_set_channel();
117                 break;
118
119 # ifdef CONFIG_CARL9170FW_PSM
120         case CARL9170_CMD_PSM:
121                 resp->hdr.len = 0;
122                 fw.phy.psm.state = le32_to_cpu(cmd->psm.state);
123                 rf_psm();
124                 break;
125 # endif /* CONFIG_CARL9170FW_PSM */
126 #endif /* CONFIG_CARL9170FW_RADIO_FUNCTIOS */
127
128 #ifdef CONFIG_CARL9170FW_USB_WATCHDOG
129         case CARL9170_CMD_USB_WD:
130                 resp->hdr.len = 4;
131                 fw.usb.watchdog.state = le32_to_cpu(cmd->watchdog.state);
132                 break;
133
134 #endif /* CONFIG_CARL9170FW_USB_WATCHDOG */
135
136         default:
137                 break;
138         }
139 }