platform:x86: Add Intel telemetry platform device (48c19170) · Commits · e / devices / android_kernel_fairphone_FP4

drivers/platform/x86/intel_pmc_ipc.c

+96 −0

Original line number	Original line	Diff line number	Diff line
	@@ -70,6 +70,7 @@
	#define PLAT_RESOURCE_GCR_SIZE 0x1000		#define PLAT_RESOURCE_GCR_SIZE 0x1000
	#define PLAT_RESOURCE_BIOS_DATA_INDEX 1		#define PLAT_RESOURCE_BIOS_DATA_INDEX 1
	#define PLAT_RESOURCE_BIOS_IFACE_INDEX 2		#define PLAT_RESOURCE_BIOS_IFACE_INDEX 2
			#define PLAT_RESOURCE_TELEM_SSRAM_INDEX 3
	#define PLAT_RESOURCE_ISP_DATA_INDEX 4		#define PLAT_RESOURCE_ISP_DATA_INDEX 4
	#define PLAT_RESOURCE_ISP_IFACE_INDEX 5		#define PLAT_RESOURCE_ISP_IFACE_INDEX 5
	#define PLAT_RESOURCE_GTD_DATA_INDEX 6		#define PLAT_RESOURCE_GTD_DATA_INDEX 6
	@@ -88,6 +89,10 @@
	#define TCO_BASE_OFFSET 0x60		#define TCO_BASE_OFFSET 0x60
	#define TCO_REGS_SIZE 16		#define TCO_REGS_SIZE 16
	#define PUNIT_DEVICE_NAME "intel_punit_ipc"		#define PUNIT_DEVICE_NAME "intel_punit_ipc"
			#define TELEMETRY_DEVICE_NAME "intel_telemetry"
			#define TELEM_SSRAM_SIZE 240
			#define TELEM_PMC_SSRAM_OFFSET 0x1B00
			#define TELEM_PUNIT_SSRAM_OFFSET 0x1A00

	static const int iTCO_version = 3;		static const int iTCO_version = 3;

	@@ -110,6 +115,14 @@ static struct intel_pmc_ipc_dev {

	/* punit */		/* punit */
	struct platform_device *punit_dev;		struct platform_device *punit_dev;

			/* Telemetry */
			resource_size_t telem_pmc_ssram_base;
			resource_size_t telem_punit_ssram_base;
			int telem_pmc_ssram_size;
			int telem_punit_ssram_size;
			u8 telem_res_inval;
			struct platform_device *telemetry_dev;
	} ipcdev;		} ipcdev;

	static char *ipc_err_sources[] = {		static char *ipc_err_sources[] = {
	@@ -491,6 +504,18 @@ static struct itco_wdt_platform_data tco_info = {
	.version = 3,		.version = 3,
	};		};

			#define TELEMETRY_RESOURCE_PUNIT_SSRAM 0
			#define TELEMETRY_RESOURCE_PMC_SSRAM 1
			static struct resource telemetry_res[] = {
			/Telemetry/
			{
			.flags = IORESOURCE_MEM,
			},
			{
			.flags = IORESOURCE_MEM,
			},
			};

	static int ipc_create_punit_device(void)		static int ipc_create_punit_device(void)
	{		{
	struct platform_device *pdev;		struct platform_device *pdev;
	@@ -574,6 +599,51 @@ static int ipc_create_tco_device(void)
	return ret;		return ret;
	}		}

			static int ipc_create_telemetry_device(void)
			{
			struct platform_device *pdev;
			struct resource *res;
			int ret;

			pdev = platform_device_alloc(TELEMETRY_DEVICE_NAME, -1);
			if (!pdev) {
			dev_err(ipcdev.dev,
			"Failed to allocate telemetry platform device\n");
			return -ENOMEM;
			}

			pdev->dev.parent = ipcdev.dev;

			res = telemetry_res + TELEMETRY_RESOURCE_PUNIT_SSRAM;
			res->start = ipcdev.telem_punit_ssram_base;
			res->end = res->start + ipcdev.telem_punit_ssram_size - 1;

			res = telemetry_res + TELEMETRY_RESOURCE_PMC_SSRAM;
			res->start = ipcdev.telem_pmc_ssram_base;
			res->end = res->start + ipcdev.telem_pmc_ssram_size - 1;

			ret = platform_device_add_resources(pdev, telemetry_res,
			ARRAY_SIZE(telemetry_res));
			if (ret) {
			dev_err(ipcdev.dev,
			"Failed to add telemetry platform resources\n");
			goto err;
			}

			ret = platform_device_add(pdev);
			if (ret) {
			dev_err(ipcdev.dev,
			"Failed to add telemetry platform device\n");
			goto err;
			}
			ipcdev.telemetry_dev = pdev;

			return 0;
			err:
			platform_device_put(pdev);
			return ret;
			}

	static int ipc_create_pmc_devices(void)		static int ipc_create_pmc_devices(void)
	{		{
	int ret;		int ret;
	@@ -588,6 +658,14 @@ static int ipc_create_pmc_devices(void)
	dev_err(ipcdev.dev, "Failed to add punit platform device\n");		dev_err(ipcdev.dev, "Failed to add punit platform device\n");
	platform_device_unregister(ipcdev.tco_dev);		platform_device_unregister(ipcdev.tco_dev);
	}		}

			if (!ipcdev.telem_res_inval) {
			ret = ipc_create_telemetry_device();
			if (ret)
			dev_warn(ipcdev.dev,
			"Failed to add telemetry platform device\n");
			}

	return ret;		return ret;
	}		}

	@@ -692,6 +770,22 @@ static int ipc_plat_get_res(struct platform_device *pdev)
	ipcdev.gcr_size = PLAT_RESOURCE_GCR_SIZE;		ipcdev.gcr_size = PLAT_RESOURCE_GCR_SIZE;
	dev_info(&pdev->dev, "ipc res: %pR\n", res);		dev_info(&pdev->dev, "ipc res: %pR\n", res);

			ipcdev.telem_res_inval = 0;
			res = platform_get_resource(pdev, IORESOURCE_MEM,
			PLAT_RESOURCE_TELEM_SSRAM_INDEX);
			if (!res) {
			dev_err(&pdev->dev, "Failed to get telemetry ssram resource\n");
			ipcdev.telem_res_inval = 1;
			} else {
			ipcdev.telem_punit_ssram_base = res->start +
			TELEM_PUNIT_SSRAM_OFFSET;
			ipcdev.telem_punit_ssram_size = TELEM_SSRAM_SIZE;
			ipcdev.telem_pmc_ssram_base = res->start +
			TELEM_PMC_SSRAM_OFFSET;
			ipcdev.telem_pmc_ssram_size = TELEM_SSRAM_SIZE;
			dev_info(&pdev->dev, "telemetry ssram res: %pR\n", res);
			}

	return 0;		return 0;
	}		}

	@@ -749,6 +843,7 @@ static int ipc_plat_probe(struct platform_device *pdev)
	err_irq:		err_irq:
	platform_device_unregister(ipcdev.tco_dev);		platform_device_unregister(ipcdev.tco_dev);
	platform_device_unregister(ipcdev.punit_dev);		platform_device_unregister(ipcdev.punit_dev);
			platform_device_unregister(ipcdev.telemetry_dev);
	err_device:		err_device:
	iounmap(ipcdev.ipc_base);		iounmap(ipcdev.ipc_base);
	res = platform_get_resource(pdev, IORESOURCE_MEM,		res = platform_get_resource(pdev, IORESOURCE_MEM,
	@@ -766,6 +861,7 @@ static int ipc_plat_remove(struct platform_device *pdev)
	free_irq(ipcdev.irq, &ipcdev);		free_irq(ipcdev.irq, &ipcdev);
	platform_device_unregister(ipcdev.tco_dev);		platform_device_unregister(ipcdev.tco_dev);
	platform_device_unregister(ipcdev.punit_dev);		platform_device_unregister(ipcdev.punit_dev);
			platform_device_unregister(ipcdev.telemetry_dev);
	iounmap(ipcdev.ipc_base);		iounmap(ipcdev.ipc_base);
	res = platform_get_resource(pdev, IORESOURCE_MEM,		res = platform_get_resource(pdev, IORESOURCE_MEM,
	PLAT_RESOURCE_IPC_INDEX);		PLAT_RESOURCE_IPC_INDEX);