ssb: Make the GPIO API reentrancy safe.
SVN-Revision: 10496
This commit is contained in:
		@@ -3,54 +3,39 @@
 | 
				
			|||||||
#include <linux/interrupt.h>
 | 
					#include <linux/interrupt.h>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#ifndef BCMDRIVER
 | 
					#ifndef BCMDRIVER
 | 
				
			||||||
#include <linux/ssb/ssb.h>
 | 
					#include <linux/ssb/ssb_embedded.h>
 | 
				
			||||||
#include <linux/ssb/ssb_driver_chipcommon.h>
 | 
					 | 
				
			||||||
#include <linux/ssb/ssb_driver_extif.h>
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
extern struct ssb_bus ssb;
 | 
					extern struct ssb_bus ssb;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#define gpio_op(op, param...) \
 | 
					 | 
				
			||||||
	do { \
 | 
					 | 
				
			||||||
		if (ssb.chipco.dev) \
 | 
					 | 
				
			||||||
			return ssb_chipco_gpio_##op(&ssb.chipco, param); \
 | 
					 | 
				
			||||||
		else if (ssb.extif.dev) \
 | 
					 | 
				
			||||||
			return ssb_extif_gpio_##op(&ssb.extif, param); \
 | 
					 | 
				
			||||||
		else \
 | 
					 | 
				
			||||||
			return 0; \
 | 
					 | 
				
			||||||
	} while (0);
 | 
					 | 
				
			||||||
		
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_in(void)
 | 
					static inline u32 gpio_in(void)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(in, ~0);
 | 
						return ssb_gpio_in(&ssb, ~0);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_out(u32 mask, u32 value)
 | 
					static inline u32 gpio_out(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(out, mask, value);
 | 
						return ssb_gpio_out(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_outen(u32 mask, u32 value)
 | 
					static inline u32 gpio_outen(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(outen, mask, value);
 | 
						return ssb_gpio_outen(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_control(u32 mask, u32 value)
 | 
					static inline u32 gpio_control(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	if (ssb.chipco.dev)
 | 
						return ssb_gpio_control(&ssb, mask, value);
 | 
				
			||||||
		return ssb_chipco_gpio_control(&ssb.chipco, mask, value);
 | 
					 | 
				
			||||||
	else
 | 
					 | 
				
			||||||
		return 0;
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_intmask(u32 mask, u32 value)
 | 
					static inline u32 gpio_intmask(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(intmask, mask, value);
 | 
						return ssb_gpio_intmask(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_intpolarity(u32 mask, u32 value)
 | 
					static inline u32 gpio_intpolarity(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(polarity, mask, value);
 | 
						return ssb_gpio_polarity(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 __ssb_write32_masked(struct ssb_device *dev, u16 offset,
 | 
					static inline u32 __ssb_write32_masked(struct ssb_device *dev, u16 offset,
 | 
				
			||||||
 
 | 
				
			|||||||
@@ -3,54 +3,39 @@
 | 
				
			|||||||
#include <linux/interrupt.h>
 | 
					#include <linux/interrupt.h>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#ifndef BCMDRIVER
 | 
					#ifndef BCMDRIVER
 | 
				
			||||||
#include <linux/ssb/ssb.h>
 | 
					#include <linux/ssb/ssb_embedded.h>
 | 
				
			||||||
#include <linux/ssb/ssb_driver_chipcommon.h>
 | 
					 | 
				
			||||||
#include <linux/ssb/ssb_driver_extif.h>
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
extern struct ssb_bus ssb;
 | 
					extern struct ssb_bus ssb;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#define gpio_op(op, param...) \
 | 
					 | 
				
			||||||
	do { \
 | 
					 | 
				
			||||||
		if (ssb.chipco.dev) \
 | 
					 | 
				
			||||||
			return ssb_chipco_gpio_##op(&ssb.chipco, param); \
 | 
					 | 
				
			||||||
		else if (ssb.extif.dev) \
 | 
					 | 
				
			||||||
			return ssb_extif_gpio_##op(&ssb.extif, param); \
 | 
					 | 
				
			||||||
		else \
 | 
					 | 
				
			||||||
			return 0; \
 | 
					 | 
				
			||||||
	} while (0);
 | 
					 | 
				
			||||||
		
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_in(void)
 | 
					static inline u32 gpio_in(void)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(in, ~0);
 | 
						return ssb_gpio_in(&ssb, ~0);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_out(u32 mask, u32 value)
 | 
					static inline u32 gpio_out(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(out, mask, value);
 | 
						return ssb_gpio_out(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_outen(u32 mask, u32 value)
 | 
					static inline u32 gpio_outen(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(outen, mask, value);
 | 
						return ssb_gpio_outen(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_control(u32 mask, u32 value)
 | 
					static inline u32 gpio_control(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	if (ssb.chipco.dev)
 | 
						return ssb_gpio_control(&ssb, mask, value);
 | 
				
			||||||
		return ssb_chipco_gpio_control(&ssb.chipco, mask, value);
 | 
					 | 
				
			||||||
	else
 | 
					 | 
				
			||||||
		return 0;
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_intmask(u32 mask, u32 value)
 | 
					static inline u32 gpio_intmask(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(intmask, mask, value);
 | 
						return ssb_gpio_intmask(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline u32 gpio_intpolarity(u32 mask, u32 value)
 | 
					static inline u32 gpio_intpolarity(u32 mask, u32 value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	gpio_op(polarity, mask, value);
 | 
						return ssb_gpio_polarity(&ssb, mask, value);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#else
 | 
					#else
 | 
				
			||||||
 
 | 
				
			|||||||
@@ -1,9 +1,7 @@
 | 
				
			|||||||
#ifndef __BCM947XX_GPIO_H
 | 
					#ifndef __BCM947XX_GPIO_H
 | 
				
			||||||
#define __BCM947XX_GPIO_H
 | 
					#define __BCM947XX_GPIO_H
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include <linux/ssb/ssb.h>
 | 
					#include <linux/ssb/ssb_embedded.h>
 | 
				
			||||||
#include <linux/ssb/ssb_driver_chipcommon.h>
 | 
					 | 
				
			||||||
#include <linux/ssb/ssb_driver_extif.h>
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
extern struct ssb_bus ssb;
 | 
					extern struct ssb_bus ssb;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@@ -18,24 +16,13 @@ static inline void gpio_free(unsigned gpio)
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
static inline int gpio_direction_input(unsigned gpio)
 | 
					static inline int gpio_direction_input(unsigned gpio)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	if (ssb.chipco.dev)
 | 
						ssb_gpio_outen(&ssb, 1 << gpio, 0);
 | 
				
			||||||
		ssb_chipco_gpio_outen(&ssb.chipco, 1 << gpio, 0);
 | 
					 | 
				
			||||||
	else if (ssb.extif.dev)
 | 
					 | 
				
			||||||
		ssb_extif_gpio_outen(&ssb.extif, 1 << gpio, 0);
 | 
					 | 
				
			||||||
	else
 | 
					 | 
				
			||||||
		return -EINVAL;
 | 
					 | 
				
			||||||
	return 0;
 | 
						return 0;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline int gpio_direction_output(unsigned gpio, int value)
 | 
					static inline int gpio_direction_output(unsigned gpio, int value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	if (ssb.chipco.dev)
 | 
						ssb_gpio_outen(&ssb, 1 << gpio, value << gpio);
 | 
				
			||||||
		ssb_chipco_gpio_outen(&ssb.chipco, 1 << gpio, value << gpio);
 | 
					 | 
				
			||||||
	else if (ssb.extif.dev)
 | 
					 | 
				
			||||||
		ssb_extif_gpio_outen(&ssb.extif, 1 << gpio, value << gpio);
 | 
					 | 
				
			||||||
	else
 | 
					 | 
				
			||||||
		return -EINVAL;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	return 0;
 | 
						return 0;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@@ -61,21 +48,12 @@ static inline int irq_to_gpio(unsigned gpio)
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
static inline int gpio_get_value(unsigned gpio)
 | 
					static inline int gpio_get_value(unsigned gpio)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	if (ssb.chipco.dev)
 | 
						return !!ssb_gpio_in(&ssb, 1 << gpio);
 | 
				
			||||||
		return ssb_chipco_gpio_in(&ssb.chipco, 1 << gpio) ? 1 : 0;
 | 
					 | 
				
			||||||
	else if (ssb.extif.dev)
 | 
					 | 
				
			||||||
		return ssb_extif_gpio_in(&ssb.extif, 1 << gpio) ? 1 : 0;
 | 
					 | 
				
			||||||
	else
 | 
					 | 
				
			||||||
		return 0;
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static inline int gpio_set_value(unsigned gpio, int value)
 | 
					static inline int gpio_set_value(unsigned gpio, int value)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	if (ssb.chipco.dev)
 | 
						ssb_gpio_out(&ssb, 1 << gpio, (value ? 1 << gpio : 0));
 | 
				
			||||||
		ssb_chipco_gpio_out(&ssb.chipco, 1 << gpio, (value ? 1 << gpio : 0));
 | 
					 | 
				
			||||||
	else if (ssb.extif.dev)
 | 
					 | 
				
			||||||
		ssb_extif_gpio_out(&ssb.extif, 1 << gpio, (value ? 1 << gpio : 0));
 | 
					 | 
				
			||||||
	
 | 
					 | 
				
			||||||
	return 0;
 | 
						return 0;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 
 | 
				
			|||||||
@@ -0,0 +1,245 @@
 | 
				
			|||||||
 | 
					Index: linux-2.6.23.16/drivers/ssb/driver_chipcommon.c
 | 
				
			||||||
 | 
					===================================================================
 | 
				
			||||||
 | 
					--- linux-2.6.23.16.orig/drivers/ssb/driver_chipcommon.c	2008-02-19 15:50:42.000000000 +0100
 | 
				
			||||||
 | 
					+++ linux-2.6.23.16/drivers/ssb/driver_chipcommon.c	2008-02-19 15:50:44.000000000 +0100
 | 
				
			||||||
 | 
					@@ -361,37 +361,31 @@ u32 ssb_chipco_gpio_in(struct ssb_chipco
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return chipco_read32(cc, SSB_CHIPCO_GPIOIN) & mask;
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_chipco_gpio_in);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_chipco_gpio_out(struct ssb_chipcommon *cc, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_chipco_gpio_out);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_chipco_gpio_outen(struct ssb_chipcommon *cc, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_chipco_gpio_outen);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_chipco_gpio_control);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_chipco_gpio_intmask);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_chipco_gpio_polarity);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 #ifdef CONFIG_SSB_SERIAL
 | 
				
			||||||
 | 
					 int ssb_chipco_serial_init(struct ssb_chipcommon *cc,
 | 
				
			||||||
 | 
					Index: linux-2.6.23.16/drivers/ssb/driver_extif.c
 | 
				
			||||||
 | 
					===================================================================
 | 
				
			||||||
 | 
					--- linux-2.6.23.16.orig/drivers/ssb/driver_extif.c	2008-02-19 15:50:42.000000000 +0100
 | 
				
			||||||
 | 
					+++ linux-2.6.23.16/drivers/ssb/driver_extif.c	2008-02-19 15:50:44.000000000 +0100
 | 
				
			||||||
 | 
					@@ -122,30 +122,25 @@ u32 ssb_extif_gpio_in(struct ssb_extif *
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return extif_read32(extif, SSB_EXTIF_GPIO_IN) & mask;
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_extif_gpio_in);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_extif_gpio_out(struct ssb_extif *extif, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return extif_write32_masked(extif, SSB_EXTIF_GPIO_OUT(0),
 | 
				
			||||||
 | 
					 				   mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_extif_gpio_out);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_extif_gpio_outen(struct ssb_extif *extif, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return extif_write32_masked(extif, SSB_EXTIF_GPIO_OUTEN(0),
 | 
				
			||||||
 | 
					 				   mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_extif_gpio_outen);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_extif_gpio_polarity(struct ssb_extif *extif, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return extif_write32_masked(extif, SSB_EXTIF_GPIO_INTPOL, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_extif_gpio_polarity);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 u32 ssb_extif_gpio_intmask(struct ssb_extif *extif, u32 mask, u32 value)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					 	return extif_write32_masked(extif, SSB_EXTIF_GPIO_INTMASK, mask, value);
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					-EXPORT_SYMBOL(ssb_extif_gpio_intmask);
 | 
				
			||||||
 | 
					Index: linux-2.6.23.16/drivers/ssb/embedded.c
 | 
				
			||||||
 | 
					===================================================================
 | 
				
			||||||
 | 
					--- linux-2.6.23.16.orig/drivers/ssb/embedded.c	2008-02-19 15:50:42.000000000 +0100
 | 
				
			||||||
 | 
					+++ linux-2.6.23.16/drivers/ssb/embedded.c	2008-02-19 15:51:01.000000000 +0100
 | 
				
			||||||
 | 
					@@ -11,6 +11,8 @@
 | 
				
			||||||
 | 
					 #include <linux/ssb/ssb.h>
 | 
				
			||||||
 | 
					 #include <linux/ssb/ssb_embedded.h>
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					+#include "ssb_private.h"
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 int ssb_watchdog_timer_set(struct ssb_bus *bus, u32 ticks)
 | 
				
			||||||
 | 
					 {
 | 
				
			||||||
 | 
					@@ -24,3 +26,107 @@ int ssb_watchdog_timer_set(struct ssb_bu
 | 
				
			||||||
 | 
					 	}
 | 
				
			||||||
 | 
					 	return -ENODEV;
 | 
				
			||||||
 | 
					 }
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+u32 ssb_gpio_in(struct ssb_bus *bus, u32 mask)
 | 
				
			||||||
 | 
					+{
 | 
				
			||||||
 | 
					+	unsigned long flags;
 | 
				
			||||||
 | 
					+	u32 res = 0;
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	spin_lock_irqsave(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+	if (ssb_chipco_available(&bus->chipco))
 | 
				
			||||||
 | 
					+		res = ssb_chipco_gpio_in(&bus->chipco, mask);
 | 
				
			||||||
 | 
					+	else if (ssb_extif_available(&bus->extif))
 | 
				
			||||||
 | 
					+		res = ssb_extif_gpio_in(&bus->extif, mask);
 | 
				
			||||||
 | 
					+	else
 | 
				
			||||||
 | 
					+		SSB_WARN_ON(1);
 | 
				
			||||||
 | 
					+	spin_unlock_irqrestore(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	return res;
 | 
				
			||||||
 | 
					+}
 | 
				
			||||||
 | 
					+EXPORT_SYMBOL(ssb_gpio_in);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+u32 ssb_gpio_out(struct ssb_bus *bus, u32 mask, u32 value)
 | 
				
			||||||
 | 
					+{
 | 
				
			||||||
 | 
					+	unsigned long flags;
 | 
				
			||||||
 | 
					+	u32 res = 0;
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	spin_lock_irqsave(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+	if (ssb_chipco_available(&bus->chipco))
 | 
				
			||||||
 | 
					+		res = ssb_chipco_gpio_out(&bus->chipco, mask, value);
 | 
				
			||||||
 | 
					+	else if (ssb_extif_available(&bus->extif))
 | 
				
			||||||
 | 
					+		res = ssb_extif_gpio_out(&bus->extif, mask, value);
 | 
				
			||||||
 | 
					+	else
 | 
				
			||||||
 | 
					+		SSB_WARN_ON(1);
 | 
				
			||||||
 | 
					+	spin_unlock_irqrestore(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	return res;
 | 
				
			||||||
 | 
					+}
 | 
				
			||||||
 | 
					+EXPORT_SYMBOL(ssb_gpio_out);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+u32 ssb_gpio_outen(struct ssb_bus *bus, u32 mask, u32 value)
 | 
				
			||||||
 | 
					+{
 | 
				
			||||||
 | 
					+	unsigned long flags;
 | 
				
			||||||
 | 
					+	u32 res = 0;
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	spin_lock_irqsave(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+	if (ssb_chipco_available(&bus->chipco))
 | 
				
			||||||
 | 
					+		res = ssb_chipco_gpio_outen(&bus->chipco, mask, value);
 | 
				
			||||||
 | 
					+	else if (ssb_extif_available(&bus->extif))
 | 
				
			||||||
 | 
					+		res = ssb_extif_gpio_outen(&bus->extif, mask, value);
 | 
				
			||||||
 | 
					+	else
 | 
				
			||||||
 | 
					+		SSB_WARN_ON(1);
 | 
				
			||||||
 | 
					+	spin_unlock_irqrestore(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	return res;
 | 
				
			||||||
 | 
					+}
 | 
				
			||||||
 | 
					+EXPORT_SYMBOL(ssb_gpio_outen);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+u32 ssb_gpio_control(struct ssb_bus *bus, u32 mask, u32 value)
 | 
				
			||||||
 | 
					+{
 | 
				
			||||||
 | 
					+	unsigned long flags;
 | 
				
			||||||
 | 
					+	u32 res = 0;
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	spin_lock_irqsave(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+	if (ssb_chipco_available(&bus->chipco))
 | 
				
			||||||
 | 
					+		res = ssb_chipco_gpio_control(&bus->chipco, mask, value);
 | 
				
			||||||
 | 
					+	spin_unlock_irqrestore(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	return res;
 | 
				
			||||||
 | 
					+}
 | 
				
			||||||
 | 
					+EXPORT_SYMBOL(ssb_gpio_control);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+u32 ssb_gpio_intmask(struct ssb_bus *bus, u32 mask, u32 value)
 | 
				
			||||||
 | 
					+{
 | 
				
			||||||
 | 
					+	unsigned long flags;
 | 
				
			||||||
 | 
					+	u32 res = 0;
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	spin_lock_irqsave(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+	if (ssb_chipco_available(&bus->chipco))
 | 
				
			||||||
 | 
					+		res = ssb_chipco_gpio_intmask(&bus->chipco, mask, value);
 | 
				
			||||||
 | 
					+	else if (ssb_extif_available(&bus->extif))
 | 
				
			||||||
 | 
					+		res = ssb_extif_gpio_intmask(&bus->extif, mask, value);
 | 
				
			||||||
 | 
					+	else
 | 
				
			||||||
 | 
					+		SSB_WARN_ON(1);
 | 
				
			||||||
 | 
					+	spin_unlock_irqrestore(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	return res;
 | 
				
			||||||
 | 
					+}
 | 
				
			||||||
 | 
					+EXPORT_SYMBOL(ssb_gpio_intmask);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+u32 ssb_gpio_polarity(struct ssb_bus *bus, u32 mask, u32 value)
 | 
				
			||||||
 | 
					+{
 | 
				
			||||||
 | 
					+	unsigned long flags;
 | 
				
			||||||
 | 
					+	u32 res = 0;
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	spin_lock_irqsave(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+	if (ssb_chipco_available(&bus->chipco))
 | 
				
			||||||
 | 
					+		res = ssb_chipco_gpio_polarity(&bus->chipco, mask, value);
 | 
				
			||||||
 | 
					+	else if (ssb_extif_available(&bus->extif))
 | 
				
			||||||
 | 
					+		res = ssb_extif_gpio_polarity(&bus->extif, mask, value);
 | 
				
			||||||
 | 
					+	else
 | 
				
			||||||
 | 
					+		SSB_WARN_ON(1);
 | 
				
			||||||
 | 
					+	spin_unlock_irqrestore(&bus->gpio_lock, flags);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					+	return res;
 | 
				
			||||||
 | 
					+}
 | 
				
			||||||
 | 
					+EXPORT_SYMBOL(ssb_gpio_polarity);
 | 
				
			||||||
 | 
					Index: linux-2.6.23.16/include/linux/ssb/ssb.h
 | 
				
			||||||
 | 
					===================================================================
 | 
				
			||||||
 | 
					--- linux-2.6.23.16.orig/include/linux/ssb/ssb.h	2008-02-19 15:50:42.000000000 +0100
 | 
				
			||||||
 | 
					+++ linux-2.6.23.16/include/linux/ssb/ssb.h	2008-02-19 15:50:44.000000000 +0100
 | 
				
			||||||
 | 
					@@ -283,6 +283,11 @@ struct ssb_bus {
 | 
				
			||||||
 | 
					 	/* Contents of the SPROM. */
 | 
				
			||||||
 | 
					 	struct ssb_sprom sprom;
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					+#ifdef CONFIG_SSB_EMBEDDED
 | 
				
			||||||
 | 
					+	/* Lock for GPIO register access. */
 | 
				
			||||||
 | 
					+	spinlock_t gpio_lock;
 | 
				
			||||||
 | 
					+#endif /* EMBEDDED */
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					 	/* Internal-only stuff follows. Do not touch. */
 | 
				
			||||||
 | 
					 	struct list_head list;
 | 
				
			||||||
 | 
					 #ifdef CONFIG_SSB_DEBUG
 | 
				
			||||||
 | 
					Index: linux-2.6.23.16/include/linux/ssb/ssb_embedded.h
 | 
				
			||||||
 | 
					===================================================================
 | 
				
			||||||
 | 
					--- linux-2.6.23.16.orig/include/linux/ssb/ssb_embedded.h	2008-02-19 15:50:42.000000000 +0100
 | 
				
			||||||
 | 
					+++ linux-2.6.23.16/include/linux/ssb/ssb_embedded.h	2008-02-19 15:50:44.000000000 +0100
 | 
				
			||||||
 | 
					@@ -7,4 +7,12 @@
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 extern int ssb_watchdog_timer_set(struct ssb_bus *bus, u32 ticks);
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					+/* Generic GPIO API */
 | 
				
			||||||
 | 
					+u32 ssb_gpio_in(struct ssb_bus *bus, u32 mask);
 | 
				
			||||||
 | 
					+u32 ssb_gpio_out(struct ssb_bus *bus, u32 mask, u32 value);
 | 
				
			||||||
 | 
					+u32 ssb_gpio_outen(struct ssb_bus *bus, u32 mask, u32 value);
 | 
				
			||||||
 | 
					+u32 ssb_gpio_control(struct ssb_bus *bus, u32 mask, u32 value);
 | 
				
			||||||
 | 
					+u32 ssb_gpio_intmask(struct ssb_bus *bus, u32 mask, u32 value);
 | 
				
			||||||
 | 
					+u32 ssb_gpio_polarity(struct ssb_bus *bus, u32 mask, u32 value);
 | 
				
			||||||
 | 
					+
 | 
				
			||||||
 | 
					 #endif /* LINUX_SSB_EMBEDDED_H_ */
 | 
				
			||||||
 | 
					Index: linux-2.6.23.16/drivers/ssb/main.c
 | 
				
			||||||
 | 
					===================================================================
 | 
				
			||||||
 | 
					--- linux-2.6.23.16.orig/drivers/ssb/main.c	2008-02-19 15:50:42.000000000 +0100
 | 
				
			||||||
 | 
					+++ linux-2.6.23.16/drivers/ssb/main.c	2008-02-19 15:50:44.000000000 +0100
 | 
				
			||||||
 | 
					@@ -571,6 +571,9 @@ static int ssb_bus_register(struct ssb_b
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 	spin_lock_init(&bus->bar_lock);
 | 
				
			||||||
 | 
					 	INIT_LIST_HEAD(&bus->list);
 | 
				
			||||||
 | 
					+#ifdef CONFIG_SSB_EMBEDDED
 | 
				
			||||||
 | 
					+	spin_lock_init(&bus->gpio_lock);
 | 
				
			||||||
 | 
					+#endif
 | 
				
			||||||
 | 
					 
 | 
				
			||||||
 | 
					 	/* Powerup the bus */
 | 
				
			||||||
 | 
					 	err = ssb_pci_xtal(bus, SSB_GPIO_XTAL | SSB_GPIO_PLL, 1);
 | 
				
			||||||
		Reference in New Issue
	
	Block a user