1 /* 2 * This program is free software; you can redistribute it and/or modify 3 * it under the terms of the GNU General Public License version 2 as 4 * published by the Free Software Foundation. 5 * 6 * This program is distributed in the hope that it will be useful, 7 * but WITHOUT ANY WARRANTY; without even the implied warranty of 8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 9 * GNU General Public License for more details. 10 * 11 * Copyright (C) 2012 ARM Limited 12 */ 13 14 #include <linux/gpio/driver.h> 15 #include <linux/err.h> 16 #include <linux/io.h> 17 #include <linux/mfd/core.h> 18 #include <linux/of_address.h> 19 #include <linux/of_platform.h> 20 #include <linux/platform_data/syscon.h> 21 #include <linux/platform_device.h> 22 #include <linux/slab.h> 23 #include <linux/stat.h> 24 #include <linux/vexpress.h> 25 26 #define SYS_ID 0x000 27 #define SYS_SW 0x004 28 #define SYS_LED 0x008 29 #define SYS_100HZ 0x024 30 #define SYS_FLAGSSET 0x030 31 #define SYS_FLAGSCLR 0x034 32 #define SYS_NVFLAGS 0x038 33 #define SYS_NVFLAGSSET 0x038 34 #define SYS_NVFLAGSCLR 0x03c 35 #define SYS_MCI 0x048 36 #define SYS_FLASH 0x04c 37 #define SYS_CFGSW 0x058 38 #define SYS_24MHZ 0x05c 39 #define SYS_MISC 0x060 40 #define SYS_DMA 0x064 41 #define SYS_PROCID0 0x084 42 #define SYS_PROCID1 0x088 43 #define SYS_CFGDATA 0x0a0 44 #define SYS_CFGCTRL 0x0a4 45 #define SYS_CFGSTAT 0x0a8 46 47 #define SYS_HBI_MASK 0xfff 48 #define SYS_PROCIDx_HBI_SHIFT 0 49 50 #define SYS_MISC_MASTERSITE (1 << 14) 51 52 void vexpress_flags_set(u32 data) 53 { 54 static void __iomem *base; 55 56 if (!base) { 57 struct device_node *node = of_find_compatible_node(NULL, NULL, 58 "arm,vexpress-sysreg"); 59 60 base = of_iomap(node, 0); 61 } 62 63 if (WARN_ON(!base)) 64 return; 65 66 writel(~0, base + SYS_FLAGSCLR); 67 writel(data, base + SYS_FLAGSSET); 68 } 69 70 /* The sysreg block is just a random collection of various functions... */ 71 72 static struct syscon_platform_data vexpress_sysreg_sys_id_pdata = { 73 .label = "sys_id", 74 }; 75 76 static struct bgpio_pdata vexpress_sysreg_sys_led_pdata = { 77 .label = "sys_led", 78 .base = -1, 79 .ngpio = 8, 80 }; 81 82 static struct bgpio_pdata vexpress_sysreg_sys_mci_pdata = { 83 .label = "sys_mci", 84 .base = -1, 85 .ngpio = 2, 86 }; 87 88 static struct bgpio_pdata vexpress_sysreg_sys_flash_pdata = { 89 .label = "sys_flash", 90 .base = -1, 91 .ngpio = 1, 92 }; 93 94 static struct syscon_platform_data vexpress_sysreg_sys_misc_pdata = { 95 .label = "sys_misc", 96 }; 97 98 static struct syscon_platform_data vexpress_sysreg_sys_procid_pdata = { 99 .label = "sys_procid", 100 }; 101 102 static struct mfd_cell vexpress_sysreg_cells[] = { 103 { 104 .name = "syscon", 105 .num_resources = 1, 106 .resources = (struct resource []) { 107 DEFINE_RES_MEM(SYS_ID, 0x4), 108 }, 109 .platform_data = &vexpress_sysreg_sys_id_pdata, 110 .pdata_size = sizeof(vexpress_sysreg_sys_id_pdata), 111 }, { 112 .name = "basic-mmio-gpio", 113 .of_compatible = "arm,vexpress-sysreg,sys_led", 114 .num_resources = 1, 115 .resources = (struct resource []) { 116 DEFINE_RES_MEM_NAMED(SYS_LED, 0x4, "dat"), 117 }, 118 .platform_data = &vexpress_sysreg_sys_led_pdata, 119 .pdata_size = sizeof(vexpress_sysreg_sys_led_pdata), 120 }, { 121 .name = "basic-mmio-gpio", 122 .of_compatible = "arm,vexpress-sysreg,sys_mci", 123 .num_resources = 1, 124 .resources = (struct resource []) { 125 DEFINE_RES_MEM_NAMED(SYS_MCI, 0x4, "dat"), 126 }, 127 .platform_data = &vexpress_sysreg_sys_mci_pdata, 128 .pdata_size = sizeof(vexpress_sysreg_sys_mci_pdata), 129 }, { 130 .name = "basic-mmio-gpio", 131 .of_compatible = "arm,vexpress-sysreg,sys_flash", 132 .num_resources = 1, 133 .resources = (struct resource []) { 134 DEFINE_RES_MEM_NAMED(SYS_FLASH, 0x4, "dat"), 135 }, 136 .platform_data = &vexpress_sysreg_sys_flash_pdata, 137 .pdata_size = sizeof(vexpress_sysreg_sys_flash_pdata), 138 }, { 139 .name = "syscon", 140 .num_resources = 1, 141 .resources = (struct resource []) { 142 DEFINE_RES_MEM(SYS_MISC, 0x4), 143 }, 144 .platform_data = &vexpress_sysreg_sys_misc_pdata, 145 .pdata_size = sizeof(vexpress_sysreg_sys_misc_pdata), 146 }, { 147 .name = "syscon", 148 .num_resources = 1, 149 .resources = (struct resource []) { 150 DEFINE_RES_MEM(SYS_PROCID0, 0x8), 151 }, 152 .platform_data = &vexpress_sysreg_sys_procid_pdata, 153 .pdata_size = sizeof(vexpress_sysreg_sys_procid_pdata), 154 }, { 155 .name = "vexpress-syscfg", 156 .num_resources = 1, 157 .resources = (struct resource []) { 158 DEFINE_RES_MEM(SYS_CFGDATA, 0xc), 159 }, 160 } 161 }; 162 163 static int vexpress_sysreg_probe(struct platform_device *pdev) 164 { 165 struct resource *mem; 166 void __iomem *base; 167 struct gpio_chip *mmc_gpio_chip; 168 int master; 169 u32 dt_hbi; 170 171 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 172 if (!mem) 173 return -EINVAL; 174 175 base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem)); 176 if (!base) 177 return -ENOMEM; 178 179 master = readl(base + SYS_MISC) & SYS_MISC_MASTERSITE ? 180 VEXPRESS_SITE_DB2 : VEXPRESS_SITE_DB1; 181 vexpress_config_set_master(master); 182 183 /* Confirm board type against DT property, if available */ 184 if (of_property_read_u32(of_root, "arm,hbi", &dt_hbi) == 0) { 185 u32 id = readl(base + (master == VEXPRESS_SITE_DB1 ? 186 SYS_PROCID0 : SYS_PROCID1)); 187 u32 hbi = (id >> SYS_PROCIDx_HBI_SHIFT) & SYS_HBI_MASK; 188 189 if (WARN_ON(dt_hbi != hbi)) 190 dev_warn(&pdev->dev, "DT HBI (%x) is not matching hardware (%x)!\n", 191 dt_hbi, hbi); 192 } 193 194 /* 195 * Duplicated SYS_MCI pseudo-GPIO controller for compatibility with 196 * older trees using sysreg node for MMC control lines. 197 */ 198 mmc_gpio_chip = devm_kzalloc(&pdev->dev, sizeof(*mmc_gpio_chip), 199 GFP_KERNEL); 200 if (!mmc_gpio_chip) 201 return -ENOMEM; 202 bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI, 203 NULL, NULL, NULL, NULL, 0); 204 mmc_gpio_chip->ngpio = 2; 205 gpiochip_add_data(mmc_gpio_chip, NULL); 206 207 return mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO, 208 vexpress_sysreg_cells, 209 ARRAY_SIZE(vexpress_sysreg_cells), mem, 0, NULL); 210 } 211 212 static const struct of_device_id vexpress_sysreg_match[] = { 213 { .compatible = "arm,vexpress-sysreg", }, 214 {}, 215 }; 216 217 static struct platform_driver vexpress_sysreg_driver = { 218 .driver = { 219 .name = "vexpress-sysreg", 220 .of_match_table = vexpress_sysreg_match, 221 }, 222 .probe = vexpress_sysreg_probe, 223 }; 224 225 static int __init vexpress_sysreg_init(void) 226 { 227 struct device_node *node; 228 229 /* Need the sysreg early, before any other device... */ 230 for_each_matching_node(node, vexpress_sysreg_match) 231 of_platform_device_create(node, NULL, NULL); 232 233 return platform_driver_register(&vexpress_sysreg_driver); 234 } 235 core_initcall(vexpress_sysreg_init); 236