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 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 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 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 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 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