| /* | 
 |  *  linux/arch/arm/mach-pxa/generic.c | 
 |  * | 
 |  *  Author:	Nicolas Pitre | 
 |  *  Created:	Jun 15, 2001 | 
 |  *  Copyright:	MontaVista Software Inc. | 
 |  * | 
 |  * Code common to all PXA machines. | 
 |  * | 
 |  * This program is free software; you can redistribute it and/or modify | 
 |  * it under the terms of the GNU General Public License version 2 as | 
 |  * published by the Free Software Foundation. | 
 |  * | 
 |  * Since this file should be linked before any other machine specific file, | 
 |  * the __initcall() here will be executed first.  This serves as default | 
 |  * initialization stuff for PXA machines which can be overridden later if | 
 |  * need be. | 
 |  */ | 
 | #include <linux/module.h> | 
 | #include <linux/kernel.h> | 
 | #include <linux/init.h> | 
 | #include <linux/delay.h> | 
 | #include <linux/platform_device.h> | 
 | #include <linux/ioport.h> | 
 | #include <linux/pm.h> | 
 | #include <linux/string.h> | 
 |  | 
 | #include <asm/hardware.h> | 
 | #include <asm/irq.h> | 
 | #include <asm/system.h> | 
 | #include <asm/pgtable.h> | 
 | #include <asm/mach/map.h> | 
 |  | 
 | #include <asm/arch/pxa-regs.h> | 
 | #include <asm/arch/udc.h> | 
 | #include <asm/arch/pxafb.h> | 
 | #include <asm/arch/mmc.h> | 
 | #include <asm/arch/irda.h> | 
 | #include <asm/arch/i2c.h> | 
 |  | 
 | #include "generic.h" | 
 |  | 
 | /* | 
 |  * Handy function to set GPIO alternate functions | 
 |  */ | 
 |  | 
 | void pxa_gpio_mode(int gpio_mode) | 
 | { | 
 | 	unsigned long flags; | 
 | 	int gpio = gpio_mode & GPIO_MD_MASK_NR; | 
 | 	int fn = (gpio_mode & GPIO_MD_MASK_FN) >> 8; | 
 | 	int gafr; | 
 |  | 
 | 	local_irq_save(flags); | 
 | 	if (gpio_mode & GPIO_DFLT_LOW) | 
 | 		GPCR(gpio) = GPIO_bit(gpio); | 
 | 	else if (gpio_mode & GPIO_DFLT_HIGH) | 
 | 		GPSR(gpio) = GPIO_bit(gpio); | 
 | 	if (gpio_mode & GPIO_MD_MASK_DIR) | 
 | 		GPDR(gpio) |= GPIO_bit(gpio); | 
 | 	else | 
 | 		GPDR(gpio) &= ~GPIO_bit(gpio); | 
 | 	gafr = GAFR(gpio) & ~(0x3 << (((gpio) & 0xf)*2)); | 
 | 	GAFR(gpio) = gafr |  (fn  << (((gpio) & 0xf)*2)); | 
 | 	local_irq_restore(flags); | 
 | } | 
 |  | 
 | EXPORT_SYMBOL(pxa_gpio_mode); | 
 |  | 
 | /* | 
 |  * Routine to safely enable or disable a clock in the CKEN | 
 |  */ | 
 | void pxa_set_cken(int clock, int enable) | 
 | { | 
 | 	unsigned long flags; | 
 | 	local_irq_save(flags); | 
 |  | 
 | 	if (enable) | 
 | 		CKEN |= clock; | 
 | 	else | 
 | 		CKEN &= ~clock; | 
 |  | 
 | 	local_irq_restore(flags); | 
 | } | 
 |  | 
 | EXPORT_SYMBOL(pxa_set_cken); | 
 |  | 
 | /* | 
 |  * Intel PXA2xx internal register mapping. | 
 |  * | 
 |  * Note 1: not all PXA2xx variants implement all those addresses. | 
 |  * | 
 |  * Note 2: virtual 0xfffe0000-0xffffffff is reserved for the vector table | 
 |  *         and cache flush area. | 
 |  */ | 
 | static struct map_desc standard_io_desc[] __initdata = { | 
 |   	{	/* Devs */ | 
 | 		.virtual	=  0xf2000000, | 
 | 		.pfn		= __phys_to_pfn(0x40000000), | 
 | 		.length		= 0x02000000, | 
 | 		.type		= MT_DEVICE | 
 | 	}, {	/* LCD */ | 
 | 		.virtual	=  0xf4000000, | 
 | 		.pfn		= __phys_to_pfn(0x44000000), | 
 | 		.length		= 0x00100000, | 
 | 		.type		= MT_DEVICE | 
 | 	}, {	/* Mem Ctl */ | 
 | 		.virtual	=  0xf6000000, | 
 | 		.pfn		= __phys_to_pfn(0x48000000), | 
 | 		.length		= 0x00100000, | 
 | 		.type		= MT_DEVICE | 
 | 	}, {	/* USB host */ | 
 | 		.virtual	=  0xf8000000, | 
 | 		.pfn		= __phys_to_pfn(0x4c000000), | 
 | 		.length		= 0x00100000, | 
 | 		.type		= MT_DEVICE | 
 | 	}, {	/* Camera */ | 
 | 		.virtual	=  0xfa000000, | 
 | 		.pfn		= __phys_to_pfn(0x50000000), | 
 | 		.length		= 0x00100000, | 
 | 		.type		= MT_DEVICE | 
 | 	}, {	/* IMem ctl */ | 
 | 		.virtual	=  0xfe000000, | 
 | 		.pfn		= __phys_to_pfn(0x58000000), | 
 | 		.length		= 0x00100000, | 
 | 		.type		= MT_DEVICE | 
 | 	}, {	/* UNCACHED_PHYS_0 */ | 
 | 		.virtual	= 0xff000000, | 
 | 		.pfn		= __phys_to_pfn(0x00000000), | 
 | 		.length		= 0x00100000, | 
 | 		.type		= MT_DEVICE | 
 | 	} | 
 | }; | 
 |  | 
 | void __init pxa_map_io(void) | 
 | { | 
 | 	iotable_init(standard_io_desc, ARRAY_SIZE(standard_io_desc)); | 
 | 	get_clk_frequency_khz(1); | 
 | } | 
 |  | 
 |  | 
 | static struct resource pxamci_resources[] = { | 
 | 	[0] = { | 
 | 		.start	= 0x41100000, | 
 | 		.end	= 0x41100fff, | 
 | 		.flags	= IORESOURCE_MEM, | 
 | 	}, | 
 | 	[1] = { | 
 | 		.start	= IRQ_MMC, | 
 | 		.end	= IRQ_MMC, | 
 | 		.flags	= IORESOURCE_IRQ, | 
 | 	}, | 
 | }; | 
 |  | 
 | static u64 pxamci_dmamask = 0xffffffffUL; | 
 |  | 
 | static struct platform_device pxamci_device = { | 
 | 	.name		= "pxa2xx-mci", | 
 | 	.id		= -1, | 
 | 	.dev		= { | 
 | 		.dma_mask = &pxamci_dmamask, | 
 | 		.coherent_dma_mask = 0xffffffff, | 
 | 	}, | 
 | 	.num_resources	= ARRAY_SIZE(pxamci_resources), | 
 | 	.resource	= pxamci_resources, | 
 | }; | 
 |  | 
 | void __init pxa_set_mci_info(struct pxamci_platform_data *info) | 
 | { | 
 | 	pxamci_device.dev.platform_data = info; | 
 | } | 
 |  | 
 |  | 
 | static struct pxa2xx_udc_mach_info pxa_udc_info; | 
 |  | 
 | void __init pxa_set_udc_info(struct pxa2xx_udc_mach_info *info) | 
 | { | 
 | 	memcpy(&pxa_udc_info, info, sizeof *info); | 
 | } | 
 |  | 
 | static struct resource pxa2xx_udc_resources[] = { | 
 | 	[0] = { | 
 | 		.start	= 0x40600000, | 
 | 		.end	= 0x4060ffff, | 
 | 		.flags	= IORESOURCE_MEM, | 
 | 	}, | 
 | 	[1] = { | 
 | 		.start	= IRQ_USB, | 
 | 		.end	= IRQ_USB, | 
 | 		.flags	= IORESOURCE_IRQ, | 
 | 	}, | 
 | }; | 
 |  | 
 | static u64 udc_dma_mask = ~(u32)0; | 
 |  | 
 | static struct platform_device udc_device = { | 
 | 	.name		= "pxa2xx-udc", | 
 | 	.id		= -1, | 
 | 	.resource	= pxa2xx_udc_resources, | 
 | 	.num_resources	= ARRAY_SIZE(pxa2xx_udc_resources), | 
 | 	.dev		=  { | 
 | 		.platform_data	= &pxa_udc_info, | 
 | 		.dma_mask	= &udc_dma_mask, | 
 | 	} | 
 | }; | 
 |  | 
 | static struct pxafb_mach_info pxa_fb_info; | 
 |  | 
 | void __init set_pxa_fb_info(struct pxafb_mach_info *hard_pxa_fb_info) | 
 | { | 
 | 	memcpy(&pxa_fb_info,hard_pxa_fb_info,sizeof(struct pxafb_mach_info)); | 
 | } | 
 |  | 
 | static struct resource pxafb_resources[] = { | 
 | 	[0] = { | 
 | 		.start	= 0x44000000, | 
 | 		.end	= 0x4400ffff, | 
 | 		.flags	= IORESOURCE_MEM, | 
 | 	}, | 
 | 	[1] = { | 
 | 		.start	= IRQ_LCD, | 
 | 		.end	= IRQ_LCD, | 
 | 		.flags	= IORESOURCE_IRQ, | 
 | 	}, | 
 | }; | 
 |  | 
 | static u64 fb_dma_mask = ~(u64)0; | 
 |  | 
 | static struct platform_device pxafb_device = { | 
 | 	.name		= "pxa2xx-fb", | 
 | 	.id		= -1, | 
 | 	.dev		= { | 
 |  		.platform_data	= &pxa_fb_info, | 
 | 		.dma_mask	= &fb_dma_mask, | 
 | 		.coherent_dma_mask = 0xffffffff, | 
 | 	}, | 
 | 	.num_resources	= ARRAY_SIZE(pxafb_resources), | 
 | 	.resource	= pxafb_resources, | 
 | }; | 
 |  | 
 | void __init set_pxa_fb_parent(struct device *parent_dev) | 
 | { | 
 | 	pxafb_device.dev.parent = parent_dev; | 
 | } | 
 |  | 
 | static struct platform_device ffuart_device = { | 
 | 	.name		= "pxa2xx-uart", | 
 | 	.id		= 0, | 
 | }; | 
 | static struct platform_device btuart_device = { | 
 | 	.name		= "pxa2xx-uart", | 
 | 	.id		= 1, | 
 | }; | 
 | static struct platform_device stuart_device = { | 
 | 	.name		= "pxa2xx-uart", | 
 | 	.id		= 2, | 
 | }; | 
 | static struct platform_device hwuart_device = { | 
 | 	.name		= "pxa2xx-uart", | 
 | 	.id		= 3, | 
 | }; | 
 |  | 
 | static struct resource i2c_resources[] = { | 
 | 	{ | 
 | 		.start	= 0x40301680, | 
 | 		.end	= 0x403016a3, | 
 | 		.flags	= IORESOURCE_MEM, | 
 | 	}, { | 
 | 		.start	= IRQ_I2C, | 
 | 		.end	= IRQ_I2C, | 
 | 		.flags	= IORESOURCE_IRQ, | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct platform_device i2c_device = { | 
 | 	.name		= "pxa2xx-i2c", | 
 | 	.id		= 0, | 
 | 	.resource	= i2c_resources, | 
 | 	.num_resources	= ARRAY_SIZE(i2c_resources), | 
 | }; | 
 |  | 
 | void __init pxa_set_i2c_info(struct i2c_pxa_platform_data *info) | 
 | { | 
 | 	i2c_device.dev.platform_data = info; | 
 | } | 
 |  | 
 | static struct resource i2s_resources[] = { | 
 | 	{ | 
 | 		.start	= 0x40400000, | 
 | 		.end	= 0x40400083, | 
 | 		.flags	= IORESOURCE_MEM, | 
 | 	}, { | 
 | 		.start	= IRQ_I2S, | 
 | 		.end	= IRQ_I2S, | 
 | 		.flags	= IORESOURCE_IRQ, | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct platform_device i2s_device = { | 
 | 	.name		= "pxa2xx-i2s", | 
 | 	.id		= -1, | 
 | 	.resource	= i2s_resources, | 
 | 	.num_resources	= ARRAY_SIZE(i2s_resources), | 
 | }; | 
 |  | 
 | static u64 pxaficp_dmamask = ~(u32)0; | 
 |  | 
 | static struct platform_device pxaficp_device = { | 
 | 	.name		= "pxa2xx-ir", | 
 | 	.id		= -1, | 
 | 	.dev		= { | 
 | 		.dma_mask = &pxaficp_dmamask, | 
 | 		.coherent_dma_mask = 0xffffffff, | 
 | 	}, | 
 | }; | 
 |  | 
 | void __init pxa_set_ficp_info(struct pxaficp_platform_data *info) | 
 | { | 
 | 	pxaficp_device.dev.platform_data = info; | 
 | } | 
 |  | 
 | static struct platform_device *devices[] __initdata = { | 
 | 	&pxamci_device, | 
 | 	&udc_device, | 
 | 	&pxafb_device, | 
 | 	&ffuart_device, | 
 | 	&btuart_device, | 
 | 	&stuart_device, | 
 | 	&pxaficp_device, | 
 | 	&i2c_device, | 
 | 	&i2s_device, | 
 | }; | 
 |  | 
 | static int __init pxa_init(void) | 
 | { | 
 | 	int cpuid, ret; | 
 |  | 
 | 	ret = platform_add_devices(devices, ARRAY_SIZE(devices)); | 
 | 	if (ret) | 
 | 		return ret; | 
 |  | 
 | 	/* Only add HWUART for PXA255/26x; PXA210/250/27x do not have it. */ | 
 | 	cpuid = read_cpuid(CPUID_ID); | 
 | 	if (((cpuid >> 4) & 0xfff) == 0x2d0 || | 
 | 	    ((cpuid >> 4) & 0xfff) == 0x290) | 
 | 		ret = platform_device_register(&hwuart_device); | 
 |  | 
 | 	return ret; | 
 | } | 
 |  | 
 | subsys_initcall(pxa_init); |