18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Driver for Intel MSIC
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2011, Intel Corporation
68c2ecf20Sopenharmony_ci * Author: Mika Westerberg <mika.westerberg@linux.intel.com>
78c2ecf20Sopenharmony_ci */
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ci#include <linux/err.h>
108c2ecf20Sopenharmony_ci#include <linux/gpio.h>
118c2ecf20Sopenharmony_ci#include <linux/io.h>
128c2ecf20Sopenharmony_ci#include <linux/init.h>
138c2ecf20Sopenharmony_ci#include <linux/mfd/core.h>
148c2ecf20Sopenharmony_ci#include <linux/mfd/intel_msic.h>
158c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
168c2ecf20Sopenharmony_ci#include <linux/slab.h>
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci#include <asm/intel_scu_ipc.h>
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci#define MSIC_VENDOR(id)		((id >> 6) & 3)
218c2ecf20Sopenharmony_ci#define MSIC_VERSION(id)	(id & 0x3f)
228c2ecf20Sopenharmony_ci#define MSIC_MAJOR(id)		('A' + ((id >> 3) & 7))
238c2ecf20Sopenharmony_ci#define MSIC_MINOR(id)		(id & 7)
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci/*
268c2ecf20Sopenharmony_ci * MSIC interrupt tree is readable from SRAM at INTEL_MSIC_IRQ_PHYS_BASE.
278c2ecf20Sopenharmony_ci * Since IRQ block starts from address 0x002 we need to subtract that from
288c2ecf20Sopenharmony_ci * the actual IRQ status register address.
298c2ecf20Sopenharmony_ci */
308c2ecf20Sopenharmony_ci#define MSIC_IRQ_STATUS(x)	(INTEL_MSIC_IRQ_PHYS_BASE + ((x) - 2))
318c2ecf20Sopenharmony_ci#define MSIC_IRQ_STATUS_ACCDET	MSIC_IRQ_STATUS(INTEL_MSIC_ACCDET)
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci/*
348c2ecf20Sopenharmony_ci * The SCU hardware has limitation of 16 bytes per read/write buffer on
358c2ecf20Sopenharmony_ci * Medfield.
368c2ecf20Sopenharmony_ci */
378c2ecf20Sopenharmony_ci#define SCU_IPC_RWBUF_LIMIT	16
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci/**
408c2ecf20Sopenharmony_ci * struct intel_msic - an MSIC MFD instance
418c2ecf20Sopenharmony_ci * @pdev: pointer to the platform device
428c2ecf20Sopenharmony_ci * @vendor: vendor ID
438c2ecf20Sopenharmony_ci * @version: chip version
448c2ecf20Sopenharmony_ci * @irq_base: base address of the mapped MSIC SRAM interrupt tree
458c2ecf20Sopenharmony_ci */
468c2ecf20Sopenharmony_cistruct intel_msic {
478c2ecf20Sopenharmony_ci	struct platform_device		*pdev;
488c2ecf20Sopenharmony_ci	unsigned			vendor;
498c2ecf20Sopenharmony_ci	unsigned			version;
508c2ecf20Sopenharmony_ci	void __iomem			*irq_base;
518c2ecf20Sopenharmony_ci};
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_cistatic struct resource msic_touch_resources[] = {
548c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
558c2ecf20Sopenharmony_ci};
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_cistatic struct resource msic_adc_resources[] = {
588c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
598c2ecf20Sopenharmony_ci};
608c2ecf20Sopenharmony_ci
618c2ecf20Sopenharmony_cistatic struct resource msic_battery_resources[] = {
628c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
638c2ecf20Sopenharmony_ci};
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_cistatic struct resource msic_gpio_resources[] = {
668c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
678c2ecf20Sopenharmony_ci};
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_cistatic struct resource msic_audio_resources[] = {
708c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ_NAMED(0, "IRQ"),
718c2ecf20Sopenharmony_ci	/*
728c2ecf20Sopenharmony_ci	 * We will pass IRQ_BASE to the driver now but this can be removed
738c2ecf20Sopenharmony_ci	 * when/if the driver starts to use intel_msic_irq_read().
748c2ecf20Sopenharmony_ci	 */
758c2ecf20Sopenharmony_ci	DEFINE_RES_MEM_NAMED(MSIC_IRQ_STATUS_ACCDET, 1, "IRQ_BASE"),
768c2ecf20Sopenharmony_ci};
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_cistatic struct resource msic_hdmi_resources[] = {
798c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
808c2ecf20Sopenharmony_ci};
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_cistatic struct resource msic_thermal_resources[] = {
838c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
848c2ecf20Sopenharmony_ci};
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_cistatic struct resource msic_power_btn_resources[] = {
878c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
888c2ecf20Sopenharmony_ci};
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_cistatic struct resource msic_ocd_resources[] = {
918c2ecf20Sopenharmony_ci	DEFINE_RES_IRQ(0),
928c2ecf20Sopenharmony_ci};
938c2ecf20Sopenharmony_ci
948c2ecf20Sopenharmony_ci/*
958c2ecf20Sopenharmony_ci * Devices that are part of the MSIC and are available via firmware
968c2ecf20Sopenharmony_ci * populated SFI DEVS table.
978c2ecf20Sopenharmony_ci */
988c2ecf20Sopenharmony_cistatic struct mfd_cell msic_devs[] = {
998c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_TOUCH]	= {
1008c2ecf20Sopenharmony_ci		.name			= "msic_touch",
1018c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_touch_resources),
1028c2ecf20Sopenharmony_ci		.resources		= msic_touch_resources,
1038c2ecf20Sopenharmony_ci	},
1048c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_ADC]		= {
1058c2ecf20Sopenharmony_ci		.name			= "msic_adc",
1068c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_adc_resources),
1078c2ecf20Sopenharmony_ci		.resources		= msic_adc_resources,
1088c2ecf20Sopenharmony_ci	},
1098c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_BATTERY]	= {
1108c2ecf20Sopenharmony_ci		.name			= "msic_battery",
1118c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_battery_resources),
1128c2ecf20Sopenharmony_ci		.resources		= msic_battery_resources,
1138c2ecf20Sopenharmony_ci	},
1148c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_GPIO]		= {
1158c2ecf20Sopenharmony_ci		.name			= "msic_gpio",
1168c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_gpio_resources),
1178c2ecf20Sopenharmony_ci		.resources		= msic_gpio_resources,
1188c2ecf20Sopenharmony_ci	},
1198c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_AUDIO]	= {
1208c2ecf20Sopenharmony_ci		.name			= "msic_audio",
1218c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_audio_resources),
1228c2ecf20Sopenharmony_ci		.resources		= msic_audio_resources,
1238c2ecf20Sopenharmony_ci	},
1248c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_HDMI]		= {
1258c2ecf20Sopenharmony_ci		.name			= "msic_hdmi",
1268c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_hdmi_resources),
1278c2ecf20Sopenharmony_ci		.resources		= msic_hdmi_resources,
1288c2ecf20Sopenharmony_ci	},
1298c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_THERMAL]	= {
1308c2ecf20Sopenharmony_ci		.name			= "msic_thermal",
1318c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_thermal_resources),
1328c2ecf20Sopenharmony_ci		.resources		= msic_thermal_resources,
1338c2ecf20Sopenharmony_ci	},
1348c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_POWER_BTN]	= {
1358c2ecf20Sopenharmony_ci		.name			= "msic_power_btn",
1368c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_power_btn_resources),
1378c2ecf20Sopenharmony_ci		.resources		= msic_power_btn_resources,
1388c2ecf20Sopenharmony_ci	},
1398c2ecf20Sopenharmony_ci	[INTEL_MSIC_BLOCK_OCD]		= {
1408c2ecf20Sopenharmony_ci		.name			= "msic_ocd",
1418c2ecf20Sopenharmony_ci		.num_resources		= ARRAY_SIZE(msic_ocd_resources),
1428c2ecf20Sopenharmony_ci		.resources		= msic_ocd_resources,
1438c2ecf20Sopenharmony_ci	},
1448c2ecf20Sopenharmony_ci};
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci/*
1478c2ecf20Sopenharmony_ci * Other MSIC related devices which are not directly available via SFI DEVS
1488c2ecf20Sopenharmony_ci * table. These can be pseudo devices, regulators etc. which are needed for
1498c2ecf20Sopenharmony_ci * different purposes.
1508c2ecf20Sopenharmony_ci *
1518c2ecf20Sopenharmony_ci * These devices appear only after the MSIC driver itself is initialized so
1528c2ecf20Sopenharmony_ci * we can guarantee that the SCU IPC interface is ready.
1538c2ecf20Sopenharmony_ci */
1548c2ecf20Sopenharmony_cistatic const struct mfd_cell msic_other_devs[] = {
1558c2ecf20Sopenharmony_ci	/* Audio codec in the MSIC */
1568c2ecf20Sopenharmony_ci	{
1578c2ecf20Sopenharmony_ci		.id			= -1,
1588c2ecf20Sopenharmony_ci		.name			= "sn95031",
1598c2ecf20Sopenharmony_ci	},
1608c2ecf20Sopenharmony_ci};
1618c2ecf20Sopenharmony_ci
1628c2ecf20Sopenharmony_ci/**
1638c2ecf20Sopenharmony_ci * intel_msic_reg_read - read a single MSIC register
1648c2ecf20Sopenharmony_ci * @reg: register to read
1658c2ecf20Sopenharmony_ci * @val: register value is placed here
1668c2ecf20Sopenharmony_ci *
1678c2ecf20Sopenharmony_ci * Read a single register from MSIC. Returns %0 on success and negative
1688c2ecf20Sopenharmony_ci * errno in case of failure.
1698c2ecf20Sopenharmony_ci *
1708c2ecf20Sopenharmony_ci * Function may sleep.
1718c2ecf20Sopenharmony_ci */
1728c2ecf20Sopenharmony_ciint intel_msic_reg_read(unsigned short reg, u8 *val)
1738c2ecf20Sopenharmony_ci{
1748c2ecf20Sopenharmony_ci	return intel_scu_ipc_ioread8(reg, val);
1758c2ecf20Sopenharmony_ci}
1768c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(intel_msic_reg_read);
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_ci/**
1798c2ecf20Sopenharmony_ci * intel_msic_reg_write - write a single MSIC register
1808c2ecf20Sopenharmony_ci * @reg: register to write
1818c2ecf20Sopenharmony_ci * @val: value to write to that register
1828c2ecf20Sopenharmony_ci *
1838c2ecf20Sopenharmony_ci * Write a single MSIC register. Returns 0 on success and negative
1848c2ecf20Sopenharmony_ci * errno in case of failure.
1858c2ecf20Sopenharmony_ci *
1868c2ecf20Sopenharmony_ci * Function may sleep.
1878c2ecf20Sopenharmony_ci */
1888c2ecf20Sopenharmony_ciint intel_msic_reg_write(unsigned short reg, u8 val)
1898c2ecf20Sopenharmony_ci{
1908c2ecf20Sopenharmony_ci	return intel_scu_ipc_iowrite8(reg, val);
1918c2ecf20Sopenharmony_ci}
1928c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(intel_msic_reg_write);
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_ci/**
1958c2ecf20Sopenharmony_ci * intel_msic_reg_update - update a single MSIC register
1968c2ecf20Sopenharmony_ci * @reg: register to update
1978c2ecf20Sopenharmony_ci * @val: value to write to the register
1988c2ecf20Sopenharmony_ci * @mask: specifies which of the bits are updated (%0 = don't update,
1998c2ecf20Sopenharmony_ci *        %1 = update)
2008c2ecf20Sopenharmony_ci *
2018c2ecf20Sopenharmony_ci * Perform an update to a register @reg. @mask is used to specify which
2028c2ecf20Sopenharmony_ci * bits are updated. Returns %0 in case of success and negative errno in
2038c2ecf20Sopenharmony_ci * case of failure.
2048c2ecf20Sopenharmony_ci *
2058c2ecf20Sopenharmony_ci * Function may sleep.
2068c2ecf20Sopenharmony_ci */
2078c2ecf20Sopenharmony_ciint intel_msic_reg_update(unsigned short reg, u8 val, u8 mask)
2088c2ecf20Sopenharmony_ci{
2098c2ecf20Sopenharmony_ci	return intel_scu_ipc_update_register(reg, val, mask);
2108c2ecf20Sopenharmony_ci}
2118c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(intel_msic_reg_update);
2128c2ecf20Sopenharmony_ci
2138c2ecf20Sopenharmony_ci/**
2148c2ecf20Sopenharmony_ci * intel_msic_bulk_read - read an array of registers
2158c2ecf20Sopenharmony_ci * @reg: array of register addresses to read
2168c2ecf20Sopenharmony_ci * @buf: array where the read values are placed
2178c2ecf20Sopenharmony_ci * @count: number of registers to read
2188c2ecf20Sopenharmony_ci *
2198c2ecf20Sopenharmony_ci * Function reads @count registers from the MSIC using addresses passed in
2208c2ecf20Sopenharmony_ci * @reg. Read values are placed in @buf. Reads are performed atomically
2218c2ecf20Sopenharmony_ci * wrt. MSIC.
2228c2ecf20Sopenharmony_ci *
2238c2ecf20Sopenharmony_ci * Returns %0 in case of success and negative errno in case of failure.
2248c2ecf20Sopenharmony_ci *
2258c2ecf20Sopenharmony_ci * Function may sleep.
2268c2ecf20Sopenharmony_ci */
2278c2ecf20Sopenharmony_ciint intel_msic_bulk_read(unsigned short *reg, u8 *buf, size_t count)
2288c2ecf20Sopenharmony_ci{
2298c2ecf20Sopenharmony_ci	if (WARN_ON(count > SCU_IPC_RWBUF_LIMIT))
2308c2ecf20Sopenharmony_ci		return -EINVAL;
2318c2ecf20Sopenharmony_ci
2328c2ecf20Sopenharmony_ci	return intel_scu_ipc_readv(reg, buf, count);
2338c2ecf20Sopenharmony_ci}
2348c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(intel_msic_bulk_read);
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci/**
2378c2ecf20Sopenharmony_ci * intel_msic_bulk_write - write an array of values to the MSIC registers
2388c2ecf20Sopenharmony_ci * @reg: array of registers to write
2398c2ecf20Sopenharmony_ci * @buf: values to write to each register
2408c2ecf20Sopenharmony_ci * @count: number of registers to write
2418c2ecf20Sopenharmony_ci *
2428c2ecf20Sopenharmony_ci * Function writes @count registers in @buf to MSIC. Writes are performed
2438c2ecf20Sopenharmony_ci * atomically wrt MSIC. Returns %0 in case of success and negative errno in
2448c2ecf20Sopenharmony_ci * case of failure.
2458c2ecf20Sopenharmony_ci *
2468c2ecf20Sopenharmony_ci * Function may sleep.
2478c2ecf20Sopenharmony_ci */
2488c2ecf20Sopenharmony_ciint intel_msic_bulk_write(unsigned short *reg, u8 *buf, size_t count)
2498c2ecf20Sopenharmony_ci{
2508c2ecf20Sopenharmony_ci	if (WARN_ON(count > SCU_IPC_RWBUF_LIMIT))
2518c2ecf20Sopenharmony_ci		return -EINVAL;
2528c2ecf20Sopenharmony_ci
2538c2ecf20Sopenharmony_ci	return intel_scu_ipc_writev(reg, buf, count);
2548c2ecf20Sopenharmony_ci}
2558c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(intel_msic_bulk_write);
2568c2ecf20Sopenharmony_ci
2578c2ecf20Sopenharmony_ci/**
2588c2ecf20Sopenharmony_ci * intel_msic_irq_read - read a register from an MSIC interrupt tree
2598c2ecf20Sopenharmony_ci * @msic: MSIC instance
2608c2ecf20Sopenharmony_ci * @reg: interrupt register (between %INTEL_MSIC_IRQLVL1 and
2618c2ecf20Sopenharmony_ci *	 %INTEL_MSIC_RESETIRQ2)
2628c2ecf20Sopenharmony_ci * @val: value of the register is placed here
2638c2ecf20Sopenharmony_ci *
2648c2ecf20Sopenharmony_ci * This function can be used by an MSIC subdevice interrupt handler to read
2658c2ecf20Sopenharmony_ci * a register value from the MSIC interrupt tree. In this way subdevice
2668c2ecf20Sopenharmony_ci * drivers don't have to map in the interrupt tree themselves but can just
2678c2ecf20Sopenharmony_ci * call this function instead.
2688c2ecf20Sopenharmony_ci *
2698c2ecf20Sopenharmony_ci * Function doesn't sleep and is callable from interrupt context.
2708c2ecf20Sopenharmony_ci *
2718c2ecf20Sopenharmony_ci * Returns %-EINVAL if @reg is outside of the allowed register region.
2728c2ecf20Sopenharmony_ci */
2738c2ecf20Sopenharmony_ciint intel_msic_irq_read(struct intel_msic *msic, unsigned short reg, u8 *val)
2748c2ecf20Sopenharmony_ci{
2758c2ecf20Sopenharmony_ci	if (WARN_ON(reg < INTEL_MSIC_IRQLVL1 || reg > INTEL_MSIC_RESETIRQ2))
2768c2ecf20Sopenharmony_ci		return -EINVAL;
2778c2ecf20Sopenharmony_ci
2788c2ecf20Sopenharmony_ci	*val = readb(msic->irq_base + (reg - INTEL_MSIC_IRQLVL1));
2798c2ecf20Sopenharmony_ci	return 0;
2808c2ecf20Sopenharmony_ci}
2818c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(intel_msic_irq_read);
2828c2ecf20Sopenharmony_ci
2838c2ecf20Sopenharmony_cistatic int intel_msic_init_devices(struct intel_msic *msic)
2848c2ecf20Sopenharmony_ci{
2858c2ecf20Sopenharmony_ci	struct platform_device *pdev = msic->pdev;
2868c2ecf20Sopenharmony_ci	struct intel_msic_platform_data *pdata = dev_get_platdata(&pdev->dev);
2878c2ecf20Sopenharmony_ci	int ret, i;
2888c2ecf20Sopenharmony_ci
2898c2ecf20Sopenharmony_ci	if (pdata->gpio) {
2908c2ecf20Sopenharmony_ci		struct mfd_cell *cell = &msic_devs[INTEL_MSIC_BLOCK_GPIO];
2918c2ecf20Sopenharmony_ci
2928c2ecf20Sopenharmony_ci		cell->platform_data = pdata->gpio;
2938c2ecf20Sopenharmony_ci		cell->pdata_size = sizeof(*pdata->gpio);
2948c2ecf20Sopenharmony_ci	}
2958c2ecf20Sopenharmony_ci
2968c2ecf20Sopenharmony_ci	if (pdata->ocd) {
2978c2ecf20Sopenharmony_ci		unsigned gpio = pdata->ocd->gpio;
2988c2ecf20Sopenharmony_ci
2998c2ecf20Sopenharmony_ci		ret = devm_gpio_request_one(&pdev->dev, gpio,
3008c2ecf20Sopenharmony_ci					GPIOF_IN, "ocd_gpio");
3018c2ecf20Sopenharmony_ci		if (ret) {
3028c2ecf20Sopenharmony_ci			dev_err(&pdev->dev, "failed to register OCD GPIO\n");
3038c2ecf20Sopenharmony_ci			return ret;
3048c2ecf20Sopenharmony_ci		}
3058c2ecf20Sopenharmony_ci
3068c2ecf20Sopenharmony_ci		ret = gpio_to_irq(gpio);
3078c2ecf20Sopenharmony_ci		if (ret < 0) {
3088c2ecf20Sopenharmony_ci			dev_err(&pdev->dev, "no IRQ number for OCD GPIO\n");
3098c2ecf20Sopenharmony_ci			return ret;
3108c2ecf20Sopenharmony_ci		}
3118c2ecf20Sopenharmony_ci
3128c2ecf20Sopenharmony_ci		/* Update the IRQ number for the OCD */
3138c2ecf20Sopenharmony_ci		pdata->irq[INTEL_MSIC_BLOCK_OCD] = ret;
3148c2ecf20Sopenharmony_ci	}
3158c2ecf20Sopenharmony_ci
3168c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(msic_devs); i++) {
3178c2ecf20Sopenharmony_ci		if (!pdata->irq[i])
3188c2ecf20Sopenharmony_ci			continue;
3198c2ecf20Sopenharmony_ci
3208c2ecf20Sopenharmony_ci		ret = mfd_add_devices(&pdev->dev, -1, &msic_devs[i], 1, NULL,
3218c2ecf20Sopenharmony_ci				      pdata->irq[i], NULL);
3228c2ecf20Sopenharmony_ci		if (ret)
3238c2ecf20Sopenharmony_ci			goto fail;
3248c2ecf20Sopenharmony_ci	}
3258c2ecf20Sopenharmony_ci
3268c2ecf20Sopenharmony_ci	ret = mfd_add_devices(&pdev->dev, 0, msic_other_devs,
3278c2ecf20Sopenharmony_ci			      ARRAY_SIZE(msic_other_devs), NULL, 0, NULL);
3288c2ecf20Sopenharmony_ci	if (ret)
3298c2ecf20Sopenharmony_ci		goto fail;
3308c2ecf20Sopenharmony_ci
3318c2ecf20Sopenharmony_ci	return 0;
3328c2ecf20Sopenharmony_ci
3338c2ecf20Sopenharmony_cifail:
3348c2ecf20Sopenharmony_ci	mfd_remove_devices(&pdev->dev);
3358c2ecf20Sopenharmony_ci
3368c2ecf20Sopenharmony_ci	return ret;
3378c2ecf20Sopenharmony_ci}
3388c2ecf20Sopenharmony_ci
3398c2ecf20Sopenharmony_cistatic void intel_msic_remove_devices(struct intel_msic *msic)
3408c2ecf20Sopenharmony_ci{
3418c2ecf20Sopenharmony_ci	struct platform_device *pdev = msic->pdev;
3428c2ecf20Sopenharmony_ci
3438c2ecf20Sopenharmony_ci	mfd_remove_devices(&pdev->dev);
3448c2ecf20Sopenharmony_ci}
3458c2ecf20Sopenharmony_ci
3468c2ecf20Sopenharmony_cistatic int intel_msic_probe(struct platform_device *pdev)
3478c2ecf20Sopenharmony_ci{
3488c2ecf20Sopenharmony_ci	struct intel_msic_platform_data *pdata = dev_get_platdata(&pdev->dev);
3498c2ecf20Sopenharmony_ci	struct intel_msic *msic;
3508c2ecf20Sopenharmony_ci	struct resource *res;
3518c2ecf20Sopenharmony_ci	u8 id0, id1;
3528c2ecf20Sopenharmony_ci	int ret;
3538c2ecf20Sopenharmony_ci
3548c2ecf20Sopenharmony_ci	if (!pdata) {
3558c2ecf20Sopenharmony_ci		dev_err(&pdev->dev, "no platform data passed\n");
3568c2ecf20Sopenharmony_ci		return -EINVAL;
3578c2ecf20Sopenharmony_ci	}
3588c2ecf20Sopenharmony_ci
3598c2ecf20Sopenharmony_ci	/* First validate that we have an MSIC in place */
3608c2ecf20Sopenharmony_ci	ret = intel_scu_ipc_ioread8(INTEL_MSIC_ID0, &id0);
3618c2ecf20Sopenharmony_ci	if (ret) {
3628c2ecf20Sopenharmony_ci		dev_err(&pdev->dev, "failed to identify the MSIC chip (ID0)\n");
3638c2ecf20Sopenharmony_ci		return -ENXIO;
3648c2ecf20Sopenharmony_ci	}
3658c2ecf20Sopenharmony_ci
3668c2ecf20Sopenharmony_ci	ret = intel_scu_ipc_ioread8(INTEL_MSIC_ID1, &id1);
3678c2ecf20Sopenharmony_ci	if (ret) {
3688c2ecf20Sopenharmony_ci		dev_err(&pdev->dev, "failed to identify the MSIC chip (ID1)\n");
3698c2ecf20Sopenharmony_ci		return -ENXIO;
3708c2ecf20Sopenharmony_ci	}
3718c2ecf20Sopenharmony_ci
3728c2ecf20Sopenharmony_ci	if (MSIC_VENDOR(id0) != MSIC_VENDOR(id1)) {
3738c2ecf20Sopenharmony_ci		dev_err(&pdev->dev, "invalid vendor ID: %x, %x\n", id0, id1);
3748c2ecf20Sopenharmony_ci		return -ENXIO;
3758c2ecf20Sopenharmony_ci	}
3768c2ecf20Sopenharmony_ci
3778c2ecf20Sopenharmony_ci	msic = devm_kzalloc(&pdev->dev, sizeof(*msic), GFP_KERNEL);
3788c2ecf20Sopenharmony_ci	if (!msic)
3798c2ecf20Sopenharmony_ci		return -ENOMEM;
3808c2ecf20Sopenharmony_ci
3818c2ecf20Sopenharmony_ci	msic->vendor = MSIC_VENDOR(id0);
3828c2ecf20Sopenharmony_ci	msic->version = MSIC_VERSION(id0);
3838c2ecf20Sopenharmony_ci	msic->pdev = pdev;
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_ci	/*
3868c2ecf20Sopenharmony_ci	 * Map in the MSIC interrupt tree area in SRAM. This is exposed to
3878c2ecf20Sopenharmony_ci	 * the clients via intel_msic_irq_read().
3888c2ecf20Sopenharmony_ci	 */
3898c2ecf20Sopenharmony_ci	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
3908c2ecf20Sopenharmony_ci	msic->irq_base = devm_ioremap_resource(&pdev->dev, res);
3918c2ecf20Sopenharmony_ci	if (IS_ERR(msic->irq_base))
3928c2ecf20Sopenharmony_ci		return PTR_ERR(msic->irq_base);
3938c2ecf20Sopenharmony_ci
3948c2ecf20Sopenharmony_ci	platform_set_drvdata(pdev, msic);
3958c2ecf20Sopenharmony_ci
3968c2ecf20Sopenharmony_ci	ret = intel_msic_init_devices(msic);
3978c2ecf20Sopenharmony_ci	if (ret) {
3988c2ecf20Sopenharmony_ci		dev_err(&pdev->dev, "failed to initialize MSIC devices\n");
3998c2ecf20Sopenharmony_ci		return ret;
4008c2ecf20Sopenharmony_ci	}
4018c2ecf20Sopenharmony_ci
4028c2ecf20Sopenharmony_ci	dev_info(&pdev->dev, "Intel MSIC version %c%d (vendor %#x)\n",
4038c2ecf20Sopenharmony_ci		 MSIC_MAJOR(msic->version), MSIC_MINOR(msic->version),
4048c2ecf20Sopenharmony_ci		 msic->vendor);
4058c2ecf20Sopenharmony_ci
4068c2ecf20Sopenharmony_ci	return 0;
4078c2ecf20Sopenharmony_ci}
4088c2ecf20Sopenharmony_ci
4098c2ecf20Sopenharmony_cistatic int intel_msic_remove(struct platform_device *pdev)
4108c2ecf20Sopenharmony_ci{
4118c2ecf20Sopenharmony_ci	struct intel_msic *msic = platform_get_drvdata(pdev);
4128c2ecf20Sopenharmony_ci
4138c2ecf20Sopenharmony_ci	intel_msic_remove_devices(msic);
4148c2ecf20Sopenharmony_ci
4158c2ecf20Sopenharmony_ci	return 0;
4168c2ecf20Sopenharmony_ci}
4178c2ecf20Sopenharmony_ci
4188c2ecf20Sopenharmony_cistatic struct platform_driver intel_msic_driver = {
4198c2ecf20Sopenharmony_ci	.probe		= intel_msic_probe,
4208c2ecf20Sopenharmony_ci	.remove		= intel_msic_remove,
4218c2ecf20Sopenharmony_ci	.driver		= {
4228c2ecf20Sopenharmony_ci		.name	= "intel_msic",
4238c2ecf20Sopenharmony_ci	},
4248c2ecf20Sopenharmony_ci};
4258c2ecf20Sopenharmony_cibuiltin_platform_driver(intel_msic_driver);
426