Received: by 2002:a05:6358:3188:b0:123:57c1:9b43 with SMTP id q8csp1475326rwd; Thu, 1 Jun 2023 16:41:14 -0700 (PDT) X-Google-Smtp-Source: ACHHUZ597yM2l8DKigK9VOtJeqESxZRV15OJDhttOM6IOmncgcSsZKhf80hdGsGjximdnnsZ7+Sm X-Received: by 2002:a92:c94d:0:b0:338:abc1:1e1d with SMTP id i13-20020a92c94d000000b00338abc11e1dmr6828098ilq.4.1685662874219; Thu, 01 Jun 2023 16:41:14 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1685662874; cv=none; d=google.com; s=arc-20160816; b=QT/f7dFB+zML6kBBpUFF3u2pTwgm4R3uZXuQgNoLLfDwG1ubDmWJIzK+5snO9bZHhc +0ZaEO1HfuiDiDV7epZ5zpeH7ual/hN+qbGNABLvey9LdQaYUOaq/HB0FM3N3WkYXLJB zMzvimAZDWrsL32xEbGmYpexqoP3oaFQ6vwI/dLWktC5ZySCwpGfZgKOvRx3v8YZ6pXo LhrAfkbyEkzchpZZdZgZU5fzZM7/+I1TCeXPtV1P7Fox58goVLi3b0QVKM3SLUMqMEuO ZcZ/awgyhqiQPsuy7fs+ZE/OnE/IYYBeiHZoVijq8fwgpryzwUj1ARnqxgpV5HK5sJi6 3iaw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:in-reply-to :organization:from:references:cc:to:content-language:subject :user-agent:mime-version:date:message-id:dkim-signature; bh=txexQXDoGG6VYiI5KECBszvnwBmlD5WrmhgC3kHlY4g=; b=MSUz1iSYfuJ4+mnhum3Z2stYzCX3pE/elXqGPHes/S3Yn6BM9i4dC4xYBg6l0SAn3h FSEz1tOSnNzq9KyPpIWw1dUQhLOimfFIbEcs/6ASNMZC0CuqOYrR3LXmqC9FtRCo7dCz SU/gfjmvN5YKhIyOsJ4ZveGTc7AA09F4yKSCUorP2Z+Mftfjo14GXzLS0JJhf4hLN4q4 xcJ+urPlGbQ2f6UKUiV2s5Hkf6xcyJHuTA/O8fppUs+HaWTCd1c7DZwjyWawyB7ZO/0E VnxjYe4dhlazVonXg6uZyotaMM/GzQFXWF3yTvGSUDiBiGuKRn+a0oRTbr8jT6MMu14Q 3Rhw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@kernel.org header.s=k20201202 header.b=UEXBZYnn; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Return-Path: Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id j28-20020a633c1c000000b0053f89db745bsi3532510pga.624.2023.06.01.16.41.00; Thu, 01 Jun 2023 16:41:14 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=pass header.i=@kernel.org header.s=k20201202 header.b=UEXBZYnn; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231605AbjFAXbw (ORCPT + 99 others); Thu, 1 Jun 2023 19:31:52 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:38592 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231600AbjFAXbq (ORCPT ); Thu, 1 Jun 2023 19:31:46 -0400 Received: from dfw.source.kernel.org (dfw.source.kernel.org [IPv6:2604:1380:4641:c500::1]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 7D7B718C; Thu, 1 Jun 2023 16:31:34 -0700 (PDT) Received: from smtp.kernel.org (relay.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by dfw.source.kernel.org (Postfix) with ESMTPS id 0D2AA64AE3; Thu, 1 Jun 2023 23:31:34 +0000 (UTC) Received: by smtp.kernel.org (Postfix) with ESMTPSA id 63EEBC4339B; Thu, 1 Jun 2023 23:31:32 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=kernel.org; s=k20201202; t=1685662293; bh=yCYh4d9M/VrqqfnMy3ikq+3quCgiH5GujzZvuZPM5to=; h=Date:Subject:To:Cc:References:From:In-Reply-To:From; b=UEXBZYnnuP456Kz9E5He94M7ZUiUjMMHAwH6DefrToZZJIuUiXeO7LI+bIB8ydwxS ksDoPBx+GuuXd13piMuKffArNJ3Be08vCiOtjExhpuMVPwwed2nPipwkjoETpi181y ojE1ppH45WhO9H29NtrxYcbSsFBaVctDrDp52i8hgiH/AP2/rn3Z26hmeCDpwBJbaq 76buzPzuCAI2037Tklhl0U778AwwhABGlX5V9SqYinfWldZ6gl6UM4a+ztlAFb/Svv 2seuax4ZyqcFFLsfxghfvO14/aFg/se1+z3gbUGAzVoXW/jK8gkrPX0bTV1CRPg6gJ TeKcJdHALM4Kw== Message-ID: Date: Fri, 2 Jun 2023 08:31:31 +0900 MIME-Version: 1.0 User-Agent: Mozilla/5.0 (X11; Linux x86_64; rv:102.0) Gecko/20100101 Thunderbird/102.10.0 Subject: Re: [PATCH v5 9/9] PCI: endpoint: Add PCI Endpoint function driver for MHI bus Content-Language: en-US To: Manivannan Sadhasivam , lpieralisi@kernel.org, kw@linux.com Cc: kishon@kernel.org, bhelgaas@google.com, linux-pci@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-msm@vger.kernel.org References: <20230601145718.12204-1-manivannan.sadhasivam@linaro.org> <20230601145718.12204-10-manivannan.sadhasivam@linaro.org> From: Damien Le Moal Organization: Western Digital Research In-Reply-To: <20230601145718.12204-10-manivannan.sadhasivam@linaro.org> Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 7bit X-Spam-Status: No, score=-4.7 required=5.0 tests=BAYES_00,DKIMWL_WL_HIGH, DKIM_SIGNED,DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,NICE_REPLY_A, RCVD_IN_DNSWL_MED,SPF_HELO_NONE,SPF_PASS,T_SCC_BODY_TEXT_LINE autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On 6/1/23 23:57, Manivannan Sadhasivam wrote: > Add PCI Endpoint driver for the Qualcomm MHI (Modem Host Interface) bus. > The driver implements the MHI function over PCI in the endpoint device > such as SDX55 modem. The MHI endpoint function driver acts as a > controller driver for the MHI Endpoint stack and carries out all PCI > related activities like mapping the host memory using iATU, triggering > MSIs etc... > > Reviewed-by: Kishon Vijay Abraham I > Signed-off-by: Manivannan Sadhasivam Looks good, but not knowing this hardware, I only did a style review. I added some nits below. Reviewed-by: Damien Le Moal > --- > drivers/pci/endpoint/functions/Kconfig | 10 + > drivers/pci/endpoint/functions/Makefile | 1 + > drivers/pci/endpoint/functions/pci-epf-mhi.c | 462 +++++++++++++++++++ > 3 files changed, 473 insertions(+) > create mode 100644 drivers/pci/endpoint/functions/pci-epf-mhi.c > > diff --git a/drivers/pci/endpoint/functions/Kconfig b/drivers/pci/endpoint/functions/Kconfig > index 9fd560886871..f5171b4fabbe 100644 > --- a/drivers/pci/endpoint/functions/Kconfig > +++ b/drivers/pci/endpoint/functions/Kconfig > @@ -37,3 +37,13 @@ config PCI_EPF_VNTB > between PCI Root Port and PCIe Endpoint. > > If in doubt, say "N" to disable Endpoint NTB driver. > + > +config PCI_EPF_MHI > + tristate "PCI Endpoint driver for MHI bus" > + depends on PCI_ENDPOINT && MHI_BUS_EP > + help > + Enable this configuration option to enable the PCI Endpoint > + driver for Modem Host Interface (MHI) bus in Qualcomm Endpoint > + devices such as SDX55. > + > + If in doubt, say "N" to disable Endpoint driver for MHI bus. > diff --git a/drivers/pci/endpoint/functions/Makefile b/drivers/pci/endpoint/functions/Makefile > index 5c13001deaba..696473fce50e 100644 > --- a/drivers/pci/endpoint/functions/Makefile > +++ b/drivers/pci/endpoint/functions/Makefile > @@ -6,3 +6,4 @@ > obj-$(CONFIG_PCI_EPF_TEST) += pci-epf-test.o > obj-$(CONFIG_PCI_EPF_NTB) += pci-epf-ntb.o > obj-$(CONFIG_PCI_EPF_VNTB) += pci-epf-vntb.o > +obj-$(CONFIG_PCI_EPF_MHI) += pci-epf-mhi.o > diff --git a/drivers/pci/endpoint/functions/pci-epf-mhi.c b/drivers/pci/endpoint/functions/pci-epf-mhi.c > new file mode 100644 > index 000000000000..98f0d96cfd46 > --- /dev/null > +++ b/drivers/pci/endpoint/functions/pci-epf-mhi.c > @@ -0,0 +1,462 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * PCI EPF driver for MHI Endpoint devices > + * > + * Copyright (C) 2023 Linaro Ltd. > + * Author: Manivannan Sadhasivam > + */ > + > +#include > +#include > +#include > +#include > +#include > + > +#define MHI_VERSION_1_0 0x01000000 > + > +#define to_epf_mhi(cntrl) container_of(cntrl, struct pci_epf_mhi, cntrl) > + > +struct pci_epf_mhi_ep_info { > + const struct mhi_ep_cntrl_config *config; > + struct pci_epf_header *epf_header; > + enum pci_barno bar_num; > + u32 epf_flags; > + u32 msi_count; > + u32 mru; > +}; > + > +#define MHI_EP_CHANNEL_CONFIG(ch_num, ch_name, direction) \ > + { \ > + .num = ch_num, \ > + .name = ch_name, \ > + .dir = direction, \ > + } > + > +#define MHI_EP_CHANNEL_CONFIG_UL(ch_num, ch_name) \ > + MHI_EP_CHANNEL_CONFIG(ch_num, ch_name, DMA_TO_DEVICE) > + > +#define MHI_EP_CHANNEL_CONFIG_DL(ch_num, ch_name) \ > + MHI_EP_CHANNEL_CONFIG(ch_num, ch_name, DMA_FROM_DEVICE) > + > +static const struct mhi_ep_channel_config mhi_v1_channels[] = { > + MHI_EP_CHANNEL_CONFIG_UL(0, "LOOPBACK"), > + MHI_EP_CHANNEL_CONFIG_DL(1, "LOOPBACK"), > + MHI_EP_CHANNEL_CONFIG_UL(2, "SAHARA"), > + MHI_EP_CHANNEL_CONFIG_DL(3, "SAHARA"), > + MHI_EP_CHANNEL_CONFIG_UL(4, "DIAG"), > + MHI_EP_CHANNEL_CONFIG_DL(5, "DIAG"), > + MHI_EP_CHANNEL_CONFIG_UL(6, "SSR"), > + MHI_EP_CHANNEL_CONFIG_DL(7, "SSR"), > + MHI_EP_CHANNEL_CONFIG_UL(8, "QDSS"), > + MHI_EP_CHANNEL_CONFIG_DL(9, "QDSS"), > + MHI_EP_CHANNEL_CONFIG_UL(10, "EFS"), > + MHI_EP_CHANNEL_CONFIG_DL(11, "EFS"), > + MHI_EP_CHANNEL_CONFIG_UL(12, "MBIM"), > + MHI_EP_CHANNEL_CONFIG_DL(13, "MBIM"), > + MHI_EP_CHANNEL_CONFIG_UL(14, "QMI"), > + MHI_EP_CHANNEL_CONFIG_DL(15, "QMI"), > + MHI_EP_CHANNEL_CONFIG_UL(16, "QMI"), > + MHI_EP_CHANNEL_CONFIG_DL(17, "QMI"), > + MHI_EP_CHANNEL_CONFIG_UL(18, "IP-CTRL-1"), > + MHI_EP_CHANNEL_CONFIG_DL(19, "IP-CTRL-1"), > + MHI_EP_CHANNEL_CONFIG_UL(20, "IPCR"), > + MHI_EP_CHANNEL_CONFIG_DL(21, "IPCR"), > + MHI_EP_CHANNEL_CONFIG_UL(32, "DUN"), > + MHI_EP_CHANNEL_CONFIG_DL(33, "DUN"), > + MHI_EP_CHANNEL_CONFIG_UL(46, "IP_SW0"), > + MHI_EP_CHANNEL_CONFIG_DL(47, "IP_SW0"), > +}; > + > +static const struct mhi_ep_cntrl_config mhi_v1_config = { > + .max_channels = 128, > + .num_channels = ARRAY_SIZE(mhi_v1_channels), > + .ch_cfg = mhi_v1_channels, > + .mhi_version = MHI_VERSION_1_0, > +}; > + > +static struct pci_epf_header sdx55_header = { > + .vendorid = PCI_VENDOR_ID_QCOM, > + .deviceid = 0x0306, > + .baseclass_code = PCI_BASE_CLASS_COMMUNICATION, > + .subclass_code = PCI_CLASS_COMMUNICATION_MODEM & 0xff, > + .interrupt_pin = PCI_INTERRUPT_INTA, > +}; > + > +static const struct pci_epf_mhi_ep_info sdx55_info = { > + .config = &mhi_v1_config, > + .epf_header = &sdx55_header, > + .bar_num = BAR_0, > + .epf_flags = PCI_BASE_ADDRESS_MEM_TYPE_32, > + .msi_count = 32, > + .mru = 0x8000, > +}; > + > +struct pci_epf_mhi { > + const struct pci_epf_mhi_ep_info *info; > + struct mhi_ep_cntrl mhi_cntrl; > + struct pci_epf *epf; > + struct mutex lock; > + void __iomem *mmio; > + resource_size_t mmio_phys; > + u32 mmio_size; > + int irq; > +}; > + > +static int pci_epf_mhi_alloc_map(struct mhi_ep_cntrl *mhi_cntrl, u64 pci_addr, > + phys_addr_t *paddr, void __iomem **vaddr, > + size_t size) > +{ > + struct pci_epf_mhi *epf_mhi = to_epf_mhi(mhi_cntrl); > + struct pci_epf *epf = epf_mhi->epf; > + struct pci_epc *epc = epf_mhi->epf->epc; > + size_t offset = pci_addr & (epc->mem->window.page_size - 1); > + void __iomem *__vaddr; > + phys_addr_t __paddr; > + int ret; > + > + __vaddr = pci_epc_mem_alloc_addr(epc, &__paddr, size + offset); > + if (!__vaddr) > + return -ENOMEM; > + > + ret = pci_epc_map_addr(epc, epf->func_no, epf->vfunc_no, __paddr, > + pci_addr - offset, size + offset); > + if (ret) { > + pci_epc_mem_free_addr(epc, __paddr, __vaddr, size + offset); > + Drop the blank line here. > + return ret; > + } > + > + *paddr = __paddr + offset; > + *vaddr = __vaddr + offset; > + > + return 0; > +} > + > +static void pci_epf_mhi_unmap_free(struct mhi_ep_cntrl *mhi_cntrl, u64 pci_addr, > + phys_addr_t paddr, void __iomem *vaddr, > + size_t size) > +{ > + struct pci_epf_mhi *epf_mhi = to_epf_mhi(mhi_cntrl); > + struct pci_epf *epf = epf_mhi->epf; > + struct pci_epc *epc = epf->epc; > + size_t offset = pci_addr & (epc->mem->window.page_size - 1); > + > + pci_epc_unmap_addr(epc, epf->func_no, epf->vfunc_no, paddr - offset); > + pci_epc_mem_free_addr(epc, paddr - offset, vaddr - offset, > + size + offset); > +} > + > +static void pci_epf_mhi_raise_irq(struct mhi_ep_cntrl *mhi_cntrl, u32 vector) > +{ > + struct pci_epf_mhi *epf_mhi = to_epf_mhi(mhi_cntrl); > + struct pci_epf *epf = epf_mhi->epf; > + struct pci_epc *epc = epf->epc; > + > + /* > + * MHI supplies 0 based MSI vector but the API expects the vector to be > + * 1 based, so we need to increment the vector by 1. > + */ > + pci_epc_raise_irq(epc, epf->func_no, epf->vfunc_no, PCI_EPC_IRQ_MSI, > + vector + 1); > +} > + > +static int pci_epf_mhi_read_from_host(struct mhi_ep_cntrl *mhi_cntrl, u64 from, > + void __iomem *to, size_t size) > +{ > + struct pci_epf_mhi *epf_mhi = to_epf_mhi(mhi_cntrl); > + struct pci_epf *epf = epf_mhi->epf; > + struct pci_epc *epc = epf_mhi->epf->epc; > + void __iomem *tre_buf; > + phys_addr_t tre_phys; > + size_t offset = from % SZ_4K; > + int ret; > + > + mutex_lock(&epf_mhi->lock); > + > + tre_buf = pci_epc_mem_alloc_addr(epc, &tre_phys, size + offset); > + if (!tre_buf) { > + ret = -ENOMEM; > + goto err_unlock; > + } > + > + ret = pci_epc_map_addr(epc, epf->func_no, epf->vfunc_no, tre_phys, > + from - offset, size + offset); > + if (ret) { > + pci_epc_mem_free_addr(epc, tre_phys, tre_buf, size + offset); > + goto err_unlock; > + } > + > + memcpy_fromio(to, tre_buf + offset, size); > + > + pci_epc_unmap_addr(epc, epf->func_no, epf->vfunc_no, tre_phys); > + pci_epc_mem_free_addr(epc, tre_phys, tre_buf, size + offset); > + > +err_unlock: > + mutex_unlock(&epf_mhi->lock); > + > + return ret; > +} > + > +static int pci_epf_mhi_write_to_host(struct mhi_ep_cntrl *mhi_cntrl, > + void __iomem *from, u64 to, size_t size) > +{ > + struct pci_epf_mhi *epf_mhi = to_epf_mhi(mhi_cntrl); > + struct pci_epf *epf = epf_mhi->epf; > + struct pci_epc *epc = epf_mhi->epf->epc; > + void __iomem *tre_buf; > + phys_addr_t tre_phys; > + size_t offset = to % SZ_4K; > + int ret; > + > + mutex_lock(&epf_mhi->lock); > + > + tre_buf = pci_epc_mem_alloc_addr(epc, &tre_phys, size + offset); > + if (!tre_buf) { > + ret = -ENOMEM; > + goto err_unlock; > + } > + > + ret = pci_epc_map_addr(epc, epf->func_no, epf->vfunc_no, tre_phys, > + to - offset, size + offset); > + if (ret) { > + pci_epc_mem_free_addr(epc, tre_phys, tre_buf, size + offset); > + goto err_unlock; > + } The above 2 hunks are that same as in pci_epf_mhi_read_from_host(). May be pack these in a helper function ? E.g. pci_epf_mhi_map() ? Note that I have a patch series in the work that does that at the pci_epc API level (pci_epc_map() + pci_epc_unmap()) to simplify function drivers. > + > + memcpy_toio(tre_buf + offset, from, size); > + > + pci_epc_unmap_addr(epc, epf->func_no, epf->vfunc_no, tre_phys); > + pci_epc_mem_free_addr(epc, tre_phys, tre_buf, size + offset); Same here: pci_epf_mhi_unmap() ? > + > +err_unlock: > + mutex_unlock(&epf_mhi->lock); > + > + return ret; > +} > + > +static int pci_epf_mhi_core_init(struct pci_epf *epf) > +{ > + struct pci_epf_mhi *epf_mhi = epf_get_drvdata(epf); > + const struct pci_epf_mhi_ep_info *info = epf_mhi->info; > + struct pci_epf_bar *epf_bar = &epf->bar[info->bar_num]; > + struct pci_epc *epc = epf->epc; > + struct device *dev = &epf->dev; > + int ret; > + > + epf_bar->phys_addr = epf_mhi->mmio_phys; > + epf_bar->size = epf_mhi->mmio_size; > + epf_bar->barno = info->bar_num; > + epf_bar->flags = info->epf_flags; > + ret = pci_epc_set_bar(epc, epf->func_no, epf->vfunc_no, epf_bar); > + if (ret) { > + dev_err(dev, "Failed to set BAR: %d\n", ret); > + return ret; > + } > + > + ret = pci_epc_set_msi(epc, epf->func_no, epf->vfunc_no, > + order_base_2(info->msi_count)); > + if (ret) { > + dev_err(dev, "Failed to set MSI configuration: %d\n", ret); > + return ret; > + } > + > + ret = pci_epc_write_header(epc, epf->func_no, epf->vfunc_no, > + epf->header); > + if (ret) { > + dev_err(dev, "Failed to set Configuration header: %d\n", ret); > + return ret; > + } > + > + return 0; > +} > + > +static int pci_epf_mhi_link_up(struct pci_epf *epf) > +{ > + struct pci_epf_mhi *epf_mhi = epf_get_drvdata(epf); > + const struct pci_epf_mhi_ep_info *info = epf_mhi->info; > + struct mhi_ep_cntrl *mhi_cntrl = &epf_mhi->mhi_cntrl; > + struct pci_epc *epc = epf->epc; > + struct device *dev = &epf->dev; > + int ret; > + > + mhi_cntrl->mmio = epf_mhi->mmio; > + mhi_cntrl->irq = epf_mhi->irq; > + mhi_cntrl->mru = info->mru; > + > + /* Assign the struct dev of PCI EP as MHI controller device */ > + mhi_cntrl->cntrl_dev = epc->dev.parent; > + mhi_cntrl->raise_irq = pci_epf_mhi_raise_irq; > + mhi_cntrl->alloc_map = pci_epf_mhi_alloc_map; > + mhi_cntrl->unmap_free = pci_epf_mhi_unmap_free; > + mhi_cntrl->read_from_host = pci_epf_mhi_read_from_host; > + mhi_cntrl->write_to_host = pci_epf_mhi_write_to_host; > + > + /* Register the MHI EP controller */ > + ret = mhi_ep_register_controller(mhi_cntrl, info->config); > + if (ret) { > + dev_err(dev, "Failed to register MHI EP controller: %d\n", ret); > + return ret; > + } > + > + return 0; > +} > + > +static int pci_epf_mhi_link_down(struct pci_epf *epf) > +{ > + struct pci_epf_mhi *epf_mhi = epf_get_drvdata(epf); > + const struct pci_epf_mhi_ep_info *info = epf_mhi->info; > + struct mhi_ep_cntrl *mhi_cntrl = &epf_mhi->mhi_cntrl; > + > + if (mhi_cntrl->mhi_dev) { > + mhi_ep_power_down(mhi_cntrl); > + mhi_ep_unregister_controller(mhi_cntrl); > + } > + > + return 0; > +} > + > +static int pci_epf_mhi_bme(struct pci_epf *epf) > +{ > + struct pci_epf_mhi *epf_mhi = epf_get_drvdata(epf); > + const struct pci_epf_mhi_ep_info *info = epf_mhi->info; > + struct mhi_ep_cntrl *mhi_cntrl = &epf_mhi->mhi_cntrl; > + struct device *dev = &epf->dev; > + int ret; > + > + /* > + * Power up the MHI EP stack if link is up and stack is in power down > + * state. > + */ > + if (!mhi_cntrl->enabled && mhi_cntrl->mhi_dev) { > + ret = mhi_ep_power_up(mhi_cntrl); > + if (ret) { > + dev_err(dev, "Failed to power up MHI EP: %d\n", ret); > + mhi_ep_unregister_controller(mhi_cntrl); > + } > + } > + > + return 0; > +} > + > +static int pci_epf_mhi_bind(struct pci_epf *epf) > +{ > + struct pci_epf_mhi *epf_mhi = epf_get_drvdata(epf); > + struct pci_epc *epc = epf->epc; > + struct platform_device *pdev = to_platform_device(epc->dev.parent); > + struct device *dev = &epf->dev; > + struct resource *res; > + int ret; > + > + if (WARN_ON_ONCE(!epc)) > + return -EINVAL; This should never happen. If there is a possibility that the EPC core code calls bind with epc == NULL, we need to fix that there. > + > + /* Get MMIO base address from Endpoint controller */ > + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mmio"); > + epf_mhi->mmio_phys = res->start; > + epf_mhi->mmio_size = resource_size(res); > + > + epf_mhi->mmio = ioremap(epf_mhi->mmio_phys, epf_mhi->mmio_size); > + if (IS_ERR(epf_mhi->mmio)) > + return PTR_ERR(epf_mhi->mmio); > + > + ret = platform_get_irq_byname(pdev, "doorbell"); > + if (ret < 0) { > + dev_err(dev, "Failed to get Doorbell IRQ\n"); > + iounmap(epf_mhi->mmio); > + return ret; > + } > + > + epf_mhi->irq = ret; > + > + return 0; > +} > + > +static void pci_epf_mhi_unbind(struct pci_epf *epf) > +{ > + struct pci_epf_mhi *epf_mhi = epf_get_drvdata(epf); > + const struct pci_epf_mhi_ep_info *info = epf_mhi->info; > + struct pci_epf_bar *epf_bar = &epf->bar[info->bar_num]; > + struct mhi_ep_cntrl *mhi_cntrl = &epf_mhi->mhi_cntrl; > + struct pci_epc *epc = epf->epc; > + > + /* > + * Forcefully power down the MHI EP stack. Only way to bring the MHI EP > + * stack back to working state after successive bind is by getting BME > + * from host. > + */ > + if (mhi_cntrl->mhi_dev) { > + mhi_ep_power_down(mhi_cntrl); > + mhi_ep_unregister_controller(mhi_cntrl); > + } > + > + iounmap(epf_mhi->mmio); > + pci_epc_clear_bar(epc, epf->func_no, epf->vfunc_no, epf_bar); > +} > + > +static struct pci_epc_event_ops pci_epf_mhi_event_ops = { > + .core_init = pci_epf_mhi_core_init, > + .link_up = pci_epf_mhi_link_up, > + .link_down = pci_epf_mhi_link_down, > + .bme = pci_epf_mhi_bme, > +}; > + > +static int pci_epf_mhi_probe(struct pci_epf *epf, > + const struct pci_epf_device_id *id) > +{ > + struct pci_epf_mhi_ep_info *info = > + (struct pci_epf_mhi_ep_info *)id->driver_data; > + struct pci_epf_mhi *epf_mhi; > + struct device *dev = &epf->dev; > + > + epf_mhi = devm_kzalloc(dev, sizeof(*epf_mhi), GFP_KERNEL); > + if (!epf_mhi) > + return -ENOMEM; > + > + epf->header = info->epf_header; > + epf_mhi->info = info; > + epf_mhi->epf = epf; > + > + epf->event_ops = &pci_epf_mhi_event_ops; > + > + mutex_init(&epf_mhi->lock); > + > + epf_set_drvdata(epf, epf_mhi); > + > + return 0; > +} > + > +static const struct pci_epf_device_id pci_epf_mhi_ids[] = { > + { > + .name = "sdx55", .driver_data = (kernel_ulong_t)&sdx55_info, > + }, > + {}, > +}; > + > +static struct pci_epf_ops pci_epf_mhi_ops = { > + .unbind = pci_epf_mhi_unbind, > + .bind = pci_epf_mhi_bind, > +}; > + > +static struct pci_epf_driver pci_epf_mhi_driver = { > + .driver.name = "pci_epf_mhi", > + .probe = pci_epf_mhi_probe, > + .id_table = pci_epf_mhi_ids, > + .ops = &pci_epf_mhi_ops, > + .owner = THIS_MODULE, > +}; > + > +static int __init pci_epf_mhi_init(void) > +{ > + return pci_epf_register_driver(&pci_epf_mhi_driver); > +} > +module_init(pci_epf_mhi_init); > + > +static void __exit pci_epf_mhi_exit(void) > +{ > + pci_epf_unregister_driver(&pci_epf_mhi_driver); > +} > +module_exit(pci_epf_mhi_exit); > + > +MODULE_DESCRIPTION("PCI EPF driver for MHI Endpoint devices"); > +MODULE_AUTHOR("Manivannan Sadhasivam "); > +MODULE_LICENSE("GPL"); -- Damien Le Moal Western Digital Research