Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 | /* * 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; } |