Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  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_softc *sc, int *csz)
 26 {
 27         *csz = L1_CACHE_BYTES >> 2;
 28 }
 29 
 30 static void ath_ahb_cleanup(struct ath_softc *sc)
 31 {
 32         iounmap(sc->mem);
 33 }
 34 
 35 static bool ath_ahb_eeprom_read(struct ath_hw *ah, u32 off, u16 *data)
 36 {
 37         struct ath_softc *sc = ah->ah_sc;
 38         struct platform_device *pdev = to_platform_device(sc->dev);
 39         struct ath9k_platform_data *pdata;
 40 
 41         pdata = (struct ath9k_platform_data *) pdev->dev.platform_data;
 42         if (off >= (ARRAY_SIZE(pdata->eeprom_data))) {
 43                 DPRINTF(ah->ah_sc, ATH_DBG_FATAL,
 44                         "%s: flash read failed, offset %08x is out of range\n",
 45                                 __func__, off);
 46                 return false;
 47         }
 48 
 49         *data = pdata->eeprom_data[off];
 50         return true;
 51 }
 52 
 53 static struct ath_bus_ops ath_ahb_bus_ops  = {
 54         .read_cachesize = ath_ahb_read_cachesize,
 55         .cleanup = ath_ahb_cleanup,
 56 
 57         .eeprom_read = ath_ahb_eeprom_read,
 58 };
 59 
 60 static int ath_ahb_probe(struct platform_device *pdev)
 61 {
 62         void __iomem *mem;
 63         struct ath_wiphy *aphy;
 64         struct ath_softc *sc;
 65         struct ieee80211_hw *hw;
 66         struct resource *res;
 67         int irq;
 68         int ret = 0;
 69         struct ath_hw *ah;
 70 
 71         if (!pdev->dev.platform_data) {
 72                 dev_err(&pdev->dev, "no platform data specified\n");
 73                 ret = -EINVAL;
 74                 goto err_out;
 75         }
 76 
 77         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 78         if (res == NULL) {
 79                 dev_err(&pdev->dev, "no memory resource found\n");
 80                 ret = -ENXIO;
 81                 goto err_out;
 82         }
 83 
 84         mem = ioremap_nocache(res->start, res->end - res->start + 1);
 85         if (mem == NULL) {
 86                 dev_err(&pdev->dev, "ioremap failed\n");
 87                 ret = -ENOMEM;
 88                 goto err_out;
 89         }
 90 
 91         res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 92         if (res == NULL) {
 93                 dev_err(&pdev->dev, "no IRQ resource found\n");
 94                 ret = -ENXIO;
 95                 goto err_iounmap;
 96         }
 97 
 98         irq = res->start;
 99 
100         hw = ieee80211_alloc_hw(sizeof(struct ath_wiphy) +
101                                 sizeof(struct ath_softc), &ath9k_ops);
102         if (hw == NULL) {
103                 dev_err(&pdev->dev, "no memory for ieee80211_hw\n");
104                 ret = -ENOMEM;
105                 goto err_iounmap;
106         }
107 
108         SET_IEEE80211_DEV(hw, &pdev->dev);
109         platform_set_drvdata(pdev, hw);
110 
111         aphy = hw->priv;
112         sc = (struct ath_softc *) (aphy + 1);
113         aphy->sc = sc;
114         aphy->hw = hw;
115         sc->pri_wiphy = aphy;
116         sc->hw = hw;
117         sc->dev = &pdev->dev;
118         sc->mem = mem;
119         sc->bus_ops = &ath_ahb_bus_ops;
120         sc->irq = irq;
121 
122         ret = ath_attach(AR5416_AR9100_DEVID, sc);
123         if (ret != 0) {
124                 dev_err(&pdev->dev, "failed to attach device, err=%d\n", ret);
125                 ret = -ENODEV;
126                 goto err_free_hw;
127         }
128 
129         ret = request_irq(irq, ath_isr, IRQF_SHARED, "ath9k", sc);
130         if (ret) {
131                 dev_err(&pdev->dev, "request_irq failed, err=%d\n", ret);
132                 ret = -EIO;
133                 goto err_detach;
134         }
135 
136         ah = sc->sc_ah;
137         printk(KERN_INFO
138                "%s: Atheros AR%s MAC/BB Rev:%x, "
139                "AR%s RF Rev:%x, mem=0x%lx, irq=%d\n",
140                wiphy_name(hw->wiphy),
141                ath_mac_bb_name(ah->hw_version.macVersion),
142                ah->hw_version.macRev,
143                ath_rf_name((ah->hw_version.analog5GhzRev & AR_RADIO_SREV_MAJOR)),
144                ah->hw_version.phyRev,
145                (unsigned long)mem, irq);
146 
147         return 0;
148 
149  err_detach:
150         ath_detach(sc);
151  err_free_hw:
152         ieee80211_free_hw(hw);
153         platform_set_drvdata(pdev, NULL);
154  err_iounmap:
155         iounmap(mem);
156  err_out:
157         return ret;
158 }
159 
160 static int ath_ahb_remove(struct platform_device *pdev)
161 {
162         struct ieee80211_hw *hw = platform_get_drvdata(pdev);
163 
164         if (hw) {
165                 struct ath_wiphy *aphy = hw->priv;
166                 struct ath_softc *sc = aphy->sc;
167 
168                 ath_cleanup(sc);
169                 platform_set_drvdata(pdev, NULL);
170         }
171 
172         return 0;
173 }
174 
175 static struct platform_driver ath_ahb_driver = {
176         .probe      = ath_ahb_probe,
177         .remove     = ath_ahb_remove,
178         .driver         = {
179                 .name   = "ath9k",
180                 .owner  = THIS_MODULE,
181         },
182 };
183 
184 int ath_ahb_init(void)
185 {
186         return platform_driver_register(&ath_ahb_driver);
187 }
188 
189 void ath_ahb_exit(void)
190 {
191         platform_driver_unregister(&ath_ahb_driver);
192 }
193 
  This page was automatically generated by the LXR engine.