release/src-rt-6.x.4708/linux/linux-2.6.36/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_print(common, ATH_DBG_FATAL,
  39                           "%s: flash read failed, offset %08x "
  40                           "is out of range\n",
  41                           __func__, off);
  42                 return false;
  43         }
  44
  45         *data = pdata->eeprom_data[off];
  46         return true;
  47 }
  48
  49 static struct ath_bus_ops ath_ahb_bus_ops  = {
  50         .ath_bus_type = ATH_AHB,
  51         .read_cachesize = ath_ahb_read_cachesize,
  52         .eeprom_read = ath_ahb_eeprom_read,
  53 };
  54
  55 static int ath_ahb_probe(struct platform_device *pdev)
  56 {
  57         void __iomem *mem;
  58         struct ath_wiphy *aphy;
  59         struct ath_softc *sc;
  60         struct ieee80211_hw *hw;
  61         struct resource *res;
  62         int irq;
  63         int ret = 0;
  64         struct ath_hw *ah;
  65         char hw_name[64];
  66
  67         if (!pdev->dev.platform_data) {
  68                 dev_err(&pdev->dev, "no platform data specified\n");
  69                 ret = -EINVAL;
  70                 goto err_out;
  71         }
  72
  73         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  74         if (res == NULL) {
  75                 dev_err(&pdev->dev, "no memory resource found\n");
  76                 ret = -ENXIO;
  77                 goto err_out;
  78         }
  79
  80         mem = ioremap_nocache(res->start, res->end - res->start + 1);
  81         if (mem == NULL) {
  82                 dev_err(&pdev->dev, "ioremap failed\n");
  83                 ret = -ENOMEM;
  84                 goto err_out;
  85         }
  86
  87         res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  88         if (res == NULL) {
  89                 dev_err(&pdev->dev, "no IRQ resource found\n");
  90                 ret = -ENXIO;
  91                 goto err_iounmap;
  92         }
  93
  94         irq = res->start;
  95
  96         hw = ieee80211_alloc_hw(sizeof(struct ath_wiphy) +
  97                                 sizeof(struct ath_softc), &ath9k_ops);
  98         if (hw == NULL) {
  99                 dev_err(&pdev->dev, "no memory for ieee80211_hw\n");
 100                 ret = -ENOMEM;
 101                 goto err_iounmap;
 102         }
 103
 104         SET_IEEE80211_DEV(hw, &pdev->dev);
 105         platform_set_drvdata(pdev, hw);
 106
 107         aphy = hw->priv;
 108         sc = (struct ath_softc *) (aphy + 1);
 109         aphy->sc = sc;
 110         aphy->hw = hw;
 111         sc->pri_wiphy = aphy;
 112         sc->hw = hw;
 113         sc->dev = &pdev->dev;
 114         sc->mem = mem;
 115         sc->irq = irq;
 116
 117         /* Will be cleared in ath9k_start() */
 118         sc->sc_flags |= SC_OP_INVALID;
 119
 120         ret = request_irq(irq, ath_isr, IRQF_SHARED, "ath9k", sc);
 121         if (ret) {
 122                 dev_err(&pdev->dev, "request_irq failed\n");
 123                 goto err_free_hw;
 124         }
 125
 126         ret = ath9k_init_device(AR5416_AR9100_DEVID, sc, 0x0, &ath_ahb_bus_ops);
 127         if (ret) {
 128                 dev_err(&pdev->dev, "failed to initialize device\n");
 129                 goto err_irq;
 130         }
 131
 132         ah = sc->sc_ah;
 133         ath9k_hw_name(ah, hw_name, sizeof(hw_name));
 134         wiphy_info(hw->wiphy, "%s mem=0x%lx, irq=%d\n",
 135                    hw_name, (unsigned long)mem, irq);
 136
 137         return 0;
 138
 139  err_irq:
 140         free_irq(irq, sc);
 141  err_free_hw:
 142         ieee80211_free_hw(hw);
 143         platform_set_drvdata(pdev, NULL);
 144  err_iounmap:
 145         iounmap(mem);
 146  err_out:
 147         return ret;
 148 }
 149
 150 static int ath_ahb_remove(struct platform_device *pdev)
 151 {
 152         struct ieee80211_hw *hw = platform_get_drvdata(pdev);
 153
 154         if (hw) {
 155                 struct ath_wiphy *aphy = hw->priv;
 156                 struct ath_softc *sc = aphy->sc;
 157                 void __iomem *mem = sc->mem;
 158
 159                 ath9k_deinit_device(sc);
 160                 free_irq(sc->irq, sc);
 161                 ieee80211_free_hw(sc->hw);
 162                 iounmap(mem);
 163                 platform_set_drvdata(pdev, NULL);
 164         }
 165
 166         return 0;
 167 }
 168
 169 static struct platform_driver ath_ahb_driver = {
 170         .probe      = ath_ahb_probe,
 171         .remove     = ath_ahb_remove,
 172         .driver         = {
 173                 .name   = "ath9k",
 174                 .owner  = THIS_MODULE,
 175         },
 176 };
 177
 178 int ath_ahb_init(void)
 179 {
 180         return platform_driver_register(&ath_ahb_driver);
 181 }
 182
 183 void ath_ahb_exit(void)
 184 {
 185         platform_driver_unregister(&ath_ahb_driver);
 186 }