5cab9dfa8c07c1d5d88be64fd812e6eb3d0a3100
[cascardo/linux.git] / drivers / net / wireless / rtl818x / rtl8180_grf5101.c
1
2 /*
3  * Radio tuning for GCT GRF5101 on RTL8180
4  *
5  * Copyright 2007 Andrea Merello <andreamrl@tiscali.it>
6  *
7  * Code from the BSD driver and the rtl8181 project have been
8  * very useful to understand certain things
9  *
10  * I want to thanks the Authors of such projects and the Ndiswrapper
11  * project Authors.
12  *
13  * A special Big Thanks also is for all people who donated me cards,
14  * making possible the creation of the original rtl8180 driver
15  * from which this code is derived!
16  *
17  * This program is free software; you can redistribute it and/or modify
18  * it under the terms of the GNU General Public License version 2 as
19  * published by the Free Software Foundation.
20  */
21
22 #include <linux/init.h>
23 #include <linux/pci.h>
24 #include <linux/delay.h>
25 #include <net/mac80211.h>
26
27 #include "rtl8180.h"
28 #include "rtl8180_grf5101.h"
29
30 static const int grf5101_encode[] = {
31         0x0, 0x8, 0x4, 0xC,
32         0x2, 0xA, 0x6, 0xE,
33         0x1, 0x9, 0x5, 0xD,
34         0x3, 0xB, 0x7, 0xF
35 };
36
37 static void write_grf5101(struct ieee80211_hw *dev, u8 addr, u32 data)
38 {
39         struct rtl8180_priv *priv = dev->priv;
40         u32 phy_config;
41
42         phy_config =  grf5101_encode[(data >> 8) & 0xF];
43         phy_config |= grf5101_encode[(data >> 4) & 0xF] << 4;
44         phy_config |= grf5101_encode[data & 0xF] << 8;
45         phy_config |= grf5101_encode[(addr >> 1) & 0xF] << 12;
46         phy_config |= (addr & 1) << 16;
47         phy_config |= grf5101_encode[(data & 0xf000) >> 12] << 24;
48
49         /* MAC will bang bits to the chip */
50         phy_config |= 0x90000000;
51
52         rtl818x_iowrite32(priv,
53                 (__le32 __iomem *) &priv->map->RFPinsOutput, phy_config);
54
55         msleep(3);
56 }
57
58 static void grf5101_write_phy_antenna(struct ieee80211_hw *dev, short chan)
59 {
60         struct rtl8180_priv *priv = dev->priv;
61         u8 ant = GRF5101_ANTENNA;
62
63         if (priv->rfparam & RF_PARAM_ANTBDEFAULT)
64                 ant |= BB_ANTENNA_B;
65
66         if (chan == 14)
67                 ant |= BB_ANTATTEN_CHAN14;
68
69         rtl8180_write_phy(dev, 0x10, ant);
70 }
71
72 static u8 grf5101_rf_calc_rssi(u8 agc, u8 sq)
73 {
74         if (agc > 60)
75                 return 65;
76
77         /* TODO(?): just return agc (or agc + 5) to avoid mult / div */
78         return 65 * agc / 60;
79 }
80
81 static void grf5101_rf_set_channel(struct ieee80211_hw *dev,
82                                    struct ieee80211_conf *conf)
83 {
84         struct rtl8180_priv *priv = dev->priv;
85         int channel = ieee80211_frequency_to_channel(conf->channel->center_freq);
86         u32 txpw = priv->channels[channel - 1].hw_value & 0xFF;
87         u32 chan = channel - 1;
88
89         /* set TX power */
90         write_grf5101(dev, 0x15, 0x0);
91         write_grf5101(dev, 0x06, txpw);
92         write_grf5101(dev, 0x15, 0x10);
93         write_grf5101(dev, 0x15, 0x0);
94
95         /* set frequency */
96         write_grf5101(dev, 0x07, 0x0);
97         write_grf5101(dev, 0x0B, chan);
98         write_grf5101(dev, 0x07, 0x1000);
99
100         grf5101_write_phy_antenna(dev, channel);
101 }
102
103 static void grf5101_rf_stop(struct ieee80211_hw *dev)
104 {
105         struct rtl8180_priv *priv = dev->priv;
106         u32 anaparam;
107
108         anaparam = priv->anaparam;
109         anaparam &= 0x000fffff;
110         anaparam |= 0x3f900000;
111         rtl8180_set_anaparam(priv, anaparam);
112
113         write_grf5101(dev, 0x07, 0x0);
114         write_grf5101(dev, 0x1f, 0x45);
115         write_grf5101(dev, 0x1f, 0x5);
116         write_grf5101(dev, 0x00, 0x8e4);
117 }
118
119 static void grf5101_rf_init(struct ieee80211_hw *dev)
120 {
121         struct rtl8180_priv *priv = dev->priv;
122
123         rtl8180_set_anaparam(priv, priv->anaparam);
124
125         write_grf5101(dev, 0x1f, 0x0);
126         write_grf5101(dev, 0x1f, 0x0);
127         write_grf5101(dev, 0x1f, 0x40);
128         write_grf5101(dev, 0x1f, 0x60);
129         write_grf5101(dev, 0x1f, 0x61);
130         write_grf5101(dev, 0x1f, 0x61);
131         write_grf5101(dev, 0x00, 0xae4);
132         write_grf5101(dev, 0x1f, 0x1);
133         write_grf5101(dev, 0x1f, 0x41);
134         write_grf5101(dev, 0x1f, 0x61);
135
136         write_grf5101(dev, 0x01, 0x1a23);
137         write_grf5101(dev, 0x02, 0x4971);
138         write_grf5101(dev, 0x03, 0x41de);
139         write_grf5101(dev, 0x04, 0x2d80);
140         write_grf5101(dev, 0x05, 0x68ff);       /* 0x61ff original value */
141         write_grf5101(dev, 0x06, 0x0);
142         write_grf5101(dev, 0x07, 0x0);
143         write_grf5101(dev, 0x08, 0x7533);
144         write_grf5101(dev, 0x09, 0xc401);
145         write_grf5101(dev, 0x0a, 0x0);
146         write_grf5101(dev, 0x0c, 0x1c7);
147         write_grf5101(dev, 0x0d, 0x29d3);
148         write_grf5101(dev, 0x0e, 0x2e8);
149         write_grf5101(dev, 0x10, 0x192);
150         write_grf5101(dev, 0x11, 0x248);
151         write_grf5101(dev, 0x12, 0x0);
152         write_grf5101(dev, 0x13, 0x20c4);
153         write_grf5101(dev, 0x14, 0xf4fc);
154         write_grf5101(dev, 0x15, 0x0);
155         write_grf5101(dev, 0x16, 0x1500);
156
157         write_grf5101(dev, 0x07, 0x1000);
158
159         /* baseband configuration */
160         rtl8180_write_phy(dev, 0, 0xa8);
161         rtl8180_write_phy(dev, 3, 0x0);
162         rtl8180_write_phy(dev, 4, 0xc0);
163         rtl8180_write_phy(dev, 5, 0x90);
164         rtl8180_write_phy(dev, 6, 0x1e);
165         rtl8180_write_phy(dev, 7, 0x64);
166
167         grf5101_write_phy_antenna(dev, 1);
168
169         rtl8180_write_phy(dev, 0x11, 0x88);
170
171         if (rtl818x_ioread8(priv, &priv->map->CONFIG2) &
172             RTL818X_CONFIG2_ANTENNA_DIV)
173                 rtl8180_write_phy(dev, 0x12, 0xc0); /* enable ant diversity */
174         else
175                 rtl8180_write_phy(dev, 0x12, 0x40); /* disable ant diversity */
176
177         rtl8180_write_phy(dev, 0x13, 0x90 | priv->csthreshold);
178
179         rtl8180_write_phy(dev, 0x19, 0x0);
180         rtl8180_write_phy(dev, 0x1a, 0xa0);
181         rtl8180_write_phy(dev, 0x1b, 0x44);
182 }
183
184 const struct rtl818x_rf_ops grf5101_rf_ops = {
185         .name           = "GCT",
186         .init           = grf5101_rf_init,
187         .stop           = grf5101_rf_stop,
188         .set_chan       = grf5101_rf_set_channel,
189         .calc_rssi      = grf5101_rf_calc_rssi,
190 };