Linux Audio

Check our new training course

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