Having received another series of whitespace patches I decided to do this once and for all rather than dealing with this kind of patches trickling in forever. Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
		
			
				
	
	
		
			174 lines
		
	
	
	
		
			4.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			174 lines
		
	
	
	
		
			4.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * This file is subject to the terms and conditions of the GNU General Public
 | 
						|
 * License.  See the file "COPYING" in the main directory of this archive
 | 
						|
 * for more details.
 | 
						|
 *
 | 
						|
 * Copyright (C) 2007 Aurelien Jarno <aurelien@aurel32.net>
 | 
						|
 */
 | 
						|
 | 
						|
#include <linux/platform_device.h>
 | 
						|
#include <linux/module.h>
 | 
						|
#include <linux/leds.h>
 | 
						|
#include <linux/mtd/physmap.h>
 | 
						|
#include <linux/ssb/ssb.h>
 | 
						|
#include <linux/ssb/ssb_embedded.h>
 | 
						|
#include <linux/interrupt.h>
 | 
						|
#include <linux/reboot.h>
 | 
						|
#include <linux/gpio.h>
 | 
						|
#include <asm/mach-bcm47xx/bcm47xx.h>
 | 
						|
 | 
						|
/* GPIO definitions for the WGT634U */
 | 
						|
#define WGT634U_GPIO_LED	3
 | 
						|
#define WGT634U_GPIO_RESET	2
 | 
						|
#define WGT634U_GPIO_TP1	7
 | 
						|
#define WGT634U_GPIO_TP2	6
 | 
						|
#define WGT634U_GPIO_TP3	5
 | 
						|
#define WGT634U_GPIO_TP4	4
 | 
						|
#define WGT634U_GPIO_TP5	1
 | 
						|
 | 
						|
static struct gpio_led wgt634u_leds[] = {
 | 
						|
	{
 | 
						|
		.name = "power",
 | 
						|
		.gpio = WGT634U_GPIO_LED,
 | 
						|
		.active_low = 1,
 | 
						|
		.default_trigger = "heartbeat",
 | 
						|
	},
 | 
						|
};
 | 
						|
 | 
						|
static struct gpio_led_platform_data wgt634u_led_data = {
 | 
						|
	.num_leds =	ARRAY_SIZE(wgt634u_leds),
 | 
						|
	.leds =		wgt634u_leds,
 | 
						|
};
 | 
						|
 | 
						|
static struct platform_device wgt634u_gpio_leds = {
 | 
						|
	.name =		"leds-gpio",
 | 
						|
	.id =		-1,
 | 
						|
	.dev = {
 | 
						|
		.platform_data = &wgt634u_led_data,
 | 
						|
	}
 | 
						|
};
 | 
						|
 | 
						|
 | 
						|
/* 8MiB flash. The struct mtd_partition matches original Netgear WGT634U
 | 
						|
   firmware. */
 | 
						|
static struct mtd_partition wgt634u_partitions[] = {
 | 
						|
	{
 | 
						|
		.name	    = "cfe",
 | 
						|
		.offset	    = 0,
 | 
						|
		.size	    = 0x60000,		/* 384k */
 | 
						|
		.mask_flags = MTD_WRITEABLE	/* force read-only */
 | 
						|
	},
 | 
						|
	{
 | 
						|
		.name	= "config",
 | 
						|
		.offset = 0x60000,
 | 
						|
		.size	= 0x20000		/* 128k */
 | 
						|
	},
 | 
						|
	{
 | 
						|
		.name	= "linux",
 | 
						|
		.offset = 0x80000,
 | 
						|
		.size	= 0x140000		/* 1280k */
 | 
						|
	},
 | 
						|
	{
 | 
						|
		.name	= "jffs",
 | 
						|
		.offset = 0x1c0000,
 | 
						|
		.size	= 0x620000		/* 6272k */
 | 
						|
	},
 | 
						|
	{
 | 
						|
		.name	= "nvram",
 | 
						|
		.offset = 0x7e0000,
 | 
						|
		.size	= 0x20000		/* 128k */
 | 
						|
	},
 | 
						|
};
 | 
						|
 | 
						|
static struct physmap_flash_data wgt634u_flash_data = {
 | 
						|
	.parts	  = wgt634u_partitions,
 | 
						|
	.nr_parts = ARRAY_SIZE(wgt634u_partitions)
 | 
						|
};
 | 
						|
 | 
						|
static struct resource wgt634u_flash_resource = {
 | 
						|
	.flags = IORESOURCE_MEM,
 | 
						|
};
 | 
						|
 | 
						|
