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