| Michael Buesch | 42bfad4 | 2008-02-19 12:41:30 +0100 | [diff] [blame] | 1 | /* | 
 | 2 |  * Sonics Silicon Backplane | 
 | 3 |  * Embedded systems support code | 
 | 4 |  * | 
 | 5 |  * Copyright 2005-2008, Broadcom Corporation | 
 | 6 |  * Copyright 2006-2008, Michael Buesch <mb@bu3sch.de> | 
 | 7 |  * | 
 | 8 |  * Licensed under the GNU/GPL. See COPYING for details. | 
 | 9 |  */ | 
 | 10 |  | 
 | 11 | #include <linux/ssb/ssb.h> | 
 | 12 | #include <linux/ssb/ssb_embedded.h> | 
| Michael Buesch | aab547c | 2008-02-29 11:36:12 +0100 | [diff] [blame] | 13 | #include <linux/ssb/ssb_driver_pci.h> | 
 | 14 | #include <linux/ssb/ssb_driver_gige.h> | 
 | 15 | #include <linux/pci.h> | 
| Michael Buesch | 42bfad4 | 2008-02-19 12:41:30 +0100 | [diff] [blame] | 16 |  | 
| Michael Buesch | 53521d8 | 2008-02-19 16:22:50 +0100 | [diff] [blame] | 17 | #include "ssb_private.h" | 
 | 18 |  | 
| Michael Buesch | 42bfad4 | 2008-02-19 12:41:30 +0100 | [diff] [blame] | 19 |  | 
 | 20 | int ssb_watchdog_timer_set(struct ssb_bus *bus, u32 ticks) | 
 | 21 | { | 
 | 22 | 	if (ssb_chipco_available(&bus->chipco)) { | 
 | 23 | 		ssb_chipco_watchdog_timer_set(&bus->chipco, ticks); | 
 | 24 | 		return 0; | 
 | 25 | 	} | 
 | 26 | 	if (ssb_extif_available(&bus->extif)) { | 
 | 27 | 		ssb_extif_watchdog_timer_set(&bus->extif, ticks); | 
 | 28 | 		return 0; | 
 | 29 | 	} | 
 | 30 | 	return -ENODEV; | 
 | 31 | } | 
