137 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 *4 * Copyright (C) 2012 ARM Limited5 */6 7#include <linux/gpio/driver.h>8#include <linux/err.h>9#include <linux/io.h>10#include <linux/mfd/core.h>11#include <linux/module.h>12#include <linux/of_platform.h>13#include <linux/platform_data/syscon.h>14#include <linux/platform_device.h>15#include <linux/slab.h>16#include <linux/stat.h>17 18#define SYS_ID 0x00019#define SYS_SW 0x00420#define SYS_LED 0x00821#define SYS_100HZ 0x02422#define SYS_FLAGSSET 0x03023#define SYS_FLAGSCLR 0x03424#define SYS_NVFLAGS 0x03825#define SYS_NVFLAGSSET 0x03826#define SYS_NVFLAGSCLR 0x03c27#define SYS_MCI 0x04828#define SYS_FLASH 0x04c29#define SYS_CFGSW 0x05830#define SYS_24MHZ 0x05c31#define SYS_MISC 0x06032#define SYS_DMA 0x06433#define SYS_PROCID0 0x08434#define SYS_PROCID1 0x08835#define SYS_CFGDATA 0x0a036#define SYS_CFGCTRL 0x0a437#define SYS_CFGSTAT 0x0a838 39/* The sysreg block is just a random collection of various functions... */40 41static struct bgpio_pdata vexpress_sysreg_sys_led_pdata = {42 .label = "sys_led",43 .base = -1,44 .ngpio = 8,45};46 47static struct bgpio_pdata vexpress_sysreg_sys_mci_pdata = {48 .label = "sys_mci",49 .base = -1,50 .ngpio = 2,51};52 53static struct bgpio_pdata vexpress_sysreg_sys_flash_pdata = {54 .label = "sys_flash",55 .base = -1,56 .ngpio = 1,57};58 59static struct mfd_cell vexpress_sysreg_cells[] = {60 {61 .name = "basic-mmio-gpio",62 .of_compatible = "arm,vexpress-sysreg,sys_led",63 .num_resources = 1,64 .resources = &DEFINE_RES_MEM_NAMED(SYS_LED, 0x4, "dat"),65 .platform_data = &vexpress_sysreg_sys_led_pdata,66 .pdata_size = sizeof(vexpress_sysreg_sys_led_pdata),67 }, {68 .name = "basic-mmio-gpio",69 .of_compatible = "arm,vexpress-sysreg,sys_mci",70 .num_resources = 1,71 .resources = &DEFINE_RES_MEM_NAMED(SYS_MCI, 0x4, "dat"),72 .platform_data = &vexpress_sysreg_sys_mci_pdata,73 .pdata_size = sizeof(vexpress_sysreg_sys_mci_pdata),74 }, {75 .name = "basic-mmio-gpio",76 .of_compatible = "arm,vexpress-sysreg,sys_flash",77 .num_resources = 1,78 .resources = &DEFINE_RES_MEM_NAMED(SYS_FLASH, 0x4, "dat"),79 .platform_data = &vexpress_sysreg_sys_flash_pdata,80 .pdata_size = sizeof(vexpress_sysreg_sys_flash_pdata),81 }, {82 .name = "vexpress-syscfg",83 .num_resources = 1,84 .resources = &DEFINE_RES_MEM(SYS_MISC, 0x4c),85 }86};87 88static int vexpress_sysreg_probe(struct platform_device *pdev)89{90 struct resource *mem;91 void __iomem *base;92 struct gpio_chip *mmc_gpio_chip;93 94 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);95 if (!mem)96 return -EINVAL;97 98 base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));99 if (!base)100 return -ENOMEM;101 102 /*103 * Duplicated SYS_MCI pseudo-GPIO controller for compatibility with104 * older trees using sysreg node for MMC control lines.105 */106 mmc_gpio_chip = devm_kzalloc(&pdev->dev, sizeof(*mmc_gpio_chip),107 GFP_KERNEL);108 if (!mmc_gpio_chip)109 return -ENOMEM;110 bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI,111 NULL, NULL, NULL, NULL, 0);112 mmc_gpio_chip->ngpio = 2;113 devm_gpiochip_add_data(&pdev->dev, mmc_gpio_chip, NULL);114 115 return devm_mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO,116 vexpress_sysreg_cells,117 ARRAY_SIZE(vexpress_sysreg_cells), mem, 0, NULL);118}119 120static const struct of_device_id vexpress_sysreg_match[] = {121 { .compatible = "arm,vexpress-sysreg", },122 {},123};124MODULE_DEVICE_TABLE(of, vexpress_sysreg_match);125 126static struct platform_driver vexpress_sysreg_driver = {127 .driver = {128 .name = "vexpress-sysreg",129 .of_match_table = vexpress_sysreg_match,130 },131 .probe = vexpress_sysreg_probe,132};133 134module_platform_driver(vexpress_sysreg_driver);135MODULE_DESCRIPTION("Versatile Express system registers driver");136MODULE_LICENSE("GPL v2");137