xref: /OK3568_Linux_fs/kernel/drivers/ssb/embedded.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Sonics Silicon Backplane
3*4882a593Smuzhiyun  * Embedded systems support code
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2005-2008, Broadcom Corporation
6*4882a593Smuzhiyun  * Copyright 2006-2008, Michael Buesch <m@bues.ch>
7*4882a593Smuzhiyun  * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Licensed under the GNU/GPL. See COPYING for details.
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include "ssb_private.h"
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun #include <linux/export.h>
15*4882a593Smuzhiyun #include <linux/platform_device.h>
16*4882a593Smuzhiyun #include <linux/ssb/ssb.h>
17*4882a593Smuzhiyun #include <linux/ssb/ssb_embedded.h>
18*4882a593Smuzhiyun #include <linux/ssb/ssb_driver_pci.h>
19*4882a593Smuzhiyun #include <linux/ssb/ssb_driver_gige.h>
20*4882a593Smuzhiyun #include <linux/pci.h>
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun 
ssb_watchdog_timer_set(struct ssb_bus * bus,u32 ticks)23*4882a593Smuzhiyun int ssb_watchdog_timer_set(struct ssb_bus *bus, u32 ticks)
24*4882a593Smuzhiyun {
25*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco)) {
26*4882a593Smuzhiyun 		ssb_chipco_watchdog_timer_set(&bus->chipco, ticks);
27*4882a593Smuzhiyun 		return 0;
28*4882a593Smuzhiyun 	}
29*4882a593Smuzhiyun 	if (ssb_extif_available(&bus->extif)) {
30*4882a593Smuzhiyun 		ssb_extif_watchdog_timer_set(&bus->extif, ticks);
31*4882a593Smuzhiyun 		return 0;
32*4882a593Smuzhiyun 	}
33*4882a593Smuzhiyun 	return -ENODEV;
34*4882a593Smuzhiyun }
35*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_watchdog_timer_set);
36*4882a593Smuzhiyun 
ssb_watchdog_register(struct ssb_bus * bus)37*4882a593Smuzhiyun int ssb_watchdog_register(struct ssb_bus *bus)
38*4882a593Smuzhiyun {
39*4882a593Smuzhiyun 	struct bcm47xx_wdt wdt = {};
40*4882a593Smuzhiyun 	struct platform_device *pdev;
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco)) {
43*4882a593Smuzhiyun 		wdt.driver_data = &bus->chipco;
44*4882a593Smuzhiyun 		wdt.timer_set = ssb_chipco_watchdog_timer_set_wdt;
45*4882a593Smuzhiyun 		wdt.timer_set_ms = ssb_chipco_watchdog_timer_set_ms;
46*4882a593Smuzhiyun 		wdt.max_timer_ms = bus->chipco.max_timer_ms;
47*4882a593Smuzhiyun 	} else if (ssb_extif_available(&bus->extif)) {
48*4882a593Smuzhiyun 		wdt.driver_data = &bus->extif;
49*4882a593Smuzhiyun 		wdt.timer_set = ssb_extif_watchdog_timer_set_wdt;
50*4882a593Smuzhiyun 		wdt.timer_set_ms = ssb_extif_watchdog_timer_set_ms;
51*4882a593Smuzhiyun 		wdt.max_timer_ms = SSB_EXTIF_WATCHDOG_MAX_TIMER_MS;
52*4882a593Smuzhiyun 	} else {
53*4882a593Smuzhiyun 		return -ENODEV;
54*4882a593Smuzhiyun 	}
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun 	pdev = platform_device_register_data(NULL, "bcm47xx-wdt",
57*4882a593Smuzhiyun 					     bus->busnumber, &wdt,
58*4882a593Smuzhiyun 					     sizeof(wdt));
59*4882a593Smuzhiyun 	if (IS_ERR(pdev)) {
60*4882a593Smuzhiyun 		pr_debug("can not register watchdog device, err: %li\n",
61*4882a593Smuzhiyun 			 PTR_ERR(pdev));
62*4882a593Smuzhiyun 		return PTR_ERR(pdev);
63*4882a593Smuzhiyun 	}
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun 	bus->watchdog = pdev;
66*4882a593Smuzhiyun 	return 0;
67*4882a593Smuzhiyun }
68*4882a593Smuzhiyun 
ssb_gpio_in(struct ssb_bus * bus,u32 mask)69*4882a593Smuzhiyun u32 ssb_gpio_in(struct ssb_bus *bus, u32 mask)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun 	unsigned long flags;
72*4882a593Smuzhiyun 	u32 res = 0;
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	spin_lock_irqsave(&bus->gpio_lock, flags);
75*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco))
76*4882a593Smuzhiyun 		res = ssb_chipco_gpio_in(&bus->chipco, mask);
77*4882a593Smuzhiyun 	else if (ssb_extif_available(&bus->extif))
78*4882a593Smuzhiyun 		res = ssb_extif_gpio_in(&bus->extif, mask);
79*4882a593Smuzhiyun 	else
80*4882a593Smuzhiyun 		WARN_ON(1);
81*4882a593Smuzhiyun 	spin_unlock_irqrestore(&bus->gpio_lock, flags);
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun 	return res;
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_gpio_in);
86*4882a593Smuzhiyun 
ssb_gpio_out(struct ssb_bus * bus,u32 mask,u32 value)87*4882a593Smuzhiyun u32 ssb_gpio_out(struct ssb_bus *bus, u32 mask, u32 value)
88*4882a593Smuzhiyun {
89*4882a593Smuzhiyun 	unsigned long flags;
90*4882a593Smuzhiyun 	u32 res = 0;
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun 	spin_lock_irqsave(&bus->gpio_lock, flags);
93*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco))
94*4882a593Smuzhiyun 		res = ssb_chipco_gpio_out(&bus->chipco, mask, value);
95*4882a593Smuzhiyun 	else if (ssb_extif_available(&bus->extif))
96*4882a593Smuzhiyun 		res = ssb_extif_gpio_out(&bus->extif, mask, value);
97*4882a593Smuzhiyun 	else
98*4882a593Smuzhiyun 		WARN_ON(1);
99*4882a593Smuzhiyun 	spin_unlock_irqrestore(&bus->gpio_lock, flags);
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun 	return res;
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_gpio_out);
104*4882a593Smuzhiyun 
ssb_gpio_outen(struct ssb_bus * bus,u32 mask,u32 value)105*4882a593Smuzhiyun u32 ssb_gpio_outen(struct ssb_bus *bus, u32 mask, u32 value)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun 	unsigned long flags;
108*4882a593Smuzhiyun 	u32 res = 0;
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	spin_lock_irqsave(&bus->gpio_lock, flags);
111*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco))
112*4882a593Smuzhiyun 		res = ssb_chipco_gpio_outen(&bus->chipco, mask, value);
113*4882a593Smuzhiyun 	else if (ssb_extif_available(&bus->extif))
114*4882a593Smuzhiyun 		res = ssb_extif_gpio_outen(&bus->extif, mask, value);
115*4882a593Smuzhiyun 	else
116*4882a593Smuzhiyun 		WARN_ON(1);
117*4882a593Smuzhiyun 	spin_unlock_irqrestore(&bus->gpio_lock, flags);
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun 	return res;
120*4882a593Smuzhiyun }
121*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_gpio_outen);
122*4882a593Smuzhiyun 
ssb_gpio_control(struct ssb_bus * bus,u32 mask,u32 value)123*4882a593Smuzhiyun u32 ssb_gpio_control(struct ssb_bus *bus, u32 mask, u32 value)
124*4882a593Smuzhiyun {
125*4882a593Smuzhiyun 	unsigned long flags;
126*4882a593Smuzhiyun 	u32 res = 0;
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun 	spin_lock_irqsave(&bus->gpio_lock, flags);
129*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco))
130*4882a593Smuzhiyun 		res = ssb_chipco_gpio_control(&bus->chipco, mask, value);
131*4882a593Smuzhiyun 	spin_unlock_irqrestore(&bus->gpio_lock, flags);
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun 	return res;
134*4882a593Smuzhiyun }
135*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_gpio_control);
136*4882a593Smuzhiyun 
ssb_gpio_intmask(struct ssb_bus * bus,u32 mask,u32 value)137*4882a593Smuzhiyun u32 ssb_gpio_intmask(struct ssb_bus *bus, u32 mask, u32 value)
138*4882a593Smuzhiyun {
139*4882a593Smuzhiyun 	unsigned long flags;
140*4882a593Smuzhiyun 	u32 res = 0;
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	spin_lock_irqsave(&bus->gpio_lock, flags);
143*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco))
144*4882a593Smuzhiyun 		res = ssb_chipco_gpio_intmask(&bus->chipco, mask, value);
145*4882a593Smuzhiyun 	else if (ssb_extif_available(&bus->extif))
146*4882a593Smuzhiyun 		res = ssb_extif_gpio_intmask(&bus->extif, mask, value);
147*4882a593Smuzhiyun 	else
148*4882a593Smuzhiyun 		WARN_ON(1);
149*4882a593Smuzhiyun 	spin_unlock_irqrestore(&bus->gpio_lock, flags);
150*4882a593Smuzhiyun 
151*4882a593Smuzhiyun 	return res;
152*4882a593Smuzhiyun }
153*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_gpio_intmask);
154*4882a593Smuzhiyun 
ssb_gpio_polarity(struct ssb_bus * bus,u32 mask,u32 value)155*4882a593Smuzhiyun u32 ssb_gpio_polarity(struct ssb_bus *bus, u32 mask, u32 value)
156*4882a593Smuzhiyun {
157*4882a593Smuzhiyun 	unsigned long flags;
158*4882a593Smuzhiyun 	u32 res = 0;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	spin_lock_irqsave(&bus->gpio_lock, flags);
161*4882a593Smuzhiyun 	if (ssb_chipco_available(&bus->chipco))
162*4882a593Smuzhiyun 		res = ssb_chipco_gpio_polarity(&bus->chipco, mask, value);
163*4882a593Smuzhiyun 	else if (ssb_extif_available(&bus->extif))
164*4882a593Smuzhiyun 		res = ssb_extif_gpio_polarity(&bus->extif, mask, value);
165*4882a593Smuzhiyun 	else
166*4882a593Smuzhiyun 		WARN_ON(1);
167*4882a593Smuzhiyun 	spin_unlock_irqrestore(&bus->gpio_lock, flags);
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	return res;
170*4882a593Smuzhiyun }
171*4882a593Smuzhiyun EXPORT_SYMBOL(ssb_gpio_polarity);
172*4882a593Smuzhiyun 
173*4882a593Smuzhiyun #ifdef CONFIG_SSB_DRIVER_GIGE
gige_pci_init_callback(struct ssb_bus * bus,unsigned long data)174*4882a593Smuzhiyun static int gige_pci_init_callback(struct ssb_bus *bus, unsigned long data)
175*4882a593Smuzhiyun {
176*4882a593Smuzhiyun 	struct pci_dev *pdev = (struct pci_dev *)data;
177*4882a593Smuzhiyun 	struct ssb_device *dev;
178*4882a593Smuzhiyun 	unsigned int i;
179*4882a593Smuzhiyun 	int res;
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	for (i = 0; i < bus->nr_devices; i++) {
182*4882a593Smuzhiyun 		dev = &(bus->devices[i]);
183*4882a593Smuzhiyun 		if (dev->id.coreid != SSB_DEV_ETHERNET_GBIT)
184*4882a593Smuzhiyun 			continue;
185*4882a593Smuzhiyun 		if (!dev->dev ||
186*4882a593Smuzhiyun 		    !dev->dev->driver ||
187*4882a593Smuzhiyun 		    !device_is_registered(dev->dev))
188*4882a593Smuzhiyun 			continue;
189*4882a593Smuzhiyun 		res = ssb_gige_pcibios_plat_dev_init(dev, pdev);
190*4882a593Smuzhiyun 		if (res >= 0)
191*4882a593Smuzhiyun 			return res;
192*4882a593Smuzhiyun 	}
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun 	return -ENODEV;
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun #endif /* CONFIG_SSB_DRIVER_GIGE */
197*4882a593Smuzhiyun 
ssb_pcibios_plat_dev_init(struct pci_dev * dev)198*4882a593Smuzhiyun int ssb_pcibios_plat_dev_init(struct pci_dev *dev)
199*4882a593Smuzhiyun {
200*4882a593Smuzhiyun 	int err;
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	err = ssb_pcicore_plat_dev_init(dev);
203*4882a593Smuzhiyun 	if (!err)
204*4882a593Smuzhiyun 		return 0;
205*4882a593Smuzhiyun #ifdef CONFIG_SSB_DRIVER_GIGE
206*4882a593Smuzhiyun 	err = ssb_for_each_bus_call((unsigned long)dev, gige_pci_init_callback);
207*4882a593Smuzhiyun 	if (err >= 0)
208*4882a593Smuzhiyun 		return err;
209*4882a593Smuzhiyun #endif
210*4882a593Smuzhiyun 	/* This is not a PCI device on any SSB device. */
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	return -ENODEV;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun #ifdef CONFIG_SSB_DRIVER_GIGE
gige_map_irq_callback(struct ssb_bus * bus,unsigned long data)216*4882a593Smuzhiyun static int gige_map_irq_callback(struct ssb_bus *bus, unsigned long data)
217*4882a593Smuzhiyun {
218*4882a593Smuzhiyun 	const struct pci_dev *pdev = (const struct pci_dev *)data;
219*4882a593Smuzhiyun 	struct ssb_device *dev;
220*4882a593Smuzhiyun 	unsigned int i;
221*4882a593Smuzhiyun 	int res;
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 	for (i = 0; i < bus->nr_devices; i++) {
224*4882a593Smuzhiyun 		dev = &(bus->devices[i]);
225*4882a593Smuzhiyun 		if (dev->id.coreid != SSB_DEV_ETHERNET_GBIT)
226*4882a593Smuzhiyun 			continue;
227*4882a593Smuzhiyun 		if (!dev->dev ||
228*4882a593Smuzhiyun 		    !dev->dev->driver ||
229*4882a593Smuzhiyun 		    !device_is_registered(dev->dev))
230*4882a593Smuzhiyun 			continue;
231*4882a593Smuzhiyun 		res = ssb_gige_map_irq(dev, pdev);
232*4882a593Smuzhiyun 		if (res >= 0)
233*4882a593Smuzhiyun 			return res;
234*4882a593Smuzhiyun 	}
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	return -ENODEV;
237*4882a593Smuzhiyun }
238*4882a593Smuzhiyun #endif /* CONFIG_SSB_DRIVER_GIGE */
239*4882a593Smuzhiyun 
ssb_pcibios_map_irq(const struct pci_dev * dev,u8 slot,u8 pin)240*4882a593Smuzhiyun int ssb_pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
241*4882a593Smuzhiyun {
242*4882a593Smuzhiyun 	int res;
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 	/* Check if this PCI device is a device on a SSB bus or device
245*4882a593Smuzhiyun 	 * and return the IRQ number for it. */
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	res = ssb_pcicore_pcibios_map_irq(dev, slot, pin);
248*4882a593Smuzhiyun 	if (res >= 0)
249*4882a593Smuzhiyun 		return res;
250*4882a593Smuzhiyun #ifdef CONFIG_SSB_DRIVER_GIGE
251*4882a593Smuzhiyun 	res = ssb_for_each_bus_call((unsigned long)dev, gige_map_irq_callback);
252*4882a593Smuzhiyun 	if (res >= 0)
253*4882a593Smuzhiyun 		return res;
254*4882a593Smuzhiyun #endif
255*4882a593Smuzhiyun 	/* This is not a PCI device on any SSB device. */
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun 	return -ENODEV;
258*4882a593Smuzhiyun }
259