| Michael Buesch | 53521d8 | 2008-02-19 16:22:50 +0100 | [diff] [blame] | 32 |  | 
 | 33 | u32 ssb_gpio_in(struct ssb_bus *bus, u32 mask) | 
 | 34 | { | 
 | 35 | 	unsigned long flags; | 
 | 36 | 	u32 res = 0; | 
 | 37 |  | 
 | 38 | 	spin_lock_irqsave(&bus->gpio_lock, flags); | 
 | 39 | 	if (ssb_chipco_available(&bus->chipco)) | 
 | 40 | 		res = ssb_chipco_gpio_in(&bus->chipco, mask); | 
 | 41 | 	else if (ssb_extif_available(&bus->extif)) | 
 | 42 | 		res = ssb_extif_gpio_in(&bus->extif, mask); | 
 | 43 | 	else | 
 | 44 | 		SSB_WARN_ON(1); | 
 | 45 | 	spin_unlock_irqrestore(&bus->gpio_lock, flags); | 
 | 46 |  | 
 | 47 | 	return res; | 
 | 48 | } | 
 | 49 | EXPORT_SYMBOL(ssb_gpio_in); | 
 | 50 |  | 
 | 51 | u32 ssb_gpio_out(struct ssb_bus *bus, u32 mask, u32 value) | 
 | 52 | { | 
 | 53 | 	unsigned long flags; | 
 | 54 | 	u32 res = 0; | 
 | 55 |  | 
 | 56 | 	spin_lock_irqsave(&bus->gpio_lock, flags); | 
 | 57 | 	if (ssb_chipco_available(&bus->chipco)) | 
 | 58 | 		res = ssb_chipco_gpio_out(&bus->chipco, mask, value); | 
 | 59 | 	else if (ssb_extif_available(&bus->extif)) | 
 | 60 | 		res = ssb_extif_gpio_out(&bus->extif, mask, value); | 
 | 61 | 	else | 
 | 62 | 		SSB_WARN_ON(1); | 
 | 63 | 	spin_unlock_irqrestore(&bus->gpio_lock, flags); | 
 | 64 |  | 
 | 65 | 	return res; | 
 | 66 | } | 
 | 67 | EXPORT_SYMBOL(ssb_gpio_out); | 
 | 68 |  | 
 | 69 | u32 ssb_gpio_outen(struct ssb_bus *bus, u32 mask, u32 value) | 
 | 70 | { | 
 | 71 | 	unsigned long flags; | 
 | 72 | 	u32 res = 0; | 
 | 73 |  | 
 | 74 | 	spin_lock_irqsave(&bus->gpio_lock, flags); | 
 | 75 | 	if (ssb_chipco_available(&bus->chipco)) | 
 | 76 | 		res = ssb_chipco_gpio_outen(&bus->chipco, mask, value); | 
 | 77 | 	else if (ssb_extif_available(&bus->extif)) | 
 | 78 | 		res = ssb_extif_gpio_outen(&bus->extif, mask, value); | 
 | 79 | 	else | 
 | 80 | 		SSB_WARN_ON(1); | 
 | 81 | 	spin_unlock_irqrestore(&bus->gpio_lock, flags); | 
 | 82 |  | 
 | 83 | 	return res; | 
 | 84 | } | 
 | 85 | EXPORT_SYMBOL(ssb_gpio_outen); | 
 | 86 |  | 
 | 87 | u32 ssb_gpio_control(struct ssb_bus *bus, u32 mask, u32 value) | 
 | 88 | { | 
 | 89 | 	unsigned long flags; | 
 | 90 | 	u32 res = 0; | 
 | 91 |  | 
 | 92 | 	spin_lock_irqsave(&bus->gpio_lock, flags); | 
 | 93 | 	if (ssb_chipco_available(&bus->chipco)) | 
 | 94 | 		res = ssb_chipco_gpio_control(&bus->chipco, mask, value); | 
 | 95 | 	spin_unlock_irqrestore(&bus->gpio_lock, flags); | 
 | 96 |  | 
 | 97 | 	return res; | 
 | 98 | } | 
 | 99 | EXPORT_SYMBOL(ssb_gpio_control); | 
 | 100 |  | 
 | 101 | u32 ssb_gpio_intmask(struct ssb_bus *bus, u32 mask, u32 value) | 
 | 102 | { | 
 | 103 | 	unsigned long flags; | 
 | 104 | 	u32 res = 0; | 
 | 105 |  | 
 | 106 | 	spin_lock_irqsave(&bus->gpio_lock, flags); | 
 | 107 | 	if (ssb_chipco_available(&bus->chipco)) | 
 | 108 | 		res = ssb_chipco_gpio_intmask(&bus->chipco, mask, value); | 
 | 109 | 	else if (ssb_extif_available(&bus->extif)) | 
 | 110 | 		res = ssb_extif_gpio_intmask(&bus->extif, mask, value); | 
 | 111 | 	else | 
 | 112 | 		SSB_WARN_ON(1); | 
 | 113 | 	spin_unlock_irqrestore(&bus->gpio_lock, flags); | 
 | 114 |  | 
 | 115 | 	return res; | 
 | 116 | } | 
 | 117 | EXPORT_SYMBOL(ssb_gpio_intmask); | 
 | 118 |  | 
 | 119 | u32 ssb_gpio_polarity(struct ssb_bus *bus, u32 mask, u32 value) | 
 | 120 | { | 
 | 121 | 	unsigned long flags; | 
 | 122 | 	u32 res = 0; | 
 | 123 |  | 
 | 124 | 	spin_lock_irqsave(&bus->gpio_lock, flags); | 
 | 125 | 	if (ssb_chipco_available(&bus->chipco)) | 
 | 126 | 		res = ssb_chipco_gpio_polarity(&bus->chipco, mask, value); | 
 | 127 | 	else if (ssb_extif_available(&bus->extif)) | 
 | 128 | 		res = ssb_extif_gpio_polarity(&bus->extif, mask, value); | 
 | 129 | 	else | 
 | 130 | 		SSB_WARN_ON(1); | 
 | 131 | 	spin_unlock_irqrestore(&bus->gpio_lock, flags); | 
 | 132 |  | 
 | 133 | 	return res; | 
 | 134 | } | 
 | 135 | EXPORT_SYMBOL(ssb_gpio_polarity); | 
