1 /* 2 Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com> 3 Copyright (C) 2004 - 2009 Felix Fietkau <nbd@openwrt.org> 4 <http://rt2x00.serialmonkey.com> 5 6 This program is free software; you can redistribute it and/or modify 7 it under the terms of the GNU General Public License as published by 8 the Free Software Foundation; either version 2 of the License, or 9 (at your option) any later version. 10 11 This program is distributed in the hope that it will be useful, 12 but WITHOUT ANY WARRANTY; without even the implied warranty of 13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 GNU General Public License for more details. 15 16 You should have received a copy of the GNU General Public License 17 along with this program; if not, see <http://www.gnu.org/licenses/>. 18 */ 19 20 /* 21 Module: rt2x00soc 22 Abstract: rt2x00 generic soc device routines. 23 */ 24 25 #include <linux/bug.h> 26 #include <linux/kernel.h> 27 #include <linux/module.h> 28 #include <linux/platform_device.h> 29 #include <linux/slab.h> 30 31 #include "rt2x00.h" 32 #include "rt2x00soc.h" 33 34 static void rt2x00soc_free_reg(struct rt2x00_dev *rt2x00dev) 35 { 36 kfree(rt2x00dev->rf); 37 rt2x00dev->rf = NULL; 38 39 kfree(rt2x00dev->eeprom); 40 rt2x00dev->eeprom = NULL; 41 42 iounmap(rt2x00dev->csr.base); 43 } 44 45 static int rt2x00soc_alloc_reg(struct rt2x00_dev *rt2x00dev) 46 { 47 struct platform_device *pdev = to_platform_device(rt2x00dev->dev); 48 struct resource *res; 49 50 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 51 if (!res) 52 return -ENODEV; 53 54 rt2x00dev->csr.base = ioremap(res->start, resource_size(res)); 55 if (!rt2x00dev->csr.base) 56 return -ENOMEM; 57 58 rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL); 59 if (!rt2x00dev->eeprom) 60 goto exit; 61 62 rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL); 63 if (!rt2x00dev->rf) 64 goto exit; 65 66 return 0; 67 68 exit: 69 rt2x00_probe_err("Failed to allocate registers\n"); 70 rt2x00soc_free_reg(rt2x00dev); 71 72 return -ENOMEM; 73 } 74 75 int rt2x00soc_probe(struct platform_device *pdev, const struct rt2x00_ops *ops) 76 { 77 struct ieee80211_hw *hw; 78 struct rt2x00_dev *rt2x00dev; 79 int retval; 80 81 hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw); 82 if (!hw) { 83 rt2x00_probe_err("Failed to allocate hardware\n"); 84 return -ENOMEM; 85 } 86 87 platform_set_drvdata(pdev, hw); 88 89 rt2x00dev = hw->priv; 90 rt2x00dev->dev = &pdev->dev; 91 rt2x00dev->ops = ops; 92 rt2x00dev->hw = hw; 93 rt2x00dev->irq = platform_get_irq(pdev, 0); 94 rt2x00dev->name = pdev->dev.driver->name; 95 96 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_SOC); 97 98 retval = rt2x00soc_alloc_reg(rt2x00dev); 99 if (retval) 100 goto exit_free_device; 101 102 retval = rt2x00lib_probe_dev(rt2x00dev); 103 if (retval) 104 goto exit_free_reg; 105 106 return 0; 107 108 exit_free_reg: 109 rt2x00soc_free_reg(rt2x00dev); 110 111 exit_free_device: 112 ieee80211_free_hw(hw); 113 114 return retval; 115 } 116 EXPORT_SYMBOL_GPL(rt2x00soc_probe); 117 118 int rt2x00soc_remove(struct platform_device *pdev) 119 { 120 struct ieee80211_hw *hw = platform_get_drvdata(pdev); 121 struct rt2x00_dev *rt2x00dev = hw->priv; 122 123 /* 124 * Free all allocated data. 125 */ 126 rt2x00lib_remove_dev(rt2x00dev); 127 rt2x00soc_free_reg(rt2x00dev); 128 ieee80211_free_hw(hw); 129 130 return 0; 131 } 132 EXPORT_SYMBOL_GPL(rt2x00soc_remove); 133 134 #ifdef CONFIG_PM 135 int rt2x00soc_suspend(struct platform_device *pdev, pm_message_t state) 136 { 137 struct ieee80211_hw *hw = platform_get_drvdata(pdev); 138 struct rt2x00_dev *rt2x00dev = hw->priv; 139 140 return rt2x00lib_suspend(rt2x00dev, state); 141 } 142 EXPORT_SYMBOL_GPL(rt2x00soc_suspend); 143 144 int rt2x00soc_resume(struct platform_device *pdev) 145 { 146 struct ieee80211_hw *hw = platform_get_drvdata(pdev); 147 struct rt2x00_dev *rt2x00dev = hw->priv; 148 149 return rt2x00lib_resume(rt2x00dev); 150 } 151 EXPORT_SYMBOL_GPL(rt2x00soc_resume); 152 #endif /* CONFIG_PM */ 153 154 /* 155 * rt2x00soc module information. 156 */ 157 MODULE_AUTHOR(DRV_PROJECT); 158 MODULE_VERSION(DRV_VERSION); 159 MODULE_DESCRIPTION("rt2x00 soc library"); 160 MODULE_LICENSE("GPL"); 161