batman-adv: remove duplicate code from function is_bidirectional_neigh()
[cascardo/linux.git] / drivers / net / wireless / ath / ath9k / ahb.c
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>
5  *
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.
9  *
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.
17  */
18
19 #include <linux/nl80211.h>
20 #include <linux/platform_device.h>
21 #include <linux/ath9k_platform.h>
22 #include "ath9k.h"
23
24 /* return bus cachesize in 4B word units */
25 static void ath_ahb_read_cachesize(struct ath_common *common, int *csz)
26 {
27         *csz = L1_CACHE_BYTES >> 2;
28 }
29
30 static bool ath_ahb_eeprom_read(struct ath_common *common, u32 off, u16 *data)
31 {
32         struct ath_softc *sc = (struct ath_softc *)common->priv;
33         struct platform_device *pdev = to_platform_device(sc->dev);
34         struct ath9k_platform_data *pdata;
35
36         pdata = (struct ath9k_platform_data *) pdev->dev.platform_data;
37         if (off >= (ARRAY_SIZE(pdata->eeprom_data))) {
38                 ath_err(common,
39                         "%s: flash read failed, offset %08x is out of range\n",
40                         __func__, off);
41                 return false;
42         }
43
44         *data = pdata->eeprom_data[off];
45         return true;
46 }
47
48 static struct ath_bus_ops ath_ahb_bus_ops  = {
49         .ath_bus_type = ATH_AHB,
50         .read_cachesize = ath_ahb_read_cachesize,
51         .eeprom_read = ath_ahb_eeprom_read,
52 };
53
54 static int ath_ahb_probe(struct platform_device *pdev)
55 {
56         void __iomem *mem;
57         struct ath_softc *sc;
58         struct ieee80211_hw *hw;
59         struct resource *res;
60         int irq;
61         int ret = 0;
62         struct ath_hw *ah;
63         char hw_name[64];
64
65         if (!pdev->dev.platform_data) {
66                 dev_err(&pdev->dev, "no platform data specified\n");
67                 ret = -EINVAL;
68                 goto err_out;
69         }
70
71         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
72         if (res == NULL) {
73                 dev_err(&pdev->dev, "no memory resource found\n");
74                 ret = -ENXIO;
75                 goto err_out;
76         }
77
78         mem = ioremap_nocache(res->start, resource_size(res));
79         if (mem == NULL) {
80                 dev_err(&pdev->dev, "ioremap failed\n");
81                 ret = -ENOMEM;
82                 goto err_out;
83         }
84
85         res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
86         if (res == NULL) {
87                 dev_err(&pdev->dev, "no IRQ resource found\n");
88                 ret = -ENXIO;
89                 goto err_iounmap;
90         }
91
92         irq = res->start;
93
94         hw = ieee80211_alloc_hw(sizeof(struct ath_softc), &ath9k_ops);
95         if (hw == NULL) {
96                 dev_err(&pdev->dev, "no memory for ieee80211_hw\n");
97                 ret = -ENOMEM;
98                 goto err_iounmap;
99         }
100
101         SET_IEEE80211_DEV(hw, &pdev->dev);
102         platform_set_drvdata(pdev, hw);
103
104         sc = hw->priv;
105         sc->hw = hw;
106         sc->dev = &pdev->dev;
107         sc->mem = mem;
108         sc->irq = irq;
109
110         /* Will be cleared in ath9k_start() */
111         sc->sc_flags |= SC_OP_INVALID;
112
113         ret = request_irq(irq, ath_isr, IRQF_SHARED, "ath9k", sc);
114         if (ret) {
115                 dev_err(&pdev->dev, "request_irq failed\n");
116                 goto err_free_hw;
117         }
118
119         ret = ath9k_init_device(AR5416_AR9100_DEVID, sc, 0x0, &ath_ahb_bus_ops);
120         if (ret) {
121                 dev_err(&pdev->dev, "failed to initialize device\n");
122                 goto err_irq;
123         }
124
125         ah = sc->sc_ah;
126         ath9k_hw_name(ah, hw_name, sizeof(hw_name));
127         wiphy_info(hw->wiphy, "%s mem=0x%lx, irq=%d\n",
128                    hw_name, (unsigned long)mem, irq);
129
130         return 0;
131
132  err_irq:
133         free_irq(irq, sc);
134  err_free_hw:
135         ieee80211_free_hw(hw);
136         platform_set_drvdata(pdev, NULL);
137  err_iounmap:
138         iounmap(mem);
139  err_out:
140         return ret;
141 }
142
143 static int ath_ahb_remove(struct platform_device *pdev)
144 {
145         struct ieee80211_hw *hw = platform_get_drvdata(pdev);
146
147         if (hw) {
148                 struct ath_softc *sc = hw->priv;
149                 void __iomem *mem = sc->mem;
150
151                 ath9k_deinit_device(sc);
152                 free_irq(sc->irq, sc);
153                 ieee80211_free_hw(sc->hw);
154                 iounmap(mem);
155                 platform_set_drvdata(pdev, NULL);
156         }
157
158         return 0;
159 }
160
161 static struct platform_driver ath_ahb_driver = {
162         .probe      = ath_ahb_probe,
163         .remove     = ath_ahb_remove,
164         .driver         = {
165                 .name   = "ath9k",
166                 .owner  = THIS_MODULE,
167         },
168 };
169
170 int ath_ahb_init(void)
171 {
172         return platform_driver_register(&ath_ahb_driver);
173 }
174
175 void ath_ahb_exit(void)
176 {
177         platform_driver_unregister(&ath_ahb_driver);
178 }