145 lines
		
	
	
		
			3.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			145 lines
		
	
	
		
			3.0 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) 2008 Maxime Bizon <mbizon@freebox.fr>
 | |
|  */
 | |
| 
 | |
| #include <linux/init.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <asm/bootinfo.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <bcm63xx_cs.h>
 | |
| #include <bcm63xx_cpu.h>
 | |
| #include <bcm63xx_dev_pcmcia.h>
 | |
| #include <bcm63xx_io.h>
 | |
| #include <bcm63xx_regs.h>
 | |
| 
 | |
| static struct resource pcmcia_resources[] = {
 | |
| 	/* pcmcia registers */
 | |
| 	{
 | |
| 		/* start & end filled at runtime */
 | |
| 		.flags		= IORESOURCE_MEM,
 | |
| 	},
 | |
| 
 | |
| 	/* pcmcia memory zone resources */
 | |
| 	{
 | |
| 		.start		= BCM_PCMCIA_COMMON_BASE_PA,
 | |
| 		.end		= BCM_PCMCIA_COMMON_END_PA,
 | |
| 		.flags		= IORESOURCE_MEM,
 | |
| 	},
 | |
| 	{
 | |
| 		.start		= BCM_PCMCIA_ATTR_BASE_PA,
 | |
| 		.end		= BCM_PCMCIA_ATTR_END_PA,
 | |
| 		.flags		= IORESOURCE_MEM,
 | |
| 	},
 | |
| 	{
 | |
| 		.start		= BCM_PCMCIA_IO_BASE_PA,
 | |
| 		.end		= BCM_PCMCIA_IO_END_PA,
 | |
| 		.flags		= IORESOURCE_MEM,
 | |
| 	},
 | |
| 
 | |
| 	/* PCMCIA irq */
 | |
| 	{
 | |
| 		/* start filled at runtime */
 | |
| 		.flags		= IORESOURCE_IRQ,
 | |
| 	},
 | |
| 
 | |
| 	/* declare PCMCIA IO resource also */
 | |
| 	{
 | |
| 		.start		= BCM_PCMCIA_IO_BASE_PA,
 | |
| 		.end		= BCM_PCMCIA_IO_END_PA,
 | |
| 		.flags		= IORESOURCE_IO,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static struct bcm63xx_pcmcia_platform_data pd;
 | |
| 
 | |
| static struct platform_device bcm63xx_pcmcia_device = {
 | |
| 	.name		= "bcm63xx_pcmcia",
 | |
| 	.id		= 0,
 | |
| 	.num_resources	= ARRAY_SIZE(pcmcia_resources),
 | |
| 	.resource	= pcmcia_resources,
 | |
| 	.dev		= {
 | |
| 		.platform_data = &pd,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static int __init config_pcmcia_cs(unsigned int cs,
 | |
| 				   u32 base, unsigned int size)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = bcm63xx_set_cs_status(cs, 0);
 | |
| 	if (!ret)
 | |
| 		ret = bcm63xx_set_cs_base(cs, base, size);
 | |
| 	if (!ret)
 | |
| 		ret = bcm63xx_set_cs_status(cs, 1);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static const struct {
 | |
| 	unsigned int	cs;
 | |
| 	unsigned int	base;
 | |
| 	unsigned int	size;
 | |
| } pcmcia_cs[3] __initconst = {
 | |
| 	{
 | |
| 		.cs	= MPI_CS_PCMCIA_COMMON,
 | |
| 		.base	= BCM_PCMCIA_COMMON_BASE_PA,
 | |
| 		.size	= BCM_PCMCIA_COMMON_SIZE
 | |
| 	},
 | |
| 	{
 | |
| 		.cs	= MPI_CS_PCMCIA_ATTR,
 | |
| 		.base	= BCM_PCMCIA_ATTR_BASE_PA,
 | |
| 		.size	= BCM_PCMCIA_ATTR_SIZE
 | |
| 	},
 | |
| 	{
 | |
| 		.cs	= MPI_CS_PCMCIA_IO,
 | |
| 		.base	= BCM_PCMCIA_IO_BASE_PA,
 | |
| 		.size	= BCM_PCMCIA_IO_SIZE
 | |
| 	},
 | |
| };
 | |
| 
 | |
| int __init bcm63xx_pcmcia_register(void)
 | |
| {
 | |
| 	int ret, i;
 | |
| 
 | |
| 	if (!BCMCPU_IS_6348() && !BCMCPU_IS_6358())
 | |
| 		return 0;
 | |
| 
 | |
| 	/* use correct pcmcia ready gpio depending on processor */
 | |
| 	switch (bcm63xx_get_cpu_id()) {
 | |
| 	case BCM6348_CPU_ID:
 | |
| 		pd.ready_gpio = 22;
 | |
| 		break;
 | |
| 
 | |
| 	case BCM6358_CPU_ID:
 | |
| 		pd.ready_gpio = 18;
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	pcmcia_resources[0].start = bcm63xx_regset_address(RSET_PCMCIA);
 | |
| 	pcmcia_resources[0].end = pcmcia_resources[0].start +
 | |
| 		RSET_PCMCIA_SIZE - 1;
 | |
| 	pcmcia_resources[4].start = bcm63xx_get_irq_number(IRQ_PCMCIA);
 | |
| 
 | |
| 	/* configure pcmcia chip selects */
 | |
| 	for (i = 0; i < 3; i++) {
 | |
| 		ret = config_pcmcia_cs(pcmcia_cs[i].cs,
 | |
| 				       pcmcia_cs[i].base,
 | |
| 				       pcmcia_cs[i].size);
 | |
| 		if (ret)
 | |
| 			goto out_err;
 | |
| 	}
 | |
| 
 | |
| 	return platform_device_register(&bcm63xx_pcmcia_device);
 | |
| 
 | |
| out_err:
 | |
| 	pr_err("unable to set pcmcia chip select\n");
 | |
| 	return ret;
 | |
| }
 |