1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/nl80211.h>
20#include <linux/platform_device.h>
21#include <linux/etherdevice.h>
22#include <linux/export.h>
23#include <ar231x_platform.h>
24#include "ath5k.h"
25#include "debug.h"
26#include "base.h"
27#include "reg.h"
28
29
30static void ath5k_ahb_read_cachesize(struct ath_common *common, int *csz)
31{
32 *csz = L1_CACHE_BYTES >> 2;
33}
34
35static bool
36ath5k_ahb_eeprom_read(struct ath_common *common, u32 off, u16 *data)
37{
38 struct ath5k_hw *ah = common->priv;
39 struct platform_device *pdev = to_platform_device(ah->dev);
40 struct ar231x_board_config *bcfg = pdev->dev.platform_data;
41 u16 *eeprom, *eeprom_end;
42
43
44
45 bcfg = pdev->dev.platform_data;
46 eeprom = (u16 *) bcfg->radio;
47 eeprom_end = ((void *) bcfg->config) + BOARD_CONFIG_BUFSZ;
48
49 eeprom += off;
50 if (eeprom > eeprom_end)
51 return false;
52
53 *data = *eeprom;
54 return true;
55}
56
57int ath5k_hw_read_srev(struct ath5k_hw *ah)
58{
59 struct platform_device *pdev = to_platform_device(ah->dev);
60 struct ar231x_board_config *bcfg = pdev->dev.platform_data;
61 ah->ah_mac_srev = bcfg->devid;
62 return 0;
63}
64
65static int ath5k_ahb_eeprom_read_mac(struct ath5k_hw *ah, u8 *mac)
66{
67 struct platform_device *pdev = to_platform_device(ah->dev);
68 struct ar231x_board_config *bcfg = pdev->dev.platform_data;
69 u8 *cfg_mac;
70
71 if (to_platform_device(ah->dev)->id == 0)
72 cfg_mac = bcfg->config->wlan0_mac;
73 else
74 cfg_mac = bcfg->config->wlan1_mac;
75
76 memcpy(mac, cfg_mac, ETH_ALEN);
77 return 0;
78}
79
80static const struct ath_bus_ops ath_ahb_bus_ops = {
81 .ath_bus_type = ATH_AHB,
82 .read_cachesize = ath5k_ahb_read_cachesize,
83 .eeprom_read = ath5k_ahb_eeprom_read,
84 .eeprom_read_mac = ath5k_ahb_eeprom_read_mac,
85};
86
87
88static int ath_ahb_probe(struct platform_device *pdev)
89{
90 struct ar231x_board_config *bcfg = pdev->dev.platform_data;
91 struct ath5k_hw *ah;
92 struct ieee80211_hw *hw;
93 struct resource *res;
94 void __iomem *mem;
95 int irq;
96 int ret = 0;
97 u32 reg;
98
99 if (!pdev->dev.platform_data) {
100 dev_err(&pdev->dev, "no platform data specified\n");
101 ret = -EINVAL;
102 goto err_out;
103 }
104
105 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
106 if (res == NULL) {
107 dev_err(&pdev->dev, "no memory resource found\n");
108 ret = -ENXIO;
109 goto err_out;
110 }
111
112 mem = ioremap_nocache(res->start, resource_size(res));
113 if (mem == NULL) {
114 dev_err(&pdev->dev, "ioremap failed\n");
115 ret = -ENOMEM;
116 goto err_out;
117 }
118
119 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
120 if (res == NULL) {
121 dev_err(&pdev->dev, "no IRQ resource found\n");
122 ret = -ENXIO;
123 goto err_iounmap;
124 }
125
126 irq = res->start;
127
128 hw = ieee80211_alloc_hw(sizeof(struct ath5k_hw), &ath5k_hw_ops);
129 if (hw == NULL) {
130 dev_err(&pdev->dev, "no memory for ieee80211_hw\n");
131 ret = -ENOMEM;
132 goto err_iounmap;
133 }
134
135 ah = hw->priv;
136 ah->hw = hw;
137 ah->dev = &pdev->dev;
138 ah->iobase = mem;
139 ah->irq = irq;
140 ah->devid = bcfg->devid;
141
142 if (bcfg->devid >= AR5K_SREV_AR2315_R6) {
143
144 reg = ioread32((void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
145 reg |= AR5K_AR2315_AHB_ARB_CTL_WLAN;
146 iowrite32(reg, (void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
147
148
149 reg = ioread32((void __iomem *) AR5K_AR2315_BYTESWAP);
150 reg |= AR5K_AR2315_BYTESWAP_WMAC;
151 iowrite32(reg, (void __iomem *) AR5K_AR2315_BYTESWAP);
152 } else {
153
154
155 reg = ioread32((void __iomem *) AR5K_AR5312_ENABLE);
156 if (to_platform_device(ah->dev)->id == 0)
157 reg |= AR5K_AR5312_ENABLE_WLAN0;
158 else
159 reg |= AR5K_AR5312_ENABLE_WLAN1;
160 iowrite32(reg, (void __iomem *) AR5K_AR5312_ENABLE);
161
162
163
164
165
166
167 if (to_platform_device(ah->dev)->id == 0 &&
168 (bcfg->config->flags & (BD_WLAN0 | BD_WLAN1)) ==
169 (BD_WLAN1 | BD_WLAN0))
170 ah->ah_capabilities.cap_needs_2GHz_ovr = true;
171 else
172 ah->ah_capabilities.cap_needs_2GHz_ovr = false;
173 }
174
175 ret = ath5k_init_ah(ah, &ath_ahb_bus_ops);
176 if (ret != 0) {
177 dev_err(&pdev->dev, "failed to attach device, err=%d\n", ret);
178 ret = -ENODEV;
179 goto err_free_hw;
180 }
181
182 platform_set_drvdata(pdev, hw);
183
184 return 0;
185
186 err_free_hw:
187 ieee80211_free_hw(hw);
188 err_iounmap:
189 iounmap(mem);
190 err_out:
191 return ret;
192}
193
194static int ath_ahb_remove(struct platform_device *pdev)
195{
196 struct ar231x_board_config *bcfg = pdev->dev.platform_data;
197 struct ieee80211_hw *hw = platform_get_drvdata(pdev);
198 struct ath5k_hw *ah;
199 u32 reg;
200
201 if (!hw)
202 return 0;
203
204 ah = hw->priv;
205
206 if (bcfg->devid >= AR5K_SREV_AR2315_R6) {
207
208 reg = ioread32((void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
209 reg &= ~AR5K_AR2315_AHB_ARB_CTL_WLAN;
210 iowrite32(reg, (void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
211 } else {
212
213 reg = ioread32((void __iomem *) AR5K_AR5312_ENABLE);
214 if (to_platform_device(ah->dev)->id == 0)
215 reg &= ~AR5K_AR5312_ENABLE_WLAN0;
216 else
217 reg &= ~AR5K_AR5312_ENABLE_WLAN1;
218 iowrite32(reg, (void __iomem *) AR5K_AR5312_ENABLE);
219 }
220
221 ath5k_deinit_ah(ah);
222 iounmap(ah->iobase);
223 ieee80211_free_hw(hw);
224
225 return 0;
226}
227
228static struct platform_driver ath_ahb_driver = {
229 .probe = ath_ahb_probe,
230 .remove = ath_ahb_remove,
231 .driver = {
232 .name = "ar231x-wmac",
233 .owner = THIS_MODULE,
234 },
235};
236
237module_platform_driver(ath_ahb_driver);
238