/* * Driver for the Intel P-Unit Mailbox IPC mechanism * * (C) Copyright 2015 Intel Corporation * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * The heart of the P-Unit is the Foxton microcontroller and its firmware, * which provide mailbox interface for power management usage. */ #include #include #include #include #include #include #include #include /* IPC Mailbox registers */ #define OFFSET_DATA_LOW 0x0 #define OFFSET_DATA_HIGH 0x4 /* bit field of interface register */ #define CMD_RUN BIT(31) #define CMD_ERRCODE_MASK GENMASK(7, 0) #define CMD_PARA1_SHIFT 8 #define CMD_PARA2_SHIFT 16 #define CMD_TIMEOUT_SECONDS 1 enum { BASE_DATA = 0, BASE_IFACE, BASE_MAX, }; typedef struct { struct device *dev; struct mutex lock; int irq; struct completion cmd_complete; /* base of interface and data registers */ void __iomem *base[RESERVED_IPC][BASE_MAX]; IPC_TYPE type; } IPC_DEV; static IPC_DEV *punit_ipcdev; static inline u32 ipc_read_status(IPC_DEV *ipcdev, IPC_TYPE type) { return readl(ipcdev->base[type][BASE_IFACE]); } static inline void ipc_write_cmd(IPC_DEV *ipcdev, IPC_TYPE type, u32 cmd) { writel(cmd, ipcdev->base[type][BASE_IFACE]); } static inline u32 ipc_read_data_low(IPC_DEV *ipcdev, IPC_TYPE type) { return readl(ipcdev->base[type][BASE_DATA] + OFFSET_DATA_LOW); } static inline u32 ipc_read_data_high(IPC_DEV *ipcdev, IPC_TYPE type) { return readl(ipcdev->base[type][BASE_DATA] + OFFSET_DATA_HIGH); } static inline void ipc_write_data_low(IPC_DEV *ipcdev, IPC_TYPE type, u32 data) { writel(data, ipcdev->base[type][BASE_DATA] + OFFSET_DATA_LOW); } static inline void ipc_write_data_high(IPC_DEV *ipcdev, IPC_TYPE type, u32 data) { writel(data, ipcdev->base[type][BASE_DATA] + OFFSET_DATA_HIGH); } static const char *ipc_err_string(int error) { if (error == IPC_PUNIT_ERR_SUCCESS) return "no error"; else if (error == IPC_PUNIT_ERR_INVALID_CMD) return "invalid command"; else if (error == IPC_PUNIT_ERR_INVALID_PARAMETER) return "invalid parameter"; else if (error == IPC_PUNIT_ERR_CMD_TIMEOUT) return "command timeout"; else if (error == IPC_PUNIT_ERR_CMD_LOCKED) return "command locked"; else if (error == IPC_PUNIT_ERR_INVALID_VR_ID) return "invalid vr id"; else if (error == IPC_PUNIT_ERR_VR_ERR) return "vr error"; else return "unknown error"; } static int intel_punit_ipc_check_status(IPC_DEV *ipcdev, IPC_TYPE type) { int loops = CMD_TIMEOUT_SECONDS * USEC_PER_SEC; int errcode; int status; if (ipcdev->irq) { if (!wait_for_completion_timeout(&ipcdev->cmd_complete, CMD_TIMEOUT_SECONDS * HZ)) { dev_err(ipcdev->dev, "IPC timed out\n"); return -ETIMEDOUT; } } else { while ((ipc_read_status(ipcdev, type) & CMD_RUN) && --loops) udelay(1); if (!loops) { dev_err(ipcdev->dev, "IPC timed out\n"); return -ETIMEDOUT; } } status = ipc_read_status(ipcdev, type); errcode = status & CMD_ERRCODE_MASK; if (errcode) { dev_err(ipcdev->dev, "IPC failed: %s, IPC_STS=0x%x\n", ipc_err_string(errcode), status); return -EIO; } return 0; } /** * intel_punit_ipc_simple_command() - Simple IPC command * @cmd: IPC command code. * @para1: First 8bit parameter, set 0 if not used. * @para2: Second 8bit parameter, set 0 if not used. * * Send a IPC command to P-Unit when there is no data transaction * * Return: IPC error code or 0 on success. */ int intel_punit_ipc_simple_command(int cmd, int para1, int para2) { IPC_DEV *ipcdev = punit_ipcdev; IPC_TYPE type; u32 val; int ret; mutex_lock(&ipcdev->lock); reinit_completion(&ipcdev->cmd_complete); type = (cmd & IPC_PUNIT_CMD_TYPE_MASK) >> IPC_TYPE_OFFSET; val = cmd & ~IPC_PUNIT_CMD_TYPE_MASK; val |= CMD_RUN | para2 << CMD_PARA2_SHIFT | para1 << CMD_PARA1_SHIFT; ipc_write_cmd(ipcdev, type, val); ret = intel_punit_ipc_check_status(ipcdev, type); mutex_unlock(&ipcdev->lock); return ret; } EXPORT_SYMBOL(intel_punit_ipc_simple_command); /** * intel_punit_ipc_command() - IPC command with data and pointers * @cmd: IPC command code. * @para1: First 8bit parameter, set 0 if not used. * @para2: Second 8bit parameter, set 0 if not used. * @in: Input data, 32bit for BIOS cmd, two 32bit for GTD and ISPD. * @out: Output data. * * Send a IPC command to P-Unit with data transaction * * Return: IPC error code or 0 on success. */ int intel_punit_ipc_command(u32 cmd, u32 para1, u32 para2, u32 *in, u32 *out) { IPC_DEV *ipcdev = punit_ipcdev; IPC_TYPE type; u32 val; int ret; mutex_lock(&ipcdev->lock); reinit_completion(&ipcdev->cmd_complete); type = (cmd & IPC_PUNIT_CMD_TYPE_MASK) >> IPC_TYPE_OFFSET; if (in) { ipc_write_data_low(ipcdev, type, *in); if (type == GTDRIVER_IPC || type == ISPDRIVER_IPC) ipc_write_data_high(ipcdev, type, *++in); } val = cmd & ~IPC_PUNIT_CMD_TYPE_MASK; val |= CMD_RUN | para2 << CMD_PARA2_SHIFT | para1 << CMD_PARA1_SHIFT; ipc_write_cmd(ipcdev, type, val); ret = intel_punit_ipc_check_status(ipcdev, type); if (ret) goto out; if (out) { *out = ipc_read_data_low(ipcdev, type); if (type == GTDRIVER_IPC || type == ISPDRIVER_IPC) *++out = ipc_read_data_high(ipcdev, type); } out: mutex_unlock(&ipcdev->lock); return ret; } EXPORT_SYMBOL_GPL(intel_punit_ipc_command); static irqreturn_t intel_punit_ioc(int irq, void *dev_id) { IPC_DEV *ipcdev = dev_id; complete(&ipcdev->cmd_complete); return IRQ_HANDLED; } static int intel_punit_get_bars(struct platform_device *pdev) { struct resource *res; void __iomem *addr; /* * The following resources are required * - BIOS_IPC BASE_DATA * - BIOS_IPC BASE_IFACE */ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); addr = devm_ioremap_resource(&pdev->dev, res); if (IS_ERR(addr)) return PTR_ERR(addr); punit_ipcdev->base[BIOS_IPC][BASE_DATA] = addr; res = platform_get_resource(pdev, IORESOURCE_MEM, 1); addr = devm_ioremap_resource(&pdev->dev, res); if (IS_ERR(addr)) return PTR_ERR(addr); punit_ipcdev->base[BIOS_IPC][BASE_IFACE] = addr; /* * The following resources are optional * - ISPDRIVER_IPC BASE_DATA * - ISPDRIVER_IPC BASE_IFACE * - GTDRIVER_IPC BASE_DATA * - GTDRIVER_IPC BASE_IFACE */ res = platform_get_resource(pdev, IORESOURCE_MEM, 2); if (res) { addr = devm_ioremap_resource(&pdev->dev, res); if (!IS_ERR(addr)) punit_ipcdev->base[ISPDRIVER_IPC][BASE_DATA] = addr; } res = platform_get_resource(pdev, IORESOURCE_MEM, 3); if (res) { addr = devm_ioremap_resource(&pdev->dev, res); if (!IS_ERR(addr)) punit_ipcdev->base[ISPDRIVER_IPC][BASE_IFACE] = addr; } res = platform_get_resource(pdev, IORESOURCE_MEM, 4); if (res) { addr = devm_ioremap_resource(&pdev->dev, res); if (!IS_ERR(addr)) punit_ipcdev->base[GTDRIVER_IPC][BASE_DATA] = addr; } res = platform_get_resource(pdev, IORESOURCE_MEM, 5); if (res) { addr = devm_ioremap_resource(&pdev->dev, res); if (!IS_ERR(addr)) punit_ipcdev->base[GTDRIVER_IPC][BASE_IFACE] = addr; } return 0; } static int intel_punit_ipc_probe(struct platform_device *pdev) { int irq, ret; punit_ipcdev = devm_kzalloc(&pdev->dev, sizeof(*punit_ipcdev), GFP_KERNEL); if (!punit_ipcdev) return -ENOMEM; platform_set_drvdata(pdev, punit_ipcdev); irq = platform_get_irq(pdev, 0); if (irq < 0) { punit_ipcdev->irq = 0; dev_warn(&pdev->dev, "Invalid IRQ, using polling mode\n"); } else { ret = devm_request_irq(&pdev->dev, irq, intel_punit_ioc, IRQF_NO_SUSPEND, "intel_punit_ipc", &punit_ipcdev); if (ret) { dev_err(&pdev->dev, "Failed to request irq: %d\n", irq); return ret; } punit_ipcdev->irq = irq; } ret = intel_punit_get_bars(pdev); if (ret) goto out; punit_ipcdev->dev = &pdev->dev; mutex_init(&punit_ipcdev->lock); init_completion(&punit_ipcdev->cmd_complete); out: return ret; } static int intel_punit_ipc_remove(struct platform_device *pdev) { return 0; } static const struct acpi_device_id punit_ipc_acpi_ids[] = { { "INT34D4", 0 }, { } }; static struct platform_driver intel_punit_ipc_driver = { .probe = intel_punit_ipc_probe, .remove = intel_punit_ipc_remove, .driver = { .name = "intel_punit_ipc", .acpi_match_table = ACPI_PTR(punit_ipc_acpi_ids), }, }; static int __init intel_punit_ipc_init(void) { return platform_driver_register(&intel_punit_ipc_driver); } static void __exit intel_punit_ipc_exit(void) { platform_driver_unregister(&intel_punit_ipc_driver); } MODULE_AUTHOR("Zha Qipeng "); MODULE_DESCRIPTION("Intel P-Unit IPC driver"); MODULE_LICENSE("GPL v2"); /* Some modules are dependent on this, so init earlier */ fs_initcall(intel_punit_ipc_init); module_exit(intel_punit_ipc_exit);