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