1 /*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 *
16 * File: wcmd.c
17 *
18 * Purpose: Handles the management command interface functions
19 *
20 * Author: Lyndon Chen
21 *
22 * Date: May 8, 2003
23 *
24 * Functions:
25 * vnt_cmd_complete - Command Complete function
26 * vnt_schedule_command - Push Command and wait Command Scheduler to do
27 * vnt_cmd_timer_wait- Call back timer
28 *
29 * Revision History:
30 *
31 */
32
33 #include "device.h"
34 #include "mac.h"
35 #include "wcmd.h"
36 #include "power.h"
37 #include "usbpipe.h"
38 #include "rxtx.h"
39 #include "rf.h"
40
vnt_cmd_timer_wait(struct vnt_private * priv,unsigned long msecs)41 static void vnt_cmd_timer_wait(struct vnt_private *priv, unsigned long msecs)
42 {
43 schedule_delayed_work(&priv->run_command_work, msecs_to_jiffies(msecs));
44 }
45
vnt_cmd_complete(struct vnt_private * priv)46 static int vnt_cmd_complete(struct vnt_private *priv)
47 {
48 priv->command_state = WLAN_CMD_IDLE;
49 if (priv->free_cmd_queue == CMD_Q_SIZE) {
50 /* Command Queue Empty */
51 priv->cmd_running = false;
52 return true;
53 }
54
55 priv->command = priv->cmd_queue[priv->cmd_dequeue_idx];
56
57 ADD_ONE_WITH_WRAP_AROUND(priv->cmd_dequeue_idx, CMD_Q_SIZE);
58 priv->free_cmd_queue++;
59 priv->cmd_running = true;
60
61 switch (priv->command) {
62 case WLAN_CMD_INIT_MAC80211:
63 priv->command_state = WLAN_CMD_INIT_MAC80211_START;
64 break;
65
66 case WLAN_CMD_TBTT_WAKEUP:
67 priv->command_state = WLAN_CMD_TBTT_WAKEUP_START;
68 break;
69
70 case WLAN_CMD_BECON_SEND:
71 priv->command_state = WLAN_CMD_BECON_SEND_START;
72 break;
73
74 case WLAN_CMD_SETPOWER:
75 priv->command_state = WLAN_CMD_SETPOWER_START;
76 break;
77
78 case WLAN_CMD_CHANGE_ANTENNA:
79 priv->command_state = WLAN_CMD_CHANGE_ANTENNA_START;
80 break;
81
82 default:
83 break;
84 }
85
86 vnt_cmd_timer_wait(priv, 0);
87
88 return true;
89 }
90
vnt_run_command(struct work_struct * work)91 void vnt_run_command(struct work_struct *work)
92 {
93 struct vnt_private *priv =
94 container_of(work, struct vnt_private, run_command_work.work);
95
96 if (test_bit(DEVICE_FLAGS_DISCONNECTED, &priv->flags))
97 return;
98
99 if (!priv->cmd_running)
100 return;
101
102 switch (priv->command_state) {
103 case WLAN_CMD_INIT_MAC80211_START:
104 if (priv->mac_hw)
105 break;
106
107 dev_info(&priv->usb->dev, "Starting mac80211\n");
108
109 if (vnt_init(priv)) {
110 /* If fail all ends TODO retry */
111 dev_err(&priv->usb->dev, "failed to start\n");
112 usb_set_intfdata(priv->intf, NULL);
113 ieee80211_free_hw(priv->hw);
114 return;
115 }
116
117 break;
118
119 case WLAN_CMD_TBTT_WAKEUP_START:
120 vnt_next_tbtt_wakeup(priv);
121 break;
122
123 case WLAN_CMD_BECON_SEND_START:
124 if (!priv->vif)
125 break;
126
127 vnt_beacon_make(priv, priv->vif);
128
129 vnt_mac_reg_bits_on(priv, MAC_REG_TCR, TCR_AUTOBCNTX);
130
131 break;
132
133 case WLAN_CMD_SETPOWER_START:
134
135 vnt_rf_setpower(priv, priv->current_rate,
136 priv->hw->conf.chandef.chan->hw_value);
137
138 break;
139
140 case WLAN_CMD_CHANGE_ANTENNA_START:
141 dev_dbg(&priv->usb->dev, "Change from Antenna%d to",
142 priv->rx_antenna_sel);
143
144 if (priv->rx_antenna_sel == 0) {
145 priv->rx_antenna_sel = 1;
146 if (priv->tx_rx_ant_inv)
147 vnt_set_antenna_mode(priv, ANT_RXA);
148 else
149 vnt_set_antenna_mode(priv, ANT_RXB);
150 } else {
151 priv->rx_antenna_sel = 0;
152 if (priv->tx_rx_ant_inv)
153 vnt_set_antenna_mode(priv, ANT_RXB);
154 else
155 vnt_set_antenna_mode(priv, ANT_RXA);
156 }
157 break;
158
159 default:
160 break;
161 }
162
163 vnt_cmd_complete(priv);
164 }
165
vnt_schedule_command(struct vnt_private * priv,enum vnt_cmd command)166 int vnt_schedule_command(struct vnt_private *priv, enum vnt_cmd command)
167 {
168 if (priv->free_cmd_queue == 0)
169 return false;
170
171 priv->cmd_queue[priv->cmd_enqueue_idx] = command;
172
173 ADD_ONE_WITH_WRAP_AROUND(priv->cmd_enqueue_idx, CMD_Q_SIZE);
174 priv->free_cmd_queue--;
175
176 if (!priv->cmd_running)
177 vnt_cmd_complete(priv);
178
179 return true;
180 }
181
vnt_reset_command_timer(struct vnt_private * priv)182 void vnt_reset_command_timer(struct vnt_private *priv)
183 {
184 priv->free_cmd_queue = CMD_Q_SIZE;
185 priv->cmd_dequeue_idx = 0;
186 priv->cmd_enqueue_idx = 0;
187 priv->command_state = WLAN_CMD_IDLE;
188 priv->cmd_running = false;
189 }
190