[mirror_ubuntu-hirsute-kernel.git] / drivers / hwtracing / intel_th / pci.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Intel(R) Trace Hub pci driver
 *
 * Copyright (C) 2014-2015 Intel Corporation.
 */

#define pr_fmt(fmt)	KBUILD_MODNAME ": " fmt

#include <linux/types.h>
#include <linux/module.h>
#include <linux/device.h>
#include <linux/sysfs.h>
#include <linux/pci.h>

#include "intel_th.h"

#define DRIVER_NAME "intel_th_pci"

#define BAR_MASK (BIT(TH_MMIO_CONFIG) | BIT(TH_MMIO_SW))

#define PCI_REG_NPKDSC	0x80
#define NPKDSC_TSACT	BIT(5)

static int intel_th_pci_activate(struct intel_th *th)
{
	struct pci_dev *pdev = to_pci_dev(th->dev);
	u32 npkdsc;
	int err;

	if (!INTEL_TH_CAP(th, tscu_enable))
		return 0;

	err = pci_read_config_dword(pdev, PCI_REG_NPKDSC, &npkdsc);
	if (!err) {
		npkdsc |= NPKDSC_TSACT;
		err = pci_write_config_dword(pdev, PCI_REG_NPKDSC, npkdsc);
	}

	if (err)
		dev_err(&pdev->dev, "failed to read NPKDSC register\n");

	return err;
}

static void intel_th_pci_deactivate(struct intel_th *th)
{
	struct pci_dev *pdev = to_pci_dev(th->dev);
	u32 npkdsc;
	int err;

	if (!INTEL_TH_CAP(th, tscu_enable))
		return;

	err = pci_read_config_dword(pdev, PCI_REG_NPKDSC, &npkdsc);
	if (!err) {
		npkdsc |= NPKDSC_TSACT;
		err = pci_write_config_dword(pdev, PCI_REG_NPKDSC, npkdsc);
	}

	if (err)
		dev_err(&pdev->dev, "failed to read NPKDSC register\n");
}

static int intel_th_pci_probe(struct pci_dev *pdev,
			      const struct pci_device_id *id)
{
	struct intel_th_drvdata *drvdata = (void *)id->driver_data;
	struct intel_th *th;
	int err;

	err = pcim_enable_device(pdev);
	if (err)
		return err;

	err = pcim_iomap_regions_request_all(pdev, BAR_MASK, DRIVER_NAME);
	if (err)
		return err;

	th = intel_th_alloc(&pdev->dev, drvdata, pdev->resource,
			    DEVICE_COUNT_RESOURCE, pdev->irq);
	if (IS_ERR(th))
		return PTR_ERR(th);

	th->activate   = intel_th_pci_activate;
	th->deactivate = intel_th_pci_deactivate;

	pci_set_master(pdev);

	return 0;
}

static void intel_th_pci_remove(struct pci_dev *pdev)
{
	struct intel_th *th = pci_get_drvdata(pdev);

	intel_th_free(th);
}

static const struct intel_th_drvdata intel_th_2x = {
	.tscu_enable	= 1,
};

static const struct pci_device_id intel_th_pci_id_table[] = {
	{
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x9d26),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa126),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Apollo Lake */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x5a8e),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Broxton */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x0a80),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Broxton B-step */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x1a8e),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Kaby Lake PCH-H */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa2a6),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Denverton */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x19e1),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Lewisburg PCH */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa1a6),
		.driver_data = (kernel_ulong_t)0,
	},
	{
		/* Gemini Lake */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x318e),
		.driver_data = (kernel_ulong_t)&intel_th_2x,
	},
	{
		/* Cannon Lake H */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa326),
		.driver_data = (kernel_ulong_t)&intel_th_2x,
	},
	{
		/* Cannon Lake LP */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x9da6),
		.driver_data = (kernel_ulong_t)&intel_th_2x,
	},
	{
		/* Cedar Fork PCH */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x18e1),
		.driver_data = (kernel_ulong_t)&intel_th_2x,
	},
	{
		/* Ice Lake PCH */
		PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x34a6),
		.driver_data = (kernel_ulong_t)&intel_th_2x,
	},
	{ 0 },
};

