162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci
362306a36Sopenharmony_ci/*
462306a36Sopenharmony_ci * Radio tuning for GCT GRF5101 on RTL8180
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * Copyright 2007 Andrea Merello <andrea.merello@gmail.com>
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Code from the BSD driver and the rtl8181 project have been
962306a36Sopenharmony_ci * very useful to understand certain things
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci * I want to thanks the Authors of such projects and the Ndiswrapper
1262306a36Sopenharmony_ci * project Authors.
1362306a36Sopenharmony_ci *
1462306a36Sopenharmony_ci * A special Big Thanks also is for all people who donated me cards,
1562306a36Sopenharmony_ci * making possible the creation of the original rtl8180 driver
1662306a36Sopenharmony_ci * from which this code is derived!
1762306a36Sopenharmony_ci */
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci#include <linux/pci.h>
2062306a36Sopenharmony_ci#include <linux/delay.h>
2162306a36Sopenharmony_ci#include <net/mac80211.h>
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#include "rtl8180.h"
2462306a36Sopenharmony_ci#include "grf5101.h"
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_cistatic const int grf5101_encode[] = {
2762306a36Sopenharmony_ci	0x0, 0x8, 0x4, 0xC,
2862306a36Sopenharmony_ci	0x2, 0xA, 0x6, 0xE,
2962306a36Sopenharmony_ci	0x1, 0x9, 0x5, 0xD,
3062306a36Sopenharmony_ci	0x3, 0xB, 0x7, 0xF
3162306a36Sopenharmony_ci};
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_cistatic void write_grf5101(struct ieee80211_hw *dev, u8 addr, u32 data)
3462306a36Sopenharmony_ci{
3562306a36Sopenharmony_ci	struct rtl8180_priv *priv = dev->priv;
3662306a36Sopenharmony_ci	u32 phy_config;
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	phy_config =  grf5101_encode[(data >> 8) & 0xF];
3962306a36Sopenharmony_ci	phy_config |= grf5101_encode[(data >> 4) & 0xF] << 4;
4062306a36Sopenharmony_ci	phy_config |= grf5101_encode[data & 0xF] << 8;
4162306a36Sopenharmony_ci	phy_config |= grf5101_encode[(addr >> 1) & 0xF] << 12;
4262306a36Sopenharmony_ci	phy_config |= (addr & 1) << 16;
4362306a36Sopenharmony_ci	phy_config |= grf5101_encode[(data & 0xf000) >> 12] << 24;
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci	/* MAC will bang bits to the chip */
4662306a36Sopenharmony_ci	phy_config |= 0x90000000;
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci	rtl818x_iowrite32(priv,
4962306a36Sopenharmony_ci		(__le32 __iomem *) &priv->map->RFPinsOutput, phy_config);
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci	msleep(3);
5262306a36Sopenharmony_ci}
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_cistatic void grf5101_write_phy_antenna(struct ieee80211_hw *dev, short chan)
5562306a36Sopenharmony_ci{
5662306a36Sopenharmony_ci	struct rtl8180_priv *priv = dev->priv;
5762306a36Sopenharmony_ci	u8 ant = GRF5101_ANTENNA;
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_ci	if (priv->rfparam & RF_PARAM_ANTBDEFAULT)
6062306a36Sopenharmony_ci		ant |= BB_ANTENNA_B;
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_ci	if (chan == 14)
6362306a36Sopenharmony_ci		ant |= BB_ANTATTEN_CHAN14;
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0x10, ant);
6662306a36Sopenharmony_ci}
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_cistatic u8 grf5101_rf_calc_rssi(u8 agc, u8 sq)
6962306a36Sopenharmony_ci{
7062306a36Sopenharmony_ci	if (agc > 60)
7162306a36Sopenharmony_ci		return 65;
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci	/* TODO(?): just return agc (or agc + 5) to avoid mult / div */
7462306a36Sopenharmony_ci	return 65 * agc / 60;
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_cistatic void grf5101_rf_set_channel(struct ieee80211_hw *dev,
7862306a36Sopenharmony_ci				   struct ieee80211_conf *conf)
7962306a36Sopenharmony_ci{
8062306a36Sopenharmony_ci	struct rtl8180_priv *priv = dev->priv;
8162306a36Sopenharmony_ci	int channel =
8262306a36Sopenharmony_ci		ieee80211_frequency_to_channel(conf->chandef.chan->center_freq);
8362306a36Sopenharmony_ci	u32 txpw = priv->channels[channel - 1].hw_value & 0xFF;
8462306a36Sopenharmony_ci	u32 chan = channel - 1;
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	/* set TX power */
8762306a36Sopenharmony_ci	write_grf5101(dev, 0x15, 0x0);
8862306a36Sopenharmony_ci	write_grf5101(dev, 0x06, txpw);
8962306a36Sopenharmony_ci	write_grf5101(dev, 0x15, 0x10);
9062306a36Sopenharmony_ci	write_grf5101(dev, 0x15, 0x0);
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci	/* set frequency */
9362306a36Sopenharmony_ci	write_grf5101(dev, 0x07, 0x0);
9462306a36Sopenharmony_ci	write_grf5101(dev, 0x0B, chan);
9562306a36Sopenharmony_ci	write_grf5101(dev, 0x07, 0x1000);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	grf5101_write_phy_antenna(dev, channel);
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_cistatic void grf5101_rf_stop(struct ieee80211_hw *dev)
10162306a36Sopenharmony_ci{
10262306a36Sopenharmony_ci	struct rtl8180_priv *priv = dev->priv;
10362306a36Sopenharmony_ci	u32 anaparam;
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	anaparam = priv->anaparam;
10662306a36Sopenharmony_ci	anaparam &= 0x000fffff;
10762306a36Sopenharmony_ci	anaparam |= 0x3f900000;
10862306a36Sopenharmony_ci	rtl8180_set_anaparam(priv, anaparam);
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	write_grf5101(dev, 0x07, 0x0);
11162306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x45);
11262306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x5);
11362306a36Sopenharmony_ci	write_grf5101(dev, 0x00, 0x8e4);
11462306a36Sopenharmony_ci}
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_cistatic void grf5101_rf_init(struct ieee80211_hw *dev)
11762306a36Sopenharmony_ci{
11862306a36Sopenharmony_ci	struct rtl8180_priv *priv = dev->priv;
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	rtl8180_set_anaparam(priv, priv->anaparam);
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x0);
12362306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x0);
12462306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x40);
12562306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x60);
12662306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x61);
12762306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x61);
12862306a36Sopenharmony_ci	write_grf5101(dev, 0x00, 0xae4);
12962306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x1);
13062306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x41);
13162306a36Sopenharmony_ci	write_grf5101(dev, 0x1f, 0x61);
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	write_grf5101(dev, 0x01, 0x1a23);
13462306a36Sopenharmony_ci	write_grf5101(dev, 0x02, 0x4971);
13562306a36Sopenharmony_ci	write_grf5101(dev, 0x03, 0x41de);
13662306a36Sopenharmony_ci	write_grf5101(dev, 0x04, 0x2d80);
13762306a36Sopenharmony_ci	write_grf5101(dev, 0x05, 0x68ff);	/* 0x61ff original value */
13862306a36Sopenharmony_ci	write_grf5101(dev, 0x06, 0x0);
13962306a36Sopenharmony_ci	write_grf5101(dev, 0x07, 0x0);
14062306a36Sopenharmony_ci	write_grf5101(dev, 0x08, 0x7533);
14162306a36Sopenharmony_ci	write_grf5101(dev, 0x09, 0xc401);
14262306a36Sopenharmony_ci	write_grf5101(dev, 0x0a, 0x0);
14362306a36Sopenharmony_ci	write_grf5101(dev, 0x0c, 0x1c7);
14462306a36Sopenharmony_ci	write_grf5101(dev, 0x0d, 0x29d3);
14562306a36Sopenharmony_ci	write_grf5101(dev, 0x0e, 0x2e8);
14662306a36Sopenharmony_ci	write_grf5101(dev, 0x10, 0x192);
14762306a36Sopenharmony_ci	write_grf5101(dev, 0x11, 0x248);
14862306a36Sopenharmony_ci	write_grf5101(dev, 0x12, 0x0);
14962306a36Sopenharmony_ci	write_grf5101(dev, 0x13, 0x20c4);
15062306a36Sopenharmony_ci	write_grf5101(dev, 0x14, 0xf4fc);
15162306a36Sopenharmony_ci	write_grf5101(dev, 0x15, 0x0);
15262306a36Sopenharmony_ci	write_grf5101(dev, 0x16, 0x1500);
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ci	write_grf5101(dev, 0x07, 0x1000);
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	/* baseband configuration */
15762306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0, 0xa8);
15862306a36Sopenharmony_ci	rtl8180_write_phy(dev, 3, 0x0);
15962306a36Sopenharmony_ci	rtl8180_write_phy(dev, 4, 0xc0);
16062306a36Sopenharmony_ci	rtl8180_write_phy(dev, 5, 0x90);
16162306a36Sopenharmony_ci	rtl8180_write_phy(dev, 6, 0x1e);
16262306a36Sopenharmony_ci	rtl8180_write_phy(dev, 7, 0x64);
16362306a36Sopenharmony_ci
16462306a36Sopenharmony_ci	grf5101_write_phy_antenna(dev, 1);
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0x11, 0x88);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	if (rtl818x_ioread8(priv, &priv->map->CONFIG2) &
16962306a36Sopenharmony_ci	    RTL818X_CONFIG2_ANTENNA_DIV)
17062306a36Sopenharmony_ci		rtl8180_write_phy(dev, 0x12, 0xc0); /* enable ant diversity */
17162306a36Sopenharmony_ci	else
17262306a36Sopenharmony_ci		rtl8180_write_phy(dev, 0x12, 0x40); /* disable ant diversity */
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0x13, 0x90 | priv->csthreshold);
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0x19, 0x0);
17762306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0x1a, 0xa0);
17862306a36Sopenharmony_ci	rtl8180_write_phy(dev, 0x1b, 0x44);
17962306a36Sopenharmony_ci}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ciconst struct rtl818x_rf_ops grf5101_rf_ops = {
18262306a36Sopenharmony_ci	.name		= "GCT",
18362306a36Sopenharmony_ci	.init		= grf5101_rf_init,
18462306a36Sopenharmony_ci	.stop		= grf5101_rf_stop,
18562306a36Sopenharmony_ci	.set_chan	= grf5101_rf_set_channel,
18662306a36Sopenharmony_ci	.calc_rssi	= grf5101_rf_calc_rssi,
18762306a36Sopenharmony_ci};
188