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