MODULE_DEVICE_TABLE(pci, intel_th_pci_id_table);

static struct pci_driver intel_th_pci_driver = {
	.name		= DRIVER_NAME,
	.id_table	= intel_th_pci_id_table,
	.probe		= intel_th_pci_probe,
	.remove		= intel_th_pci_remove,
};

module_pci_driver(intel_th_pci_driver);

MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("Intel(R) Trace Hub PCI controller driver");
MODULE_AUTHOR("Alexander Shishkin <alexander.shishkin@intel.com>");
Commit	Line	Data
50352fa7	1	// SPDX-License-Identifier: GPL-2.0
2b0b16d3 AS	2	/*
	3	* Intel(R) Trace Hub pci driver
	4	*
	5	* Copyright (C) 2014-2015 Intel Corporation.
2b0b16d3 AS	6	*/
	7
	8	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
	9
	10	#include <linux/types.h>
	11	#include <linux/module.h>
	12	#include <linux/device.h>
	13	#include <linux/sysfs.h>
	14	#include <linux/pci.h>
	15
	16	#include "intel_th.h"
	17
	18	#define DRIVER_NAME "intel_th_pci"
	19
	20	#define BAR_MASK (BIT(TH_MMIO_CONFIG) \| BIT(TH_MMIO_SW))
	21
a0e7df33 AS	22	#define PCI_REG_NPKDSC 0x80
	23	#define NPKDSC_TSACT BIT(5)
	24
	25	static int intel_th_pci_activate(struct intel_th *th)
	26	{
	27	struct pci_dev *pdev = to_pci_dev(th->dev);
	28	u32 npkdsc;
	29	int err;
	30
	31	if (!INTEL_TH_CAP(th, tscu_enable))
	32	return 0;
	33
	34	err = pci_read_config_dword(pdev, PCI_REG_NPKDSC, &npkdsc);
	35	if (!err) {
	36	npkdsc \|= NPKDSC_TSACT;
	37	err = pci_write_config_dword(pdev, PCI_REG_NPKDSC, npkdsc);
	38	}
	39
	40	if (err)
	41	dev_err(&pdev->dev, "failed to read NPKDSC register\n");
	42
	43	return err;
	44	}
	45
	46	static void intel_th_pci_deactivate(struct intel_th *th)
	47	{
	48	struct pci_dev *pdev = to_pci_dev(th->dev);
	49	u32 npkdsc;
	50	int err;
	51
	52	if (!INTEL_TH_CAP(th, tscu_enable))
	53	return;
	54
	55	err = pci_read_config_dword(pdev, PCI_REG_NPKDSC, &npkdsc);
	56	if (!err) {
	57	npkdsc \|= NPKDSC_TSACT;
	58	err = pci_write_config_dword(pdev, PCI_REG_NPKDSC, npkdsc);
	59	}
	60
	61	if (err)
	62	dev_err(&pdev->dev, "failed to read NPKDSC register\n");
	63	}
	64
