Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / staging / vt6655 / channel.c
diff --git a/kernel/drivers/staging/vt6655/channel.c b/kernel/drivers/staging/vt6655/channel.c
new file mode 100644 (file)
index 0000000..7a71782
--- /dev/null
@@ -0,0 +1,237 @@
+/*
+ * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
+ * All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ *
+ * File: channel.c
+ *
+ */
+
+#include "baseband.h"
+#include "channel.h"
+#include "device.h"
+#include "rf.h"
+
+static struct ieee80211_rate vnt_rates_bg[] = {
+       { .bitrate = 10,  .hw_value = RATE_1M },
+       { .bitrate = 20,  .hw_value = RATE_2M },
+       { .bitrate = 55,  .hw_value = RATE_5M },
+       { .bitrate = 110, .hw_value = RATE_11M },
+       { .bitrate = 60,  .hw_value = RATE_6M },
+       { .bitrate = 90,  .hw_value = RATE_9M },
+       { .bitrate = 120, .hw_value = RATE_12M },
+       { .bitrate = 180, .hw_value = RATE_18M },
+       { .bitrate = 240, .hw_value = RATE_24M },
+       { .bitrate = 360, .hw_value = RATE_36M },
+       { .bitrate = 480, .hw_value = RATE_48M },
+       { .bitrate = 540, .hw_value = RATE_54M },
+};
+
+static struct ieee80211_rate vnt_rates_a[] = {
+       { .bitrate = 60,  .hw_value = RATE_6M },
+       { .bitrate = 90,  .hw_value = RATE_9M },
+       { .bitrate = 120, .hw_value = RATE_12M },
+       { .bitrate = 180, .hw_value = RATE_18M },
+       { .bitrate = 240, .hw_value = RATE_24M },
+       { .bitrate = 360, .hw_value = RATE_36M },
+       { .bitrate = 480, .hw_value = RATE_48M },
+       { .bitrate = 540, .hw_value = RATE_54M },
+};
+
+static struct ieee80211_channel vnt_channels_2ghz[] = {
+       { .center_freq = 2412, .hw_value = 1 },
+       { .center_freq = 2417, .hw_value = 2 },
+       { .center_freq = 2422, .hw_value = 3 },
+       { .center_freq = 2427, .hw_value = 4 },
+       { .center_freq = 2432, .hw_value = 5 },
+       { .center_freq = 2437, .hw_value = 6 },
+       { .center_freq = 2442, .hw_value = 7 },
+       { .center_freq = 2447, .hw_value = 8 },
+       { .center_freq = 2452, .hw_value = 9 },
+       { .center_freq = 2457, .hw_value = 10 },
+       { .center_freq = 2462, .hw_value = 11 },
+       { .center_freq = 2467, .hw_value = 12 },
+       { .center_freq = 2472, .hw_value = 13 },
+       { .center_freq = 2484, .hw_value = 14 }
+};
+
+static struct ieee80211_channel vnt_channels_5ghz[] = {
+       { .center_freq = 4915, .hw_value = 15 },
+       { .center_freq = 4920, .hw_value = 16 },
+       { .center_freq = 4925, .hw_value = 17 },
+       { .center_freq = 4935, .hw_value = 18 },
+       { .center_freq = 4940, .hw_value = 19 },
+       { .center_freq = 4945, .hw_value = 20 },
+       { .center_freq = 4960, .hw_value = 21 },
+       { .center_freq = 4980, .hw_value = 22 },
+       { .center_freq = 5035, .hw_value = 23 },
+       { .center_freq = 5040, .hw_value = 24 },
+       { .center_freq = 5045, .hw_value = 25 },
+       { .center_freq = 5055, .hw_value = 26 },
+       { .center_freq = 5060, .hw_value = 27 },
+       { .center_freq = 5080, .hw_value = 28 },
+       { .center_freq = 5170, .hw_value = 29 },
+       { .center_freq = 5180, .hw_value = 30 },
+       { .center_freq = 5190, .hw_value = 31 },
+       { .center_freq = 5200, .hw_value = 32 },
+       { .center_freq = 5210, .hw_value = 33 },
+       { .center_freq = 5220, .hw_value = 34 },
+       { .center_freq = 5230, .hw_value = 35 },
+       { .center_freq = 5240, .hw_value = 36 },
+       { .center_freq = 5260, .hw_value = 37 },
+       { .center_freq = 5280, .hw_value = 38 },
+       { .center_freq = 5300, .hw_value = 39 },
+       { .center_freq = 5320, .hw_value = 40 },
+       { .center_freq = 5500, .hw_value = 41 },
+       { .center_freq = 5520, .hw_value = 42 },
+       { .center_freq = 5540, .hw_value = 43 },
+       { .center_freq = 5560, .hw_value = 44 },
+       { .center_freq = 5580, .hw_value = 45 },
+       { .center_freq = 5600, .hw_value = 46 },
+       { .center_freq = 5620, .hw_value = 47 },
+       { .center_freq = 5640, .hw_value = 48 },
+       { .center_freq = 5660, .hw_value = 49 },
+       { .center_freq = 5680, .hw_value = 50 },
+       { .center_freq = 5700, .hw_value = 51 },
+       { .center_freq = 5745, .hw_value = 52 },
+       { .center_freq = 5765, .hw_value = 53 },
+       { .center_freq = 5785, .hw_value = 54 },
+       { .center_freq = 5805, .hw_value = 55 },
+       { .center_freq = 5825, .hw_value = 56 }
+};
+
+static struct ieee80211_supported_band vnt_supported_2ghz_band = {
+       .channels = vnt_channels_2ghz,
+       .n_channels = ARRAY_SIZE(vnt_channels_2ghz),
+       .bitrates = vnt_rates_bg,
+       .n_bitrates = ARRAY_SIZE(vnt_rates_bg),
+};
+
+static struct ieee80211_supported_band vnt_supported_5ghz_band = {
+       .channels = vnt_channels_5ghz,
+       .n_channels = ARRAY_SIZE(vnt_channels_5ghz),
+       .bitrates = vnt_rates_a,
+       .n_bitrates = ARRAY_SIZE(vnt_rates_a),
+};
+
+void vnt_init_bands(struct vnt_private *priv)
+{
+       struct ieee80211_channel *ch;
+       int i;
+
+       switch (priv->byRFType) {
+       case RF_AIROHA7230:
+       case RF_UW2452:
+       case RF_NOTHING:
+       default:
+               ch = vnt_channels_5ghz;
+
+               for (i = 0; i < ARRAY_SIZE(vnt_channels_5ghz); i++) {
+                       ch[i].max_power = 0x3f;
+                       ch[i].flags = IEEE80211_CHAN_NO_HT40;
+               }
+
+               priv->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
+                                               &vnt_supported_5ghz_band;
+       /* fallthrough */
+       case RF_RFMD2959:
+       case RF_AIROHA:
+       case RF_AL2230S:
+       case RF_UW2451:
+       case RF_VT3226:
+               ch = vnt_channels_2ghz;
+
+               for (i = 0; i < ARRAY_SIZE(vnt_channels_2ghz); i++) {
+                       ch[i].max_power = 0x3f;
+                       ch[i].flags = IEEE80211_CHAN_NO_HT40;
+               }
+
+               priv->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
+                                               &vnt_supported_2ghz_band;
+               break;
+       }
+}
+
+/**
+ * set_channel() - Set NIC media channel
+ *
+ * @pDeviceHandler: The adapter to be set
+ * @uConnectionChannel: Channel to be set
+ *
+ * Return Value: true if succeeded; false if failed.
+ *
+ */
+bool set_channel(void *pDeviceHandler, struct ieee80211_channel *ch)
+{
+       struct vnt_private *pDevice = pDeviceHandler;
+       bool bResult = true;
+
+       if (pDevice->byCurrentCh == ch->hw_value)
+               return bResult;
+
+       /* Set VGA to max sensitivity */
+       if (pDevice->bUpdateBBVGA &&
+           pDevice->byBBVGACurrent != pDevice->abyBBVGA[0]) {
+               pDevice->byBBVGACurrent = pDevice->abyBBVGA[0];
+
+               BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
+       }
+
+       /* clear NAV */
+       MACvRegBitsOn(pDevice->PortOffset, MAC_REG_MACCR, MACCR_CLRNAV);
+
+       /* TX_PE will reserve 3 us for MAX2829 A mode only,
+          it is for better TX throughput */
+
+       if (pDevice->byRFType == RF_AIROHA7230)
+               RFbAL7230SelectChannelPostProcess(pDevice, pDevice->byCurrentCh,
+                                                 ch->hw_value);
+
+       pDevice->byCurrentCh = ch->hw_value;
+       bResult &= RFbSelectChannel(pDevice, pDevice->byRFType,
+                                   ch->hw_value);
+
+       /* Init Synthesizer Table */
+       if (pDevice->bEnablePSMode)
+               RFvWriteWakeProgSyn(pDevice, pDevice->byRFType, ch->hw_value);
+
+       BBvSoftwareReset(pDevice);
+
+       if (pDevice->byLocalID > REV_ID_VT3253_B1) {
+               unsigned long flags;
+
+               spin_lock_irqsave(&pDevice->lock, flags);
+
+               /* set HW default power register */
+               MACvSelectPage1(pDevice->PortOffset);
+               RFbSetPower(pDevice, RATE_1M, pDevice->byCurrentCh);
+               VNSvOutPortB(pDevice->PortOffset + MAC_REG_PWRCCK,
+                            pDevice->byCurPwr);
+               RFbSetPower(pDevice, RATE_6M, pDevice->byCurrentCh);
+               VNSvOutPortB(pDevice->PortOffset + MAC_REG_PWROFDM,
+                            pDevice->byCurPwr);
+               MACvSelectPage0(pDevice->PortOffset);
+
+               spin_unlock_irqrestore(&pDevice->lock, flags);
+       }
+
+       if (pDevice->byBBType == BB_TYPE_11B)
+               RFbSetPower(pDevice, RATE_1M, pDevice->byCurrentCh);
+       else
+               RFbSetPower(pDevice, RATE_6M, pDevice->byCurrentCh);
+
+       return bResult;
+}