PCI: EP: Add RC-to-EP doorbell with platform MSI controller
Subsystems (6)
Frank Li
maintainerv10 cover PCI: EP: Add RC-to-EP doorbell with platform MSI controller
┌────────────┐ ┌───────────────────────────────────┐ ┌────────────────┐ │ │ │ │ │ │ │ │ │ PCI Endpoint │ │ PCI Host │ │ │ │ │ │ │ │ │◄──┤ 1.platform_msi_domain_alloc_irqs()│ │ │ │ │ │ │ │ │ │ MSI ├──►│ 2.write_msi_msg() ├──►├─BAR<n> │ │ Controller │ │ update doorbell register address│ │ │ │ │ │ for BAR │ │ │ │ │ │ │ │ 3. Write BAR<n>│ │ │◄──┼───────────────────────────────────┼───┤ │ │ │ │ │ │ │ │ ├──►│ 4.Irq Handle │ │ │ │ │ │ │ │ │ │ │ │ │ │ │ └────────────┘ └───────────────────────────────────┘ └────────────────┘
This patches based on old https://lore.kernel.org/imx/[email protected]/
Original patch only target to vntb driver. But actually it is common method.
This patches add new API to pci-epf-core, so any EP driver can use it.
Previous v2 discussion here.
https://lore.kernel.org/imx/[email protected]/
Changes in v10:
Thomas Gleixner:
There are big change in pci-ep-msi.c. I am sure if go on the
corrent path. The key improvement is remove only 1 function devices's limitation.
I use new patch for imutable check, which relative additional
feature compared to base enablement patch.
- Remove patch Add msi_remove_device_irq_domain() in platform_device_msi_free_irqs_all()
- Add new patch irqchip/gic-v3-its: Avoid overwriting msi_prepare callback if provided by msi_domain_info
- Remove only support 1 endpoint function limiation.
- Create one MSI domain for each endpoint function devices.
- Use "msi-map" in pci ep controler node, instead of of msi-parent. first
argument is
(func_no << 8 | vfunc_no)
- Link to v9: https://lore.kernel.org/r/[email protected]
Changes in v9
- Add patch platform-msi: Add msi_remove_device_irq_domain() in platform_device_msi_free_irqs_all()
- Remove patch PCI: endpoint: Add pci_epc_get_fn() API for customizable filtering
- Remove API pci_epf_align_inbound_addr_lo_hi
- Move doorbell_alloc in to doorbell_enable function.
- Link to v8: https://lore.kernel.org/r/[email protected]
Changes in v8:
- update helper function name to pci_epf_align_inbound_addr()
- Link to v7: https://lore.kernel.org/r/[email protected]
Changes in v7:
- Add helper function pci_epf_align_addr();
- Link to v6: https://lore.kernel.org/r/[email protected]
Changes in v6:
- change doorbell_addr to doorbell_offset
- use round_down()
- add Niklas's test by tag
- rebase to pci/endpoint
- Link to v5: https://lore.kernel.org/r/[email protected]
Changes in v5:
- Move request_irq to epf test function driver for more flexiable user case
- Add fixed size bar handler
- Some minor improvememtn to see each patches's changelog.
- Link to v4: https://lore.kernel.org/r/[email protected]
Changes in v4:
- Remove patch genirq/msi: Add cleanup guard define for msi_lock_descs()/msi_unlock_descs()
- Use new method to avoid compatible problem.
Add new command DOORBELL_ENABLE and DOORBELL_DISABLE.
pcitest -B send DOORBELL_ENABLE first, EP test function driver try to
remap one of BAR_N (except test register bar) to ITS MSI MMIO space. Old driver don't support new command, so failure return, not side effect.
After test, DOORBELL_DISABLE command send out to recover original map, so
pcitest bar test can pass as normal.
- Other detail change see each patches's change log
- Link to v3: https://lore.kernel.org/r/[email protected]
Change from v2 to v3
- Fixed manivannan's comments
- Move common part to pci-ep-msi.c and pci-ep-msi.h
- rebase to 6.12-rc1
- use RevID to distingiush old version
mkdir /sys/kernel/config/pci_ep/functions/pci_epf_test/func1
echo 16 > /sys/kernel/config/pci_ep/functions/pci_epf_test/func1/msi_interrupts
echo 0x080c > /sys/kernel/config/pci_ep/functions/pci_epf_test/func1/deviceid
echo 0x1957 > /sys/kernel/config/pci_ep/functions/pci_epf_test/func1/vendorid
echo 1 > /sys/kernel/config/pci_ep/functions/pci_epf_test/func1/revid
^^^^^^ to enable platform msi support.
ln -s /sys/kernel/config/pci_ep/functions/pci_epf_test/func1 /sys/kernel/config/pci_ep/controllers/4c380000.pcie-ep
- use new device ID, which identify support doorbell to avoid broken compatility.
Enable doorbell support only for PCI_DEVICE_ID_IMX8_DB, while other devices keep the same behavior as before.
EP side RC with old driver RC with new driver
PCI_DEVICE_ID_IMX8_DB no probe doorbell enabled
Other device ID doorbell disabled* doorbell disabled*
* Behavior remains unchanged.
Change from v1 to v2
- Add missed patch for endpont/pci-epf-test.c
- Move alloc and free to epc driver from epf.
- Provide general help function for EPC driver to alloc platform msi irq.
- Fixed manivannan's comments.
To: Manivannan Sadhasivam <[email protected]>
To: Krzysztof Wilczyński <[email protected]>
To: Kishon Vijay Abraham I <[email protected]>
To: Bjorn Helgaas <[email protected]>
To: Arnd Bergmann <[email protected]>
To: Greg Kroah-Hartman <[email protected]>
Cc: [email protected]
Cc: [email protected]
Cc: [email protected]
Cc: Niklas Cassel <[email protected]>
Cc: [email protected]
Cc: [email protected]
To: Rafael J. Wysocki <[email protected]>
To: Thomas Gleixner <[email protected]>
To: Anup Patel <[email protected]>
To: Kishon Vijay Abraham I <[email protected]>
To: Marc Zyngier <[email protected]>
To: Thomas Gleixner <[email protected]>
Cc: [email protected]
---
Frank Li (7):
irqchip/gic-v3-its: Avoid overwriting msi_prepare callback if provided by msi_domain_info
PCI: endpoint: Add RC-to-EP doorbell support using platform MSI controller
PCI: endpoint: pci-ep-msi: Add MSI address/data pair mutable check
PCI: endpoint: Add pci_epf_align_inbound_addr() helper for address alignment
PCI: endpoint: pci-epf-test: Add doorbell test support
misc: pci_endpoint_test: Add doorbell test case
tools: PCI: Add 'B' option for test doorbell
drivers/irqchip/irq-gic-v3-its-msi-parent.c | 3 +- drivers/misc/pci_endpoint_test.c | 80 +++++++++++++ drivers/pci/endpoint/Makefile | 2 +- drivers/pci/endpoint/functions/pci-epf-test.c | 132 ++++++++++++++++++++++ drivers/pci/endpoint/pci-ep-msi.c | 156 ++++++++++++++++++++++++++ drivers/pci/endpoint/pci-epf-core.c | 44 ++++++++ include/linux/msi.h | 2 + include/linux/pci-ep-msi.h | 15 +++ include/linux/pci-epf.h | 19 ++++ include/uapi/linux/pcitest.h | 1 + tools/pci/pcitest.c | 16 ++- 11 files changed, 467 insertions(+), 3 deletions(-)
---
base-commit: f134785ecf3bd881a10f83dccacdcea2ac45e673
change-id: 20241010-ep-msi-8b4cab33b1be
Best regards,
---
Frank Li <[email protected]>
Frank Li
maintainerPATCH v10 1/7 irqchip/gic-v3-its: Avoid overwriting msi_prepare callback if provided by msi_domain_info
┌───────────────────────────────┐ ┌───────┐
│ │ │ │
│ PCI Endpoint Controller (1) ├───►│ ITS │
│ │ │ │
└───────────────────────────────┘ └───────┘
▲ ▲
│ │
┌───┴──┐ ┌──┴───┐
│ │ │ │
│Func1 │ │Func2 │
│ (2) │ │ │
└──────┘ └──────┘
▲ ▲
│ │
└─────────┴─────────────── PCIe Bus(1) is platform device, which is generally descripted by Device Tree(DT).
(2) Func1 and Func2 is created by configfs
The current platform MSI API supports only a single device. For instance, a platform device (e.g., PCI Endpoint Controller) calls platform_device_msi_init_and_alloc_irqs() to allocate MSI IRQs.
Child devices (e.g., function devices created by configfs) require individual MSI domains, with the same MSI parent domain as the parent device. These individual domains need specialized msi_prepare callbacks to set msi_alloc_info_t. However, the current ITS implementation overwrites the msi_prepare callback with its_pmsi_prepare().
Modify the implementation to assign its_pmsi_prepare() only if msi_domain_info::msi_prepare is NULL, allowing customized callbacks where needed.
---
Change from v9 to v10
- new patch
--- drivers/irqchip/irq-gic-v3-its-msi-parent.c | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-)
drivers/irqchip/irq-gic-v3-its-msi-parent.c +2 -1
@@ -195,7 +195,8 @@ static bool its_init_dev_msi_info(struct device *dev, struct irq_domain *domain,* FIXME: See the above PCI prepare comment. The domain * size is also known at domain creation time. */ - info->ops->msi_prepare = its_pmsi_prepare; +if (!info->ops->msi_prepare) + info->ops->msi_prepare = its_pmsi_prepare;break ;default :/* Confused. How did the lib return true? */
Signature · 1 line
2.34.1
Frank Li
maintainerPATCH v10 2/7 PCI: endpoint: Add RC-to-EP doorbell support using platform MSI controller
In reply to Frank LiDoorbell feature is implemented by mapping the EP's MSI interrupt controller message address to a dedicated BAR in the EPC core. It is the responsibility of the EPF driver to pass the actual message data to be written by the host to the doorbell BAR region through its own logic.
---
Change from v9 to v10
- Create msi domain for each function device.
- Remove only function support limiation. My hardware only support one function, so not test more than one case.
- use "msi-map" descript msi information
msi-map = <func_no << 8 | vfunc_no, &its, start_stream_id, size>;
Chagne from v8 to v9
- sort header file
- use pci_epc_get(dev_name(msi_desc_to_dev(desc)));
- check epf number at pci_epf_alloc_doorbell
- Add comments for miss msi-parent case
change from v5 to v8
-none
Change from v4 to v5
- Remove request_irq() in pci_epc_alloc_doorbell() and leave to EP function driver, so ep function driver can register differece call back function for difference doorbell events and set irq affinity to differece CPU core.
- Improve error message when MSI allocate failure.
Change from v3 to v4
- msi change to use msi_get_virq() avoid use msi_for_each_desc().
- add new struct for pci_epf_doorbell_msg to msi msg,virq and irq name.
- move mutex lock to epc function
- initialize variable at declear place.
- passdown epf to epc*() function to simplify code.
--- drivers/pci/endpoint/Makefile | 2 +- drivers/pci/endpoint/pci-ep-msi.c | 148 ++++++++++++++++++++++++++++++++++++++ include/linux/pci-ep-msi.h | 15 ++++ include/linux/pci-epf.h | 16 +++++ 4 files changed, 180 insertions(+), 1 deletion(-)
drivers/pci/endpoint/Makefile +1 -1
@@ -5,4 +5,4 @@ obj-$(CONFIG_PCI_ENDPOINT_CONFIGFS) += pci-ep-cfs.o obj-$(CONFIG_PCI_ENDPOINT) += pci-epc-core.o pci-epf-core.o\ - pci-epc-mem.o functions/ + pci-epc-mem.o pci-ep-msi.o functions/
drivers/pci/endpoint/pci-ep-msi.c new file +148 -0
148 lines not on this page · raw message
include/linux/pci-ep-msi.h new file +15 -0
@@ -0,0 +1,15 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* +* PCI Endpoint *Function* side MSI header file +* +* Copyright (C) 2024 NXP +* Author: Frank Li <[email protected]> +*/ + +#ifndef __PCI_EP_MSI__ +#define __PCI_EP_MSI__ + +int pci_epf_alloc_doorbell (struct pci_epf *epf,u16 nums); +void pci_epf_free_doorbell (struct pci_epf *epf); + +#endif /* __PCI_EP_MSI__ */
include/linux/pci-epf.h +16 -0
@@ -12,6 +12,7 @@#include <linux/configfs.h> #include <linux/device.h> #include <linux/mod_devicetable.h> +#include <linux/msi.h> #include <linux/pci.h> struct pci_epf ;
@@ -125,6 +126,17 @@ struct pci_epf_bar {int flags; }; +/** +* struct pci_epf_doorbell_msg - represents doorbell message +* @msi_msg: MSI message +* @virq: irq number of this doorbell MSI message +* @name: irq name for doorbell interrupt +*/ +struct pci_epf_doorbell_msg { +struct msi_msg msg; +int virq; +}; +/** * struct pci_epf - represents the PCI EPF device * @dev: the PCI EPF device
@@ -152,6 +164,8 @@ struct pci_epf_bar {* @vfunction_num_map: bitmap to manage virtual function number * @pci_vepf: list of virtual endpoint functions associated with this function * @event_ops: Callbacks for capturing the EPC events +* @db_msg: data for MSI from RC side +* @num_db: number of doorbells */ struct pci_epf {struct device dev;
@@ -182,6 +196,8 @@ struct pci_epf {unsigned long vfunction_num_map;struct list_head pci_vepf;const struct pci_epc_event_ops *event_ops; +struct pci_epf_doorbell_msg *db_msg; +u16 num_db; };/**
Signature · 1 line
2.34.1
Frank Li
maintainerPATCH v10 3/7 PCI: endpoint: pci-ep-msi: Add MSI address/data pair mutable check
In reply to Frank LiSome MSI controller change address/data pair when irq_set_affinity(). Current PCI endpoint can't support this type MSI controller. So add flag MSI_FLAG_MUTABLE in include/linux/msi.h and check it when allocate doorbell.
---
Change from v9 to v10
- new patch
--- drivers/pci/endpoint/pci-ep-msi.c | 8 ++++++++ include/linux/msi.h | 2 ++ 2 files changed, 10 insertions(+)
drivers/pci/endpoint/pci-ep-msi.c +8 -0
@@ -107,6 +107,14 @@ int pci_epf_alloc_doorbell(struct pci_epf *epf, u16 num_db)return -EINVAL ; } +if (!dom->msi_parent_ops) +return -EINVAL ; + +if (dom->msi_parent_ops->supported_flags &MSI_FLAG_MUTABLE ) { +dev_err (dev,"Can't support mutable address/data pair MSI controller\n" ); +return -EINVAL ; + } +dev_set_msi_domain (dev, dom); msg =kcalloc (num_db,sizeof (struct pci_epf_doorbell_msg ),GFP_KERNEL );
include/linux/msi.h +2 -0
@@ -556,6 +556,8 @@ enum {MSI_FLAG_PCI_MSIX_ALLOC_DYN = (1 <<20 ),/* PCI MSIs cannot be steered separately to CPU cores */ MSI_FLAG_NO_AFFINITY = (1 <<21 ), +/* Address and data pair is mutable when irq_set_affinity() */ + MSI_FLAG_MUTABLE = (1 << 22), };/**
Signature · 1 line
2.34.1
Re: [PATCH v10 3/7] PCI: endpoint: pci-ep-msi: Add MSI address/data pair mutable check
Quoted 4 lines · Frank Li
Some MSI controller change address/data pair when
irq_set_affinity(). Current PCI endpoint can't support this type MSI controller. So add flagMSI_FLAG_MUTABLEininclude/linux/msi.hand check it when allocate doorbell.
Q: Who is going to annotate the affected domains with that flag?
A: Nobody.
Q: What's the value of the flag?
A: Zero, as as it prevents exactly nothing.
You want a MSI_FLAG_MSG_IMMUTABLE and set that on the domains which provide it. That way you ensure that someone looked at the domain to validate it.
Thanks,
tglx
Frank Li
maintainerRe: [PATCH v10 3/7] PCI: endpoint: pci-ep-msi: Add MSI address/data pair mutable check
Quoted 10 lines · Thomas Gleixner
Quoted 4 lines · Frank Li
Some MSI controller change address/data pair when
irq_set_affinity(). Current PCI endpoint can't support this type MSI controller. So add flagMSI_FLAG_MUTABLEininclude/linux/msi.hand check it when allocate doorbell.Q: Who is going to annotate the affected domains with that flag?
A: Nobody.
Quoted 7 lines
Q: What's the value of the flag?
A: Zero, as as it prevents exactly nothing.
You want a
MSI_FLAG_MSG_IMMUTABLEand set that on the domains which provide it. That way you ensure that someone looked at the domain to validate it.
Okay, at beginning I think most MSI controller is immutable. So I use MSI_FLAG_MSG_MUTABLE.
It is fine change to MSI_FLAG_MSG_IMMUTABLE.
Frank
Quoted 4 lines
Thanks,
tglx
Re: [PATCH v10 3/7] PCI: endpoint: pci-ep-msi: Add MSI address/data pair mutable check
Quoted 7 lines · Frank Li
Quoted 3 lines · Thomas Gleixner
You want a
MSI_FLAG_MSG_IMMUTABLEand set that on the domains which provide it. That way you ensure that someone looked at the domain to validate it.Okay, at beginning I think most MSI controller is immutable. So I use
MSI_FLAG_MSG_MUTABLE.
If you want to do that then _you_ have to go through every single interrupt controllers, validate and opt-out in case it does change the message. Otherwise that flag is completely pointless.
Instead of adding the IMMUTABLE flag for one controller you know and then let others who want to utilize this amend their controllers.
Opt-in is less work and more safe than opt-out. See?
Thanks,
tglx
Frank Li
maintainerPATCH v10 4/7 PCI: endpoint: Add pci_epf_align_inbound_addr() helper for address alignment
In reply to Frank LiIntroduce the helper function pci_epf_align_inbound_addr() to adjust addresses according to PCI BAR alignment requirements, converting addresses into base and offset values.
---
Change form v9 to v10
- none
change from v8 to v9
- pci_epf_align_inbound_addr(), base and off must be not NULL
- rm pci_epf_align_inbound_addr_lo_hi()
change from v7 to v8
- change name to pci_epf_align_inbound_addr()
- update comment said only need for memory, which not allocated by pci_epf_alloc_space().
change from v6 to v7
- new patch
--- drivers/pci/endpoint/pci-epf-core.c | 44 +++++++++++++++++++++++++++++++++++++ include/linux/pci-epf.h | 3 +++ 2 files changed, 47 insertions(+)
drivers/pci/endpoint/pci-epf-core.c +44 -0
@@ -464,6 +464,50 @@ struct pci_epf *pci_epf_create(const char *name) }EXPORT_SYMBOL_GPL (pci_epf_create); +/** +* pci_epf_align_inbound_addr() - Get base address and offset that match BAR's +* alignment requirement +* @epf: the EPF device +* @addr: the address of the memory +* @bar: the BAR number corresponding to map addr +* @base: return base address, which match BAR's alignment requirement. +* @off: return offset. +* +* Helper function to convert input 'addr' to base and offset, which match +* BAR's alignment requirement. +* +* The pci_epf_alloc_space() function already accounts for alignment. This is +* primarily intended for use with other memory regions not allocated by +* pci_epf_alloc_space(), such as peripheral register spaces or the trigger +* address for a platform MSI controller. +*/ +int pci_epf_align_inbound_addr (struct pci_epf *epf,enum pci_barno bar, +u64 addr,u64 *base,size_t *off) +{ +const struct pci_epc_features *epc_features; +u64 align; + +if (!base || !off) +return -EINVAL ; + + epc_features =pci_epc_get_features (epf->epc, epf->func_no, epf->vfunc_no); +if (!epc_features) { +dev_err (&epf->dev,"epc_features not implemented\n" ); +return -EOPNOTSUPP ; + } + + align = epc_features->align; + align = align ? align :128 ; +if (epc_features->bar[bar].type ==BAR_FIXED ) + align =max (epc_features->bar[bar].fixed_size, align); + + *base =round_down (addr, align); + *off = addr & (align -1 ); + +return 0 ; +} +EXPORT_SYMBOL_GPL (pci_epf_align_inbound_addr); +static void pci_epf_dev_release (struct device *dev) {struct pci_epf *epf =to_pci_epf (dev);
include/linux/pci-epf.h +3 -0
@@ -238,6 +238,9 @@ void *pci_epf_alloc_space(struct pci_epf *epf, size_t size, enum pci_barno bar, enum pci_epc_interface_type type);void pci_epf_free_space (struct pci_epf *epf,void *addr,enum pci_barno bar,enum pci_epc_interface_type type); + +int pci_epf_align_inbound_addr (struct pci_epf *epf,enum pci_barno bar, +u64 addr,u64 *base,size_t *off);int pci_epf_bind (struct pci_epf *epf);void pci_epf_unbind (struct pci_epf *epf);int pci_epf_add_vepf (struct pci_epf *epf_pf,struct pci_epf *epf_vf);
Signature · 1 line
2.34.1
Frank Li
maintainerPATCH v10 5/7 PCI: endpoint: pci-epf-test: Add doorbell test support
In reply to Frank LiAdd three registers: doorbell_bar, doorbell_addr, and doorbell_data. Use pci_epf_alloc_doorbell() to allocate a doorbell address space.
Enable the Root Complex (RC) side driver to trigger pci-epc-test's doorbell callback handler by writing doorbell_data to the mapped doorbell_bar's address space.
Set STATUS_DOORBELL_SUCCESS in the doorbell callback to indicate completion.
Avoid breaking compatibility between host and endpoint, add new command COMMAND_ENABLE_DOORBELL and COMMAND_DISABLE_DOORBELL. Host side need send COMMAND_ENABLE_DOORBELL to map one bar's inbound address to MSI space. the command COMMAND_DISABLE_DOORBELL to recovery original inbound address mapping.
Host side new driver Host side old driver
EP: new driver S F
EP: old driver F F
S: If EP side support MSI, 'pcitest -B' return success.
If EP side doesn't support MSI, the same to 'F'.
F: 'pcitest -B' return failure, other case as usual.
---
Change from v9 to v10
- none
Change from v8 to v9
- move pci_epf_alloc_doorbell() into pci_epf_{enable/disable}_doorbell().
- remove doorbell_done in commit message.
- rename pci_epf_{enable/disable}_doorbell() to pci_epf_test_{enable/disable}_doorbell() to align corrent code style.
Change from v7 to v8
- rename to pci_epf_align_inbound_addr_lo_hi()
Change from v6 to v7
- use help function pci_epf_align_addr_lo_hi()
Change from v5 to v6
- rename doorbell_addr to doorbell_offset
Chagne from v4 to v5
- Add doorbell free at unbind function.
- Move msi irq handler to here to more complex user case, such as differece doorbell can use difference handler function.
- Add Niklas's code to handle fixed bar's case. If need add your signed-off tag or co-developer tag, please let me know.
change from v3 to v4
- remove revid requirement
- Add command COMMAND_ENABLE_DOORBELL and COMMAND_DISABLE_DOORBELL.
- call pci_epc_set_bar() to map inbound address to MSI space only at COMMAND_ENABLE_DOORBELL.
--- drivers/pci/endpoint/functions/pci-epf-test.c | 132 ++++++++++++++++++++++++++ 1 file changed, 132 insertions(+)
drivers/pci/endpoint/functions/pci-epf-test.c +132 -0
@@ -11,12 +11,14 @@#include <linux/dmaengine.h> #include <linux/io.h> #include <linux/module.h> +#include <linux/msi.h> #include <linux/slab.h> #include <linux/pci_ids.h> #include <linux/random.h> #include <linux/pci-epc.h> #include <linux/pci-epf.h> +#include <linux/pci-ep-msi.h> #include <linux/pci_regs.h> #define IRQ_TYPE_INTX 0
@@ -29,6 +31,8 @@#define COMMAND_READ BIT(3)#define COMMAND_WRITE BIT(4)#define COMMAND_COPY BIT(5) +#define COMMAND_ENABLE_DOORBELL BIT(6) +#define COMMAND_DISABLE_DOORBELL BIT(7)#define STATUS_READ_SUCCESS BIT(0)#define STATUS_READ_FAIL BIT(1)
@@ -39,6 +43,11 @@#define STATUS_IRQ_RAISED BIT(6)#define STATUS_SRC_ADDR_INVALID BIT(7)#define STATUS_DST_ADDR_INVALID BIT(8) +#define STATUS_DOORBELL_SUCCESS BIT(9) +#define STATUS_DOORBELL_ENABLE_SUCCESS BIT(10) +#define STATUS_DOORBELL_ENABLE_FAIL BIT(11) +#define STATUS_DOORBELL_DISABLE_SUCCESS BIT(12) +#define STATUS_DOORBELL_DISABLE_FAIL BIT(13)#define FLAG_USE_DMA BIT(0)
@@ -74,6 +83,9 @@ struct pci_epf_test_reg {u32 irq_type;u32 irq_number;u32 flags; +u32 doorbell_bar; +u32 doorbell_offset; +u32 doorbell_data; } __packed;static struct pci_epf_header test_header = {
@@ -642,6 +654,117 @@ static void pci_epf_test_raise_irq(struct pci_epf_test *epf_test, } } +static irqreturn_t pci_epf_test_doorbell_handler (int irq,void *data) +{ +struct pci_epf_test *epf_test = data; +enum pci_barno test_reg_bar = epf_test->test_reg_bar; +struct pci_epf_test_reg *reg = epf_test->reg[test_reg_bar]; + + reg->status |=STATUS_DOORBELL_SUCCESS ; +pci_epf_test_raise_irq (epf_test, reg); + +return IRQ_HANDLED ; +} + +static void pci_epf_test_doorbell_cleanup (struct pci_epf_test *epf_test) +{ +struct pci_epf_test_reg *reg = epf_test->reg[epf_test->test_reg_bar]; +struct pci_epf *epf = epf_test->epf; + +if (reg->doorbell_bar >0 ) { +free_irq (epf->db_msg[0 ].virq, epf_test); + reg->doorbell_bar =NO_BAR ; + } + +if (epf->db_msg) +pci_epf_free_doorbell (epf); +} + +static void pci_epf_test_enable_doorbell (struct pci_epf_test *epf_test, +struct pci_epf_test_reg *reg) +{ +struct pci_epf *epf = epf_test->epf; +struct pci_epf_bar db_bar = {}; +struct pci_epc *epc = epf->epc; +struct msi_msg *msg; +enum pci_barno bar; +size_t offset; +int ret; + + ret =pci_epf_alloc_doorbell (epf,1 ); +if (ret) { + reg->status |=STATUS_DOORBELL_ENABLE_FAIL ; +return ; + } + + msg = &epf->db_msg[0 ].msg; + bar =pci_epc_get_next_free_bar (epf_test->epc_features, epf_test->test_reg_bar +1 ); +if (bar <BAR_0 || bar == epf_test->test_reg_bar || !epf->db_msg) { + reg->status |=STATUS_DOORBELL_ENABLE_FAIL ; +return ; + } + + ret =request_irq (epf->db_msg[0 ].virq, pci_epf_test_doorbell_handler,0 , +"pci-test-doorbell" , epf_test); +if (ret) { +dev_err (&epf->dev, +"Failed to request irq %d, doorbell feature is not supported\n" , + epf->db_msg[0 ].virq); + reg->status |=STATUS_DOORBELL_ENABLE_FAIL ; +pci_epf_test_doorbell_cleanup (epf_test); +return ; + } + + reg->doorbell_data = msg->data; + reg->doorbell_bar = bar; + + msg = &epf->db_msg[0 ].msg; + ret =pci_epf_align_inbound_addr (epf, bar, ((u64 )msg->address_hi <<32 ) | msg->address_lo, + &db_bar.phys_addr, &offset); + +if (ret) { + reg->status |=STATUS_DOORBELL_ENABLE_FAIL ; +pci_epf_test_doorbell_cleanup (epf_test); +return ; + } + + reg->doorbell_offset = offset; + + db_bar.barno = bar; + db_bar.size = epf->bar[bar].size; + db_bar.flags = epf->bar[bar].flags; + + ret =pci_epc_set_bar (epc, epf->func_no, epf->vfunc_no, &db_bar); +if (ret) { + reg->status |=STATUS_DOORBELL_ENABLE_FAIL ; +pci_epf_test_doorbell_cleanup (epf_test); + }else { + reg->status |=STATUS_DOORBELL_ENABLE_SUCCESS ; + } +} + +static void pci_epf_test_disable_doorbell (struct pci_epf_test *epf_test, +struct pci_epf_test_reg *reg) +{ +enum pci_barno bar = reg->doorbell_bar; +struct pci_epf *epf = epf_test->epf; +struct pci_epc *epc = epf->epc; +int ret; + +if (bar <BAR_0 || bar == epf_test->test_reg_bar || !epf->db_msg) { + reg->status |=STATUS_DOORBELL_DISABLE_FAIL ; +return ; + } + + ret =pci_epc_set_bar (epc, epf->func_no, epf->vfunc_no, &epf->bar[bar]); +if (ret) + reg->status |=STATUS_DOORBELL_DISABLE_FAIL ; +else + reg->status |=STATUS_DOORBELL_DISABLE_SUCCESS ; + +pci_epf_test_doorbell_cleanup (epf_test); +} +static void pci_epf_test_cmd_handler (struct work_struct *work) {u32 command;
@@ -688,6 +811,14 @@ static void pci_epf_test_cmd_handler(struct work_struct *work)pci_epf_test_copy (epf_test, reg);pci_epf_test_raise_irq (epf_test, reg);break ; +case COMMAND_ENABLE_DOORBELL : +pci_epf_test_enable_doorbell (epf_test, reg); +pci_epf_test_raise_irq (epf_test, reg); +break ; +case COMMAND_DISABLE_DOORBELL : +pci_epf_test_disable_doorbell (epf_test, reg); +pci_epf_test_raise_irq (epf_test, reg); +break ;default :dev_err (dev,"Invalid command 0x%x\n" , command);break ;
@@ -934,6 +1065,7 @@ static void pci_epf_test_unbind(struct pci_epf *epf)pci_epf_test_clean_dma_chan (epf_test);pci_epf_test_clear_bar (epf); } +pci_epf_test_doorbell_cleanup (epf_test);pci_epf_test_free_space (epf); }
Signature · 1 line
2.34.1
Frank Li
maintainerPATCH v10 6/7 misc: pci_endpoint_test: Add doorbell test case
In reply to Frank LiAdd three registers: PCIE_ENDPOINT_TEST_DB_BAR, PCIE_ENDPOINT_TEST_DB_ADDR, and PCIE_ENDPOINT_TEST_DB_DATA.
Trigger the doorbell by writing data from PCI_ENDPOINT_TEST_DB_DATA to the address provided by PCI_ENDPOINT_TEST_DB_OFFSET and wait for endpoint feedback.
Add two command to COMMAND_ENABLE_DOORBELL and COMMAND_DISABLE_DOORBELL to enable EP side's doorbell support and avoid compatible problem, which host side driver miss-match with endpoint side function driver. See below table:
Host side new driver Host side old driver
EP: new driver S F
EP: old driver F F
S: If EP side support MSI, 'pcitest -B' return success.
If EP side doesn't support MSI, the same to 'F'.
F: 'pcitest -B' return failure, other case as usual.
---
Change from v9 to v10
- none
Change from v8 to v9
- change PCITEST_DOORBELL to 0xa
Change form v6 to v8
- none
Change from v5 to v6
- %s/PCI_ENDPOINT_TEST_DB_ADDR/PCI_ENDPOINT_TEST_DB_OFFSET/g
Change from v4 to v5
- remove unused varible
- add irq_type at pci_endpoint_test_doorbell();
change from v3 to v4
- Add COMMAND_ENABLE_DOORBELL and COMMAND_DISABLE_DOORBELL.
- Remove new DID requirement.
--- drivers/misc/pci_endpoint_test.c | 80 ++++++++++++++++++++++++++++++++++++++++ include/uapi/linux/pcitest.h | 1 + 2 files changed, 81 insertions(+)
drivers/misc/pci_endpoint_test.c +80 -0
@@ -42,6 +42,8 @@#define COMMAND_READ BIT(3)#define COMMAND_WRITE BIT(4)#define COMMAND_COPY BIT(5) +#define COMMAND_ENABLE_DOORBELL BIT(6) +#define COMMAND_DISABLE_DOORBELL BIT(7)#define PCI_ENDPOINT_TEST_STATUS 0x8#define STATUS_READ_SUCCESS BIT(0)
@@ -53,6 +55,11 @@#define STATUS_IRQ_RAISED BIT(6)#define STATUS_SRC_ADDR_INVALID BIT(7)#define STATUS_DST_ADDR_INVALID BIT(8) +#define STATUS_DOORBELL_SUCCESS BIT(9) +#define STATUS_DOORBELL_ENABLE_SUCCESS BIT(10) +#define STATUS_DOORBELL_ENABLE_FAIL BIT(11) +#define STATUS_DOORBELL_DISABLE_SUCCESS BIT(12) +#define STATUS_DOORBELL_DISABLE_FAIL BIT(13)#define PCI_ENDPOINT_TEST_LOWER_SRC_ADDR 0x0c#define PCI_ENDPOINT_TEST_UPPER_SRC_ADDR 0x10
@@ -67,6 +74,10 @@#define PCI_ENDPOINT_TEST_IRQ_NUMBER 0x28#define PCI_ENDPOINT_TEST_FLAGS 0x2c +#define PCI_ENDPOINT_TEST_DB_BAR 0x30 +#define PCI_ENDPOINT_TEST_DB_OFFSET 0x34 +#define PCI_ENDPOINT_TEST_DB_DATA 0x38 +#define FLAG_USE_DMA BIT(0)#define PCI_DEVICE_ID_TI_AM654 0xb00c
@@ -108,6 +119,7 @@ enum pci_barno {BAR_3 ,BAR_4 ,BAR_5 , + NO_BAR = -1, }; struct pci_endpoint_test {
@@ -746,6 +758,71 @@ static bool pci_endpoint_test_set_irq(struct pci_endpoint_test *test,return false; } +static bool pci_endpoint_test_doorbell (struct pci_endpoint_test *test) +{ +struct pci_dev *pdev = test->pdev; +struct device *dev = &pdev->dev; +int irq_type = test->irq_type; +enum pci_barno bar; +u32 data, status; +u32 addr; + +if (irq_type <IRQ_TYPE_INTX || irq_type >IRQ_TYPE_MSIX ) { +dev_err (dev,"Invalid IRQ type option\n" ); +return false; + } + +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_IRQ_TYPE , irq_type); +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_IRQ_NUMBER ,1 ); +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_COMMAND , +COMMAND_ENABLE_DOORBELL ); + +wait_for_completion_timeout (&test->irq_raised,msecs_to_jiffies (1000 )); + + status =pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_STATUS ); +if (status &STATUS_DOORBELL_ENABLE_FAIL ) { +dev_err (dev,"Failed to enable doorbell\n" ); +return false; + } + + data =pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_DB_DATA ); + addr =pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_DB_OFFSET ); + bar =pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_DB_BAR ); + +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_IRQ_TYPE , irq_type); +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_IRQ_NUMBER ,1 ); + +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_STATUS ,0 ); + + bar =pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_DB_BAR ); + +writel (data, test->bar[bar] + addr); + +wait_for_completion_timeout (&test->irq_raised,msecs_to_jiffies (1000 )); + + status =pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_STATUS ); + +if (!(status &STATUS_DOORBELL_SUCCESS )) +dev_err (dev,"Endpoint have not received Doorbell\n" ); + +pci_endpoint_test_writel (test,PCI_ENDPOINT_TEST_COMMAND , +COMMAND_DISABLE_DOORBELL ); + +wait_for_completion_timeout (&test->irq_raised,msecs_to_jiffies (1000 )); + + status |=pci_endpoint_test_readl (test,PCI_ENDPOINT_TEST_STATUS ); + +if (status &STATUS_DOORBELL_DISABLE_FAIL ) { +dev_err (dev,"Failed to disable doorbell\n" ); +return false; + } + +if (!(status &STATUS_DOORBELL_SUCCESS )) +return false; + +return true; +} +static long pci_endpoint_test_ioctl (struct file *file,unsigned int cmd,unsigned long arg) {
@@ -793,6 +870,9 @@ static long pci_endpoint_test_ioctl(struct file *file, unsigned int cmd,case PCITEST_CLEAR_IRQ : ret =pci_endpoint_test_clear_irq (test);break ; +case PCITEST_DOORBELL : + ret =pci_endpoint_test_doorbell (test); +break ; } ret:
include/uapi/linux/pcitest.h +1 -0
@@ -20,6 +20,7 @@#define PCITEST_MSIX _IOW('P', 0x7, int)#define PCITEST_SET_IRQTYPE _IOW('P', 0x8, int)#define PCITEST_GET_IRQTYPE _IO('P', 0x9) +#define PCITEST_DOORBELL _IO('P', 0xa)#define PCITEST_CLEAR_IRQ _IO('P', 0x10)#define PCITEST_FLAGS_USE_DMA 0x00000001
Signature · 1 line
2.34.1
Frank Li
maintainerPATCH v10 7/7 tools: PCI: Add 'B' option for test doorbell
In reply to Frank LiAdd doorbell test support.
---
Change from v3 to v10
- none
--- tools/pci/pcitest.c | 16 +++++++++++++++- 1 file changed, 15 insertions(+), 1 deletion(-)
tools/pci/pcitest.c +15 -1
@@ -34,6 +34,7 @@ struct pci_test {bool copy;unsigned long size;bool use_dma; +bool doorbell; };static int run_test (struct pci_test *test)
@@ -147,6 +148,15 @@ static int run_test(struct pci_test *test)fprintf (stdout,"%s\n" , result[ret]); } +if (test->doorbell) { + ret =ioctl (fd,PCITEST_DOORBELL ,0 ); +fprintf (stdout,"Ringing doorbell on the EP\t\t" ); +if (ret <0 ) +fprintf (stdout,"TEST FAILED\n" ); +else +fprintf (stdout,"%s\n" , result[ret]); + } +fflush (stdout);close (fd);return (ret <0 ) ? ret :1 - ret;/* return 0 if test succeeded */
@@ -172,7 +182,7 @@ int main(int argc, char **argv)/* set default endpoint device */ test->device ="/dev/pci-endpoint-test.0" ; -while ((c =getopt (argc, argv,"D:b:m:x:i:deIlhrwcs:" )) !=EOF ) +while ((c =getopt (argc, argv,"D:b:m:x:i:BdeIlhrwcs:" )) !=EOF )switch (c) {case 'D' : test->device = optarg;
@@ -222,6 +232,9 @@ int main(int argc, char **argv)case 'd' : test->use_dma = true;continue ; +case 'B' : + test->doorbell = true; +continue ;case 'h' :default : usage:
@@ -241,6 +254,7 @@ int main(int argc, char **argv)"\t-w Write buffer test\n" "\t-c Copy buffer test\n" "\t-s <size> Size of buffer {default: 100KB}\n" +"\t-B Doorbell test\n" "\t-h Print this help message\n" , argv[0]);return -EINVAL ;
Signature · 1 line
2.34.1