treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / net / wireless / ath / ath5k / ahb.c
blob2c9cec8b53d9e22a2e7683b92ac0feb23593fc2d
1 /*
2 * Copyright (c) 2008-2009 Atheros Communications Inc.
3 * Copyright (c) 2009 Gabor Juhos <juhosg@openwrt.org>
4 * Copyright (c) 2009 Imre Kaloz <kaloz@openwrt.org>
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 #include <linux/module.h>
20 #include <linux/nl80211.h>
21 #include <linux/platform_device.h>
22 #include <linux/etherdevice.h>
23 #include <ath25_platform.h>
24 #include "ath5k.h"
25 #include "debug.h"
26 #include "base.h"
27 #include "reg.h"
29 /* return bus cachesize in 4B word units */
30 static void ath5k_ahb_read_cachesize(struct ath_common *common, int *csz)
32 *csz = L1_CACHE_BYTES >> 2;
35 static bool
36 ath5k_ahb_eeprom_read(struct ath_common *common, u32 off, u16 *data)
38 struct ath5k_hw *ah = common->priv;
39 struct platform_device *pdev = to_platform_device(ah->dev);
40 struct ar231x_board_config *bcfg = dev_get_platdata(&pdev->dev);
41 u16 *eeprom, *eeprom_end;
43 eeprom = (u16 *) bcfg->radio;
44 eeprom_end = ((void *) bcfg->config) + BOARD_CONFIG_BUFSZ;
46 eeprom += off;
47 if (eeprom > eeprom_end)
48 return false;
50 *data = *eeprom;
51 return true;
54 int ath5k_hw_read_srev(struct ath5k_hw *ah)
56 struct platform_device *pdev = to_platform_device(ah->dev);
57 struct ar231x_board_config *bcfg = dev_get_platdata(&pdev->dev);
58 ah->ah_mac_srev = bcfg->devid;
59 return 0;
62 static int ath5k_ahb_eeprom_read_mac(struct ath5k_hw *ah, u8 *mac)
64 struct platform_device *pdev = to_platform_device(ah->dev);
65 struct ar231x_board_config *bcfg = dev_get_platdata(&pdev->dev);
66 u8 *cfg_mac;
68 if (to_platform_device(ah->dev)->id == 0)
69 cfg_mac = bcfg->config->wlan0_mac;
70 else
71 cfg_mac = bcfg->config->wlan1_mac;
73 memcpy(mac, cfg_mac, ETH_ALEN);
74 return 0;
77 static const struct ath_bus_ops ath_ahb_bus_ops = {
78 .ath_bus_type = ATH_AHB,
79 .read_cachesize = ath5k_ahb_read_cachesize,
80 .eeprom_read = ath5k_ahb_eeprom_read,
81 .eeprom_read_mac = ath5k_ahb_eeprom_read_mac,
84 /*Initialization*/
85 static int ath_ahb_probe(struct platform_device *pdev)
87 struct ar231x_board_config *bcfg = dev_get_platdata(&pdev->dev);
88 struct ath5k_hw *ah;
89 struct ieee80211_hw *hw;
90 struct resource *res;
91 void __iomem *mem;
92 int irq;
93 int ret = 0;
94 u32 reg;
96 if (!dev_get_platdata(&pdev->dev)) {
97 dev_err(&pdev->dev, "no platform data specified\n");
98 ret = -EINVAL;
99 goto err_out;
102 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
103 if (res == NULL) {
104 dev_err(&pdev->dev, "no memory resource found\n");
105 ret = -ENXIO;
106 goto err_out;
109 mem = ioremap(res->start, resource_size(res));
110 if (mem == NULL) {
111 dev_err(&pdev->dev, "ioremap failed\n");
112 ret = -ENOMEM;
113 goto err_out;
116 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
117 if (res == NULL) {
118 dev_err(&pdev->dev, "no IRQ resource found\n");
119 ret = -ENXIO;
120 goto err_iounmap;
123 irq = res->start;
125 hw = ieee80211_alloc_hw(sizeof(struct ath5k_hw), &ath5k_hw_ops);
126 if (hw == NULL) {
127 dev_err(&pdev->dev, "no memory for ieee80211_hw\n");
128 ret = -ENOMEM;
129 goto err_iounmap;
132 ah = hw->priv;
133 ah->hw = hw;
134 ah->dev = &pdev->dev;
135 ah->iobase = mem;
136 ah->irq = irq;
137 ah->devid = bcfg->devid;
139 if (bcfg->devid >= AR5K_SREV_AR2315_R6) {
140 /* Enable WMAC AHB arbitration */
141 reg = ioread32((void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
142 reg |= AR5K_AR2315_AHB_ARB_CTL_WLAN;
143 iowrite32(reg, (void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
145 /* Enable global WMAC swapping */
146 reg = ioread32((void __iomem *) AR5K_AR2315_BYTESWAP);
147 reg |= AR5K_AR2315_BYTESWAP_WMAC;
148 iowrite32(reg, (void __iomem *) AR5K_AR2315_BYTESWAP);
149 } else {
150 /* Enable WMAC DMA access (assuming 5312 or 231x*/
151 /* TODO: check other platforms */
152 reg = ioread32((void __iomem *) AR5K_AR5312_ENABLE);
153 if (to_platform_device(ah->dev)->id == 0)
154 reg |= AR5K_AR5312_ENABLE_WLAN0;
155 else
156 reg |= AR5K_AR5312_ENABLE_WLAN1;
157 iowrite32(reg, (void __iomem *) AR5K_AR5312_ENABLE);
160 * On a dual-band AR5312, the multiband radio is only
161 * used as pass-through. Disable 2 GHz support in the
162 * driver for it
164 if (to_platform_device(ah->dev)->id == 0 &&
165 (bcfg->config->flags & (BD_WLAN0 | BD_WLAN1)) ==
166 (BD_WLAN1 | BD_WLAN0))
167 ah->ah_capabilities.cap_needs_2GHz_ovr = true;
168 else
169 ah->ah_capabilities.cap_needs_2GHz_ovr = false;
172 ret = ath5k_init_ah(ah, &ath_ahb_bus_ops);
173 if (ret != 0) {
174 dev_err(&pdev->dev, "failed to attach device, err=%d\n", ret);
175 ret = -ENODEV;
176 goto err_free_hw;
179 platform_set_drvdata(pdev, hw);
181 return 0;
183 err_free_hw:
184 ieee80211_free_hw(hw);
185 err_iounmap:
186 iounmap(mem);
187 err_out:
188 return ret;
191 static int ath_ahb_remove(struct platform_device *pdev)
193 struct ar231x_board_config *bcfg = dev_get_platdata(&pdev->dev);
194 struct ieee80211_hw *hw = platform_get_drvdata(pdev);
195 struct ath5k_hw *ah;
196 u32 reg;
198 if (!hw)
199 return 0;
201 ah = hw->priv;
203 if (bcfg->devid >= AR5K_SREV_AR2315_R6) {
204 /* Disable WMAC AHB arbitration */
205 reg = ioread32((void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
206 reg &= ~AR5K_AR2315_AHB_ARB_CTL_WLAN;
207 iowrite32(reg, (void __iomem *) AR5K_AR2315_AHB_ARB_CTL);
208 } else {
209 /*Stop DMA access */
210 reg = ioread32((void __iomem *) AR5K_AR5312_ENABLE);
211 if (to_platform_device(ah->dev)->id == 0)
212 reg &= ~AR5K_AR5312_ENABLE_WLAN0;
213 else
214 reg &= ~AR5K_AR5312_ENABLE_WLAN1;
215 iowrite32(reg, (void __iomem *) AR5K_AR5312_ENABLE);
218 ath5k_deinit_ah(ah);
219 iounmap(ah->iobase);
220 ieee80211_free_hw(hw);
222 return 0;
225 static struct platform_driver ath_ahb_driver = {
226 .probe = ath_ahb_probe,
227 .remove = ath_ahb_remove,
228 .driver = {
229 .name = "ar231x-wmac",
233 module_platform_driver(ath_ahb_driver);