arch/m68knommu/platform/528x/config.c - kernel/msm-4.9 - Gitiles

 /***************************************************************************/

 /*
  *	linux/arch/m68knommu/platform/528x/config.c
  *
  *	Sub-architcture dependant initialization code for the Motorola
  *	5280 and 5282 CPUs.
  *
  *	Copyright (C) 1999-2003, Greg Ungerer (gerg@snapgear.com)
  *	Copyright (C) 2001-2003, SnapGear Inc. (www.snapgear.com)
  */

 /***************************************************************************/

 #include <linux/kernel.h>
 #include <linux/param.h>
 #include <linux/init.h>
 #include <linux/interrupt.h>
 #include <linux/platform_device.h>
 #include <linux/spi/spi.h>
 #include <linux/spi/flash.h>
 #include <linux/io.h>
 #include <asm/machdep.h>
 #include <asm/coldfire.h>
 #include <asm/mcfsim.h>
 #include <asm/mcfuart.h>
 #include <asm/mcfqspi.h>

 #ifdef CONFIG_MTD_PARTITIONS
 #include <linux/mtd/partitions.h>
 #endif

 /***************************************************************************/

 void coldfire_reset(void);
 static void coldfire_qspi_cs_control(u8 cs, u8 command);

 /***************************************************************************/

 #if defined(CONFIG_SPI)

 #if defined(CONFIG_WILDFIRE)
 #define SPI_NUM_CHIPSELECTS 	0x02
 #define SPI_PAR_VAL		0x07  /* Enable DIN, DOUT, CLK */
 #define SPI_CS_MASK		0x18

 #define FLASH_BLOCKSIZE		(1024*64)
 #define FLASH_NUMBLOCKS		16
 #define FLASH_TYPE		"m25p80"

 #define M25P80_CS		0
 #define MMC_CS			1

 #ifdef CONFIG_MTD_PARTITIONS
 static struct mtd_partition stm25p_partitions[] = {
 	/* sflash */
 	[0] = {
 		.name = "stm25p80",
 		.offset = 0x00000000,
 		.size = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS,
 		.mask_flags = 0
 	}
 };

 #endif

 #elif defined(CONFIG_WILDFIREMOD)

 #define SPI_NUM_CHIPSELECTS	0x08
 #define SPI_PAR_VAL		0x07  /* Enable DIN, DOUT, CLK */
 #define SPI_CS_MASK		0x78

 #define FLASH_BLOCKSIZE		(1024*64)
 #define FLASH_NUMBLOCKS		64
 #define FLASH_TYPE		"m25p32"
 /* Reserve 1M for the kernel parition */
 #define FLASH_KERNEL_SIZE   (1024 * 1024)

 #define M25P80_CS		5
 #define MMC_CS			6

 #ifdef CONFIG_MTD_PARTITIONS
 static struct mtd_partition stm25p_partitions[] = {
 	/* sflash */
 	[0] = {
 		.name = "kernel",
 		.offset = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS - FLASH_KERNEL_SIZE,
 		.size = FLASH_KERNEL_SIZE,
 		.mask_flags = 0
 	},
 	[1] = {
 		.name = "image",
 		.offset = 0x00000000,
 		.size = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS - FLASH_KERNEL_SIZE,
 		.mask_flags = 0
 	},
 	[2] = {
 		.name = "all",
 		.offset = 0x00000000,
 		.size = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS,
 		.mask_flags = 0
 	}
 };
 #endif

 #else
 #define SPI_NUM_CHIPSELECTS 	0x04
 #define SPI_PAR_VAL		0x7F  /* Enable DIN, DOUT, CLK, CS0 - CS4 */
 #endif

 #ifdef MMC_CS
 static struct coldfire_spi_chip flash_chip_info = {
 	.mode = SPI_MODE_0,
 	.bits_per_word = 16,
 	.del_cs_to_clk = 17,
 	.del_after_trans = 1,
 	.void_write_data = 0
 };

 static struct coldfire_spi_chip mmc_chip_info = {
 	.mode = SPI_MODE_0,
 	.bits_per_word = 16,
 	.del_cs_to_clk = 17,
 	.del_after_trans = 1,
 	.void_write_data = 0xFFFF
 };
 #endif

 #ifdef M25P80_CS
 static struct flash_platform_data stm25p80_platform_data = {
 	.name = "ST M25P80 SPI Flash chip",
 #ifdef CONFIG_MTD_PARTITIONS
 	.parts = stm25p_partitions,
 	.nr_parts = sizeof(stm25p_partitions) / sizeof(*stm25p_partitions),
 #endif
 	.type = FLASH_TYPE
 };
 #endif

 static struct spi_board_info spi_board_info[] __initdata = {
 #ifdef M25P80_CS
 	{
 		.modalias = "m25p80",
 		.max_speed_hz = 16000000,
 		.bus_num = 1,
 		.chip_select = M25P80_CS,
 		.platform_data = &stm25p80_platform_data,
 		.controller_data = &flash_chip_info
 	},
 #endif
 #ifdef MMC_CS
 	{
 		.modalias = "mmc_spi",
 		.max_speed_hz = 16000000,
 		.bus_num = 1,
 		.chip_select = MMC_CS,
 		.controller_data = &mmc_chip_info
 	}
 #endif
 };

 static struct coldfire_spi_master coldfire_master_info = {
 	.bus_num = 1,
 	.num_chipselect = SPI_NUM_CHIPSELECTS,
 	.irq_source = MCF5282_QSPI_IRQ_SOURCE,
 	.irq_vector = MCF5282_QSPI_IRQ_VECTOR,
 	.irq_mask = ((0x01 << MCF5282_QSPI_IRQ_SOURCE) | 0x01),
 	.irq_lp = 0x2B,  /* Level 5 and Priority 3 */
 	.par_val = SPI_PAR_VAL,
 	.cs_control = coldfire_qspi_cs_control,
 };

 static struct resource coldfire_spi_resources[] = {
 	[0] = {
 		.name = "qspi-par",
 		.start = MCF5282_QSPI_PAR,
 		.end = MCF5282_QSPI_PAR,
 		.flags = IORESOURCE_MEM
 	},

 	[1] = {
 		.name = "qspi-module",
 		.start = MCF5282_QSPI_QMR,
 		.end = MCF5282_QSPI_QMR + 0x18,
 		.flags = IORESOURCE_MEM
 	},

 	[2] = {
 		.name = "qspi-int-level",
 		.start = MCF5282_INTC0 + MCFINTC_ICR0 + MCF5282_QSPI_IRQ_SOURCE,
 		.end = MCF5282_INTC0 + MCFINTC_ICR0 + MCF5282_QSPI_IRQ_SOURCE,
 		.flags = IORESOURCE_MEM
 	},

 	[3] = {
 		.name = "qspi-int-mask",
 		.start = MCF5282_INTC0 + MCFINTC_IMRL,
 		.end = MCF5282_INTC0 + MCFINTC_IMRL,
 		.flags = IORESOURCE_MEM
 	}
 };

 static struct platform_device coldfire_spi = {
 	.name = "spi_coldfire",
 	.id = -1,
 	.resource = coldfire_spi_resources,
 	.num_resources = ARRAY_SIZE(coldfire_spi_resources),
 	.dev = {
 		.platform_data = &coldfire_master_info,
 	}
 };

 static void coldfire_qspi_cs_control(u8 cs, u8 command)
 {
 	u8 cs_bit = ((0x01 << cs) << 3) & SPI_CS_MASK;

 #if defined(CONFIG_WILDFIRE)
 	u8 cs_mask = ~(((0x01 << cs) << 3) & SPI_CS_MASK);
 #endif
 #if defined(CONFIG_WILDFIREMOD)
 	u8 cs_mask = (cs << 3) & SPI_CS_MASK;
 #endif

 	/*
 	 * Don't do anything if the chip select is not
 	 * one of the port qs pins.
 	 */
 	if (command & QSPI_CS_INIT) {
 #if defined(CONFIG_WILDFIRE)
 		MCF5282_GPIO_DDRQS  |= cs_bit;
 		MCF5282_GPIO_PQSPAR &= ~cs_bit;
 #endif

 #if defined(CONFIG_WILDFIREMOD)
 		MCF5282_GPIO_DDRQS  |= SPI_CS_MASK;
 		MCF5282_GPIO_PQSPAR &= ~SPI_CS_MASK;
 #endif
 	}

 	if (command & QSPI_CS_ASSERT) {
 		MCF5282_GPIO_PORTQS &= ~SPI_CS_MASK;
 		MCF5282_GPIO_PORTQS |= cs_mask;
 	} else if (command & QSPI_CS_DROP) {
 		MCF5282_GPIO_PORTQS |= SPI_CS_MASK;
 	}
 }

 static int __init spi_dev_init(void)
 {
 	int retval;

 	retval = platform_device_register(&coldfire_spi);
 	if (retval < 0)
 		return retval;

 	if (ARRAY_SIZE(spi_board_info))
 		retval = spi_register_board_info(spi_board_info, ARRAY_SIZE(spi_board_info));

 	return retval;
 }

 #endif /* CONFIG_SPI */

 /***************************************************************************/

 static struct mcf_platform_uart m528x_uart_platform[] = {
 	{
 		.mapbase	= MCF_MBAR + MCFUART_BASE1,
 		.irq		= MCFINT_VECBASE + MCFINT_UART0,
 	},
 	{
 		.mapbase 	= MCF_MBAR + MCFUART_BASE2,
 		.irq		= MCFINT_VECBASE + MCFINT_UART0 + 1,
 	},
 	{
 		.mapbase 	= MCF_MBAR + MCFUART_BASE3,
 		.irq		= MCFINT_VECBASE + MCFINT_UART0 + 2,
 	},
 	{ },
 };

 static struct platform_device m528x_uart = {
 	.name			= "mcfuart",
 	.id			= 0,
 	.dev.platform_data	= m528x_uart_platform,
 };

 static struct platform_device *m528x_devices[] __initdata = {
 	&m528x_uart,
 };

 /***************************************************************************/

 #define	INTC0	(MCF_MBAR + MCFICM_INTC0)

 static void __init m528x_uart_init_line(int line, int irq)
 {
 	u8 port;
 	u32 imr;

 	if ((line < 0) || (line > 2))
 		return;

 	/* level 6, line based priority */
 	writeb(0x30+line, INTC0 + MCFINTC_ICR0 + MCFINT_UART0 + line);

 	imr = readl(INTC0 + MCFINTC_IMRL);
 	imr &= ~((1 << (irq - MCFINT_VECBASE)) | 1);
 	writel(imr, INTC0 + MCFINTC_IMRL);

 	/* make sure PUAPAR is set for UART0 and UART1 */
 	if (line < 2) {
 		port = readb(MCF_MBAR + MCF5282_GPIO_PUAPAR);
 		port |= (0x03 << (line * 2));
 		writeb(port, MCF_MBAR + MCF5282_GPIO_PUAPAR);
 	}
 }

 static void __init m528x_uarts_init(void)
 {
 	const int nrlines = ARRAY_SIZE(m528x_uart_platform);
 	int line;

 	for (line = 0; (line < nrlines); line++)
 		m528x_uart_init_line(line, m528x_uart_platform[line].irq);
 }

 /***************************************************************************/

 void mcf_disableall(void)
 {
 	*((volatile unsigned long *) (MCF_IPSBAR + MCFICM_INTC0 + MCFINTC_IMRH)) = 0xffffffff;
 	*((volatile unsigned long *) (MCF_IPSBAR + MCFICM_INTC0 + MCFINTC_IMRL)) = 0xffffffff;
 }

 /***************************************************************************/

 void mcf_autovector(unsigned int vec)
 {
 	/* Everything is auto-vectored on the 5272 */
 }

 /***************************************************************************/

 #ifdef CONFIG_WILDFIRE
 void wildfire_halt(void)
 {
 	writeb(0, 0x30000007);
 	writeb(0x2, 0x30000007);
 }
 #endif

 #ifdef CONFIG_WILDFIREMOD
 void wildfiremod_halt(void)
 {
 	printk(KERN_INFO "WildFireMod hibernating...\n");

 	/* Set portE.5 to Digital IO */
 	MCF5282_GPIO_PEPAR &= ~(1 << (5 * 2));

 	/* Make portE.5 an output */
 	MCF5282_GPIO_DDRE |= (1 << 5);

 	/* Now toggle portE.5 from low to high */
 	MCF5282_GPIO_PORTE &= ~(1 << 5);
 	MCF5282_GPIO_PORTE |= (1 << 5);

 	printk(KERN_EMERG "Failed to hibernate. Halting!\n");
 }
 #endif

 void __init config_BSP(char *commandp, int size)
 {
 	mcf_disableall();

 #ifdef CONFIG_WILDFIRE
 	mach_halt = wildfire_halt;
 #endif
 #ifdef CONFIG_WILDFIREMOD
 	mach_halt = wildfiremod_halt;
 #endif
 }

 /***************************************************************************/

 static int __init init_BSP(void)
 {
 	m528x_uarts_init();
 	platform_add_devices(m528x_devices, ARRAY_SIZE(m528x_devices));
 	return 0;
 }

 arch_initcall(init_BSP);

 /***************************************************************************/
	/***************************************************************************/

	/*
	* linux/arch/m68knommu/platform/528x/config.c
	*
	* Sub-architcture dependant initialization code for the Motorola
	* 5280 and 5282 CPUs.
	*
	* Copyright (C) 1999-2003, Greg Ungerer (gerg@snapgear.com)
	* Copyright (C) 2001-2003, SnapGear Inc. (www.snapgear.com)
	*/

	/***************************************************************************/

	#include <linux/kernel.h>
	#include <linux/param.h>
	#include <linux/init.h>
	#include <linux/interrupt.h>
	#include <linux/platform_device.h>
	#include <linux/spi/spi.h>
	#include <linux/spi/flash.h>
	#include <linux/io.h>
	#include <asm/machdep.h>
	#include <asm/coldfire.h>
	#include <asm/mcfsim.h>
	#include <asm/mcfuart.h>
	#include <asm/mcfqspi.h>

	#ifdef CONFIG_MTD_PARTITIONS
	#include <linux/mtd/partitions.h>
	#endif

	/***************************************************************************/

	void coldfire_reset(void);
	static void coldfire_qspi_cs_control(u8 cs, u8 command);

	/***************************************************************************/

	#if defined(CONFIG_SPI)

	#if defined(CONFIG_WILDFIRE)
	#define SPI_NUM_CHIPSELECTS 0x02
	#define SPI_PAR_VAL 0x07 /* Enable DIN, DOUT, CLK */
	#define SPI_CS_MASK 0x18

	#define FLASH_BLOCKSIZE (1024*64)
	#define FLASH_NUMBLOCKS 16
	#define FLASH_TYPE "m25p80"

	#define M25P80_CS 0
	#define MMC_CS 1

	#ifdef CONFIG_MTD_PARTITIONS
	static struct mtd_partition stm25p_partitions[] = {
	/* sflash */
	[0] = {
	.name = "stm25p80",
	.offset = 0x00000000,
	.size = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS,
	.mask_flags = 0
	}
	};

	#endif

	#elif defined(CONFIG_WILDFIREMOD)

	#define SPI_NUM_CHIPSELECTS 0x08
	#define SPI_PAR_VAL 0x07 /* Enable DIN, DOUT, CLK */
	#define SPI_CS_MASK 0x78

	#define FLASH_BLOCKSIZE (1024*64)
	#define FLASH_NUMBLOCKS 64
	#define FLASH_TYPE "m25p32"
	/* Reserve 1M for the kernel parition */
	#define FLASH_KERNEL_SIZE (1024 * 1024)

	#define M25P80_CS 5
	#define MMC_CS 6

	#ifdef CONFIG_MTD_PARTITIONS
	static struct mtd_partition stm25p_partitions[] = {
	/* sflash */
	[0] = {
	.name = "kernel",
	.offset = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS - FLASH_KERNEL_SIZE,
	.size = FLASH_KERNEL_SIZE,
	.mask_flags = 0
	},
	[1] = {
	.name = "image",
	.offset = 0x00000000,
	.size = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS - FLASH_KERNEL_SIZE,
	.mask_flags = 0
	},
	[2] = {
	.name = "all",
	.offset = 0x00000000,
	.size = FLASH_BLOCKSIZE * FLASH_NUMBLOCKS,
	.mask_flags = 0
	}
	};
	#endif

	#else
	#define SPI_NUM_CHIPSELECTS 0x04
	#define SPI_PAR_VAL 0x7F /* Enable DIN, DOUT, CLK, CS0 - CS4 */
	#endif

	#ifdef MMC_CS
	static struct coldfire_spi_chip flash_chip_info = {
	.mode = SPI_MODE_0,
	.bits_per_word = 16,
	.del_cs_to_clk = 17,
	.del_after_trans = 1,
	.void_write_data = 0
	};

	static struct coldfire_spi_chip mmc_chip_info = {
	.mode = SPI_MODE_0,
	.bits_per_word = 16,
	.del_cs_to_clk = 17,
	.del_after_trans = 1,
	.void_write_data = 0xFFFF
	};
	#endif

	#ifdef M25P80_CS
	static struct flash_platform_data stm25p80_platform_data = {
	.name = "ST M25P80 SPI Flash chip",
	#ifdef CONFIG_MTD_PARTITIONS
	.parts = stm25p_partitions,
	.nr_parts = sizeof(stm25p_partitions) / sizeof(*stm25p_partitions),
	#endif
	.type = FLASH_TYPE
	};
	#endif

	static struct spi_board_info spi_board_info[] __initdata = {
	#ifdef M25P80_CS
	{
	.modalias = "m25p80",
	.max_speed_hz = 16000000,
	.bus_num = 1,
	.chip_select = M25P80_CS,
	.platform_data = &stm25p80_platform_data,
	.controller_data = &flash_chip_info
	},
	#endif
	#ifdef MMC_CS
	{
	.modalias = "mmc_spi",
	.max_speed_hz = 16000000,
	.bus_num = 1,
	.chip_select = MMC_CS,
	.controller_data = &mmc_chip_info
	}
	#endif
	};

	static struct coldfire_spi_master coldfire_master_info = {
	.bus_num = 1,
	.num_chipselect = SPI_NUM_CHIPSELECTS,
	.irq_source = MCF5282_QSPI_IRQ_SOURCE,
	.irq_vector = MCF5282_QSPI_IRQ_VECTOR,
	.irq_mask = ((0x01 << MCF5282_QSPI_IRQ_SOURCE) \| 0x01),
	.irq_lp = 0x2B, /* Level 5 and Priority 3 */
	.par_val = SPI_PAR_VAL,
	.cs_control = coldfire_qspi_cs_control,
	};

	static struct resource coldfire_spi_resources[] = {
	[0] = {
	.name = "qspi-par",
	.start = MCF5282_QSPI_PAR,
	.end = MCF5282_QSPI_PAR,
	.flags = IORESOURCE_MEM
	},

	[1] = {
	.name = "qspi-module",
	.start = MCF5282_QSPI_QMR,
	.end = MCF5282_QSPI_QMR + 0x18,
	.flags = IORESOURCE_MEM
	},

	[2] = {
	.name = "qspi-int-level",
	.start = MCF5282_INTC0 + MCFINTC_ICR0 + MCF5282_QSPI_IRQ_SOURCE,
	.end = MCF5282_INTC0 + MCFINTC_ICR0 + MCF5282_QSPI_IRQ_SOURCE,
	.flags = IORESOURCE_MEM
	},

	[3] = {
	.name = "qspi-int-mask",
	.start = MCF5282_INTC0 + MCFINTC_IMRL,
	.end = MCF5282_INTC0 + MCFINTC_IMRL,
	.flags = IORESOURCE_MEM
	}
	};

	static struct platform_device coldfire_spi = {
	.name = "spi_coldfire",
	.id = -1,
	.resource = coldfire_spi_resources,
	.num_resources = ARRAY_SIZE(coldfire_spi_resources),
	.dev = {
	.platform_data = &coldfire_master_info,
	}
	};

	static void coldfire_qspi_cs_control(u8 cs, u8 command)
	{
	u8 cs_bit = ((0x01 << cs) << 3) & SPI_CS_MASK;

	#if defined(CONFIG_WILDFIRE)
	u8 cs_mask = ~(((0x01 << cs) << 3) & SPI_CS_MASK);
	#endif
	#if defined(CONFIG_WILDFIREMOD)
	u8 cs_mask = (cs << 3) & SPI_CS_MASK;
	#endif

	/*
	* Don't do anything if the chip select is not
	* one of the port qs pins.
	*/
	if (command & QSPI_CS_INIT) {
	#if defined(CONFIG_WILDFIRE)
	MCF5282_GPIO_DDRQS \|= cs_bit;
	MCF5282_GPIO_PQSPAR &= ~cs_bit;
	#endif

	#if defined(CONFIG_WILDFIREMOD)
	MCF5282_GPIO_DDRQS \|= SPI_CS_MASK;
	MCF5282_GPIO_PQSPAR &= ~SPI_CS_MASK;
	#endif
	}

	if (command & QSPI_CS_ASSERT) {
	MCF5282_GPIO_PORTQS &= ~SPI_CS_MASK;
	MCF5282_GPIO_PORTQS \|= cs_mask;
	} else if (command & QSPI_CS_DROP) {
	MCF5282_GPIO_PORTQS \|= SPI_CS_MASK;
	}
	}

	static int __init spi_dev_init(void)
	{
	int retval;

	retval = platform_device_register(&coldfire_spi);
	if (retval < 0)
	return retval;

	if (ARRAY_SIZE(spi_board_info))
	retval = spi_register_board_info(spi_board_info, ARRAY_SIZE(spi_board_info));

	return retval;
	}

	#endif /* CONFIG_SPI */

	/***************************************************************************/

	static struct mcf_platform_uart m528x_uart_platform[] = {
	{
	.mapbase = MCF_MBAR + MCFUART_BASE1,
	.irq = MCFINT_VECBASE + MCFINT_UART0,
	},
	{
	.mapbase = MCF_MBAR + MCFUART_BASE2,
	.irq = MCFINT_VECBASE + MCFINT_UART0 + 1,
	},
	{
	.mapbase = MCF_MBAR + MCFUART_BASE3,
	.irq = MCFINT_VECBASE + MCFINT_UART0 + 2,
	},
	{ },
	};

	static struct platform_device m528x_uart = {
	.name = "mcfuart",
	.id = 0,
	.dev.platform_data = m528x_uart_platform,
	};

	static struct platform_device *m528x_devices[] __initdata = {
	&m528x_uart,
	};

	/***************************************************************************/

	#define INTC0 (MCF_MBAR + MCFICM_INTC0)

	static void __init m528x_uart_init_line(int line, int irq)
	{
	u8 port;
	u32 imr;

	if ((line < 0) \|\| (line > 2))
	return;

	/* level 6, line based priority */
	writeb(0x30+line, INTC0 + MCFINTC_ICR0 + MCFINT_UART0 + line);

	imr = readl(INTC0 + MCFINTC_IMRL);
	imr &= ~((1 << (irq - MCFINT_VECBASE)) \| 1);
	writel(imr, INTC0 + MCFINTC_IMRL);

	/* make sure PUAPAR is set for UART0 and UART1 */
	if (line < 2) {
	port = readb(MCF_MBAR + MCF5282_GPIO_PUAPAR);
	port \|= (0x03 << (line * 2));
	writeb(port, MCF_MBAR + MCF5282_GPIO_PUAPAR);
	}
	}

	static void __init m528x_uarts_init(void)
	{
	const int nrlines = ARRAY_SIZE(m528x_uart_platform);
	int line;

	for (line = 0; (line < nrlines); line++)
	m528x_uart_init_line(line, m528x_uart_platform[line].irq);
	}

	/***************************************************************************/

	void mcf_disableall(void)
	{
	((volatile unsigned long ) (MCF_IPSBAR + MCFICM_INTC0 + MCFINTC_IMRH)) = 0xffffffff;
	((volatile unsigned long ) (MCF_IPSBAR + MCFICM_INTC0 + MCFINTC_IMRL)) = 0xffffffff;
	}

	/***************************************************************************/

	void mcf_autovector(unsigned int vec)
	{
	/* Everything is auto-vectored on the 5272 */
	}

	/***************************************************************************/

	#ifdef CONFIG_WILDFIRE
	void wildfire_halt(void)
	{
	writeb(0, 0x30000007);
	writeb(0x2, 0x30000007);
	}
	#endif

	#ifdef CONFIG_WILDFIREMOD
	void wildfiremod_halt(void)
	{
	printk(KERN_INFO "WildFireMod hibernating...\n");

	/* Set portE.5 to Digital IO */
	MCF5282_GPIO_PEPAR &= ~(1 << (5 * 2));

	/* Make portE.5 an output */
	MCF5282_GPIO_DDRE \|= (1 << 5);

	/* Now toggle portE.5 from low to high */
	MCF5282_GPIO_PORTE &= ~(1 << 5);
	MCF5282_GPIO_PORTE \|= (1 << 5);

	printk(KERN_EMERG "Failed to hibernate. Halting!\n");
	}
	#endif

	void __init config_BSP(char *commandp, int size)
	{
	mcf_disableall();

	#ifdef CONFIG_WILDFIRE
	mach_halt = wildfire_halt;
	#endif
	#ifdef CONFIG_WILDFIREMOD
	mach_halt = wildfiremod_halt;
	#endif
	}

	/***************************************************************************/

	static int __init init_BSP(void)
	{
	m528x_uarts_init();
	platform_add_devices(m528x_devices, ARRAY_SIZE(m528x_devices));
	return 0;
	}

	arch_initcall(init_BSP);

	/***************************************************************************/