2b0b16d3 AS	65	static int intel_th_pci_probe(struct pci_dev *pdev,
	66	const struct pci_device_id *id)
	67	{
3321371b	68	struct intel_th_drvdata drvdata = (void )id->driver_data;
2b0b16d3 AS	69	struct intel_th *th;
	70	int err;
	71
	72	err = pcim_enable_device(pdev);
	73	if (err)
	74	return err;
	75
	76	err = pcim_iomap_regions_request_all(pdev, BAR_MASK, DRIVER_NAME);
	77	if (err)
	78	return err;
	79
3321371b	80	th = intel_th_alloc(&pdev->dev, drvdata, pdev->resource,
2b0b16d3 AS	81	DEVICE_COUNT_RESOURCE, pdev->irq);
	82	if (IS_ERR(th))
	83	return PTR_ERR(th);
2b0b16d3	84
a0e7df33 AS	85	th->activate = intel_th_pci_activate;
	86	th->deactivate = intel_th_pci_deactivate;
	87
e9b2b3e7 AS	88	pci_set_master(pdev);
e9b2b3e7 AS	89
2b0b16d3 AS	90	return 0;
	91	}
	92
	93	static void intel_th_pci_remove(struct pci_dev *pdev)
	94	{
	95	struct intel_th *th = pci_get_drvdata(pdev);
	96
	97	intel_th_free(th);
	98	}
	99
a0e7df33 AS	100	static const struct intel_th_drvdata intel_th_2x = {
	101	.tscu_enable = 1,
	102	};
	103
2b0b16d3 AS	104	static const struct pci_device_id intel_th_pci_id_table[] = {
	105	{
	106	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x9d26),
	107	.driver_data = (kernel_ulong_t)0,
	108	},
	109	{
	110	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa126),
	111	.driver_data = (kernel_ulong_t)0,
	112	},
6396b912 AS	113	{
	114	/* Apollo Lake */
	115	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x5a8e),
	116	.driver_data = (kernel_ulong_t)0,
	117	},
3f040887 AS	118	{
	119	/* Broxton */
	120	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x0a80),
	121	.driver_data = (kernel_ulong_t)0,
	122	},
aaa3ca82 AS	123	{
	124	/* Broxton B-step */
	125	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x1a8e),
	126	.driver_data = (kernel_ulong_t)0,
	127	},
7a1a47ce AS	128	{
	129	/* Kaby Lake PCH-H */
	130	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa2a6),
	131	.driver_data = (kernel_ulong_t)0,
	132	},
5118ccd3 AS	133	{
	134	/* Denverton */
	135	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x19e1),
	136	.driver_data = (kernel_ulong_t)0,
	137	},
24600840 AS	138	{
	139	/* Lewisburg PCH */
	140	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa1a6),
	141	.driver_data = (kernel_ulong_t)0,
	142	},
340837f9 AS	143	{
	144	/* Gemini Lake */
	145	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x318e),
a0e7df33	146	.driver_data = (kernel_ulong_t)&intel_th_2x,
340837f9	147	},
84331e13 AS	148	{
	149	/* Cannon Lake H */
	150	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0xa326),
a0e7df33	151	.driver_data = (kernel_ulong_t)&intel_th_2x,
84331e13	152	},
efb3669e AS	153	{
	154	/* Cannon Lake LP */
	155	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x9da6),
a0e7df33	156	.driver_data = (kernel_ulong_t)&intel_th_2x,
efb3669e	157	},
920ce7c3 AS	158	{
	159	/* Cedar Fork PCH */
	160	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x18e1),
	161	.driver_data = (kernel_ulong_t)&intel_th_2x,
	162	},
59d08d00 AS	163	{
	164	/* Ice Lake PCH */
	165	PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x34a6),
	166	.driver_data = (kernel_ulong_t)&intel_th_2x,
	167	},
2b0b16d3 AS	168	{ 0 },
	169	};
	170
	171	MODULE_DEVICE_TABLE(pci, intel_th_pci_id_table);
	172
	173	static struct pci_driver intel_th_pci_driver = {
	174	.name = DRIVER_NAME,
	175	.id_table = intel_th_pci_id_table,
	176	.probe = intel_th_pci_probe,
	177	.remove = intel_th_pci_remove,
	178	};
	179
	180	module_pci_driver(intel_th_pci_driver);
	181
	182	MODULE_LICENSE("GPL v2");
	183	MODULE_DESCRIPTION("Intel(R) Trace Hub PCI controller driver");
	184	MODULE_AUTHOR("Alexander Shishkin <alexander.shishkin@intel.com>");