static struct platform_device wgt634u_flash = {
 | 
						|
	.name	       = "physmap-flash",
 | 
						|
	.id	       = 0,
 | 
						|
	.dev	       = { .platform_data = &wgt634u_flash_data, },
 | 
						|
	.resource      = &wgt634u_flash_resource,
 | 
						|
	.num_resources = 1,
 | 
						|
};
 | 
						|
 | 
						|
/* Platform devices */
 | 
						|
static struct platform_device *wgt634u_devices[] __initdata = {
 | 
						|
	&wgt634u_flash,
 | 
						|
	&wgt634u_gpio_leds,
 | 
						|
};
 | 
						|
 | 
						|
static irqreturn_t gpio_interrupt(int irq, void *ignored)
 | 
						|
{
 | 
						|
	int state;
 | 
						|
 | 
						|
	/* Interrupts are shared, check if the current one is
 | 
						|
	   a GPIO interrupt. */
 | 
						|
	if (!ssb_chipco_irq_status(&bcm47xx_bus.ssb.chipco,
 | 
						|
				   SSB_CHIPCO_IRQ_GPIO))
 | 
						|
		return IRQ_NONE;
 | 
						|
 | 
						|
	state = gpio_get_value(WGT634U_GPIO_RESET);
 | 
						|
 | 
						|
	/* Interrupt are level triggered, revert the interrupt polarity
 | 
						|
	   to clear the interrupt. */
 | 
						|
	ssb_gpio_polarity(&bcm47xx_bus.ssb, 1 << WGT634U_GPIO_RESET,
 | 
						|
			  state ? 1 << WGT634U_GPIO_RESET : 0);
 | 
						|
 | 
						|
	if (!state) {
 | 
						|
		printk(KERN_INFO "Reset button pressed");
 | 
						|
		ctrl_alt_del();
 | 
						|
	}
 | 
						|
 | 
						|
	return IRQ_HANDLED;
 | 
						|
}
 | 
						|
 | 
						|
static int __init wgt634u_init(void)
 | 
						|
{
 | 
						|
	/* There is no easy way to detect that we are running on a WGT634U
 | 
						|
	 * machine. Use the MAC address as an heuristic. Netgear Inc. has
 | 
						|
	 * been allocated ranges 00:09:5b:xx:xx:xx and 00:0f:b5:xx:xx:xx.
 | 
						|
	 */
 | 
						|
	u8 *et0mac;
 | 
						|
 | 
						|
	if (bcm47xx_bus_type != BCM47XX_BUS_TYPE_SSB)
 | 
						|
		return -ENODEV;
 | 
						|
 | 
						|
	et0mac = bcm47xx_bus.ssb.sprom.et0mac;
 | 
						|
 | 
						|
	if (et0mac[0] == 0x00 &&
 | 
						|
	    ((et0mac[1] == 0x09 && et0mac[2] == 0x5b) ||
 | 
						|
	     (et0mac[1] == 0x0f && et0mac[2] == 0xb5))) {
 | 
						|
		struct ssb_mipscore *mcore = &bcm47xx_bus.ssb.mipscore;
 | 
						|
 | 
						|
		printk(KERN_INFO "WGT634U machine detected.\n");
 | 
						|
 | 
						|
		if (!request_irq(gpio_to_irq(WGT634U_GPIO_RESET),
 | 
						|
				 gpio_interrupt, IRQF_SHARED,
 | 
						|
				 "WGT634U GPIO", &bcm47xx_bus.ssb.chipco)) {
 | 
						|
			gpio_direction_input(WGT634U_GPIO_RESET);
 | 
						|
			ssb_gpio_intmask(&bcm47xx_bus.ssb,
 | 
						|
					 1 << WGT634U_GPIO_RESET,
 | 
						|
					 1 << WGT634U_GPIO_RESET);
 | 
						|
			ssb_chipco_irq_mask(&bcm47xx_bus.ssb.chipco,
 | 
						|
					    SSB_CHIPCO_IRQ_GPIO,
 | 
						|
					    SSB_CHIPCO_IRQ_GPIO);
 | 
						|
		}
 | 
						|
 | 
						|
		wgt634u_flash_data.width = mcore->pflash.buswidth;
 | 
						|
		wgt634u_flash_resource.start = mcore->pflash.window;
 | 
						|
		wgt634u_flash_resource.end = mcore->pflash.window
 | 
						|
					   + mcore->pflash.window_size
 | 
						|
					   - 1;
 | 
						|
		return platform_add_devices(wgt634u_devices,
 | 
						|
					    ARRAY_SIZE(wgt634u_devices));
 | 
						|
	} else
 | 
						|
		return -ENODEV;
 | 
						|
}
 | 
						|
 | 
						|
module_init(wgt634u_init);
 |