| Michael Buesch | aab547c | 2008-02-29 11:36:12 +0100 | [diff] [blame] | 136 |  | 
 | 137 | #ifdef CONFIG_SSB_DRIVER_GIGE | 
 | 138 | static int gige_pci_init_callback(struct ssb_bus *bus, unsigned long data) | 
 | 139 | { | 
 | 140 | 	struct pci_dev *pdev = (struct pci_dev *)data; | 
 | 141 | 	struct ssb_device *dev; | 
 | 142 | 	unsigned int i; | 
 | 143 | 	int res; | 
 | 144 |  | 
 | 145 | 	for (i = 0; i < bus->nr_devices; i++) { | 
 | 146 | 		dev = &(bus->devices[i]); | 
 | 147 | 		if (dev->id.coreid != SSB_DEV_ETHERNET_GBIT) | 
 | 148 | 			continue; | 
 | 149 | 		if (!dev->dev || | 
 | 150 | 		    !dev->dev->driver || | 
 | 151 | 		    !device_is_registered(dev->dev)) | 
 | 152 | 			continue; | 
 | 153 | 		res = ssb_gige_pcibios_plat_dev_init(dev, pdev); | 
 | 154 | 		if (res >= 0) | 
 | 155 | 			return res; | 
 | 156 | 	} | 
 | 157 |  | 
 | 158 | 	return -ENODEV; | 
 | 159 | } | 
 | 160 | #endif /* CONFIG_SSB_DRIVER_GIGE */ | 
 | 161 |  | 
 | 162 | int ssb_pcibios_plat_dev_init(struct pci_dev *dev) | 
 | 163 | { | 
 | 164 | 	int err; | 
 | 165 |  | 
 | 166 | 	err = ssb_pcicore_plat_dev_init(dev); | 
 | 167 | 	if (!err) | 
 | 168 | 		return 0; | 
 | 169 | #ifdef CONFIG_SSB_DRIVER_GIGE | 
 | 170 | 	err = ssb_for_each_bus_call((unsigned long)dev, gige_pci_init_callback); | 
 | 171 | 	if (err >= 0) | 
 | 172 | 		return err; | 
 | 173 | #endif | 
 | 174 | 	/* This is not a PCI device on any SSB device. */ | 
 | 175 |  | 
 | 176 | 	return -ENODEV; | 
 | 177 | } | 
 | 178 |  | 
 | 179 | #ifdef CONFIG_SSB_DRIVER_GIGE | 
 | 180 | static int gige_map_irq_callback(struct ssb_bus *bus, unsigned long data) | 
 | 181 | { | 
 | 182 | 	const struct pci_dev *pdev = (const struct pci_dev *)data; | 
 | 183 | 	struct ssb_device *dev; | 
 | 184 | 	unsigned int i; | 
 | 185 | 	int res; | 
 | 186 |  | 
 | 187 | 	for (i = 0; i < bus->nr_devices; i++) { | 
 | 188 | 		dev = &(bus->devices[i]); | 
 | 189 | 		if (dev->id.coreid != SSB_DEV_ETHERNET_GBIT) | 
 | 190 | 			continue; | 
 | 191 | 		if (!dev->dev || | 
 | 192 | 		    !dev->dev->driver || | 
 | 193 | 		    !device_is_registered(dev->dev)) | 
 | 194 | 			continue; | 
 | 195 | 		res = ssb_gige_map_irq(dev, pdev); | 
 | 196 | 		if (res >= 0) | 
 | 197 | 			return res; | 
 | 198 | 	} | 
 | 199 |  | 
 | 200 | 	return -ENODEV; | 
 | 201 | } | 
 | 202 | #endif /* CONFIG_SSB_DRIVER_GIGE */ | 
 | 203 |  | 
 | 204 | int ssb_pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin) | 
 | 205 | { | 
 | 206 | 	int res; | 
 | 207 |  | 
 | 208 | 	/* Check if this PCI device is a device on a SSB bus or device | 
 | 209 | 	 * and return the IRQ number for it. */ | 
 | 210 |  | 
 | 211 | 	res = ssb_pcicore_pcibios_map_irq(dev, slot, pin); | 
 | 212 | 	if (res >= 0) | 
 | 213 | 		return res; | 
 | 214 | #ifdef CONFIG_SSB_DRIVER_GIGE | 
 | 215 | 	res = ssb_for_each_bus_call((unsigned long)dev, gige_map_irq_callback); | 
 | 216 | 	if (res >= 0) | 
 | 217 | 		return res; | 
 | 218 | #endif | 
 | 219 | 	/* This is not a PCI device on any SSB device. */ | 
 | 220 |  | 
 | 221 | 	return -ENODEV; | 
 | 222 | } |