From patchwork Thu Apr 13 10:04:17 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "Cao, Bingbu" X-Patchwork-Id: 673048 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 5B286C77B61 for ; Thu, 13 Apr 2023 09:54:47 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S229930AbjDMJyq (ORCPT ); Thu, 13 Apr 2023 05:54:46 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:44426 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S230071AbjDMJyk (ORCPT ); Thu, 13 Apr 2023 05:54:40 -0400 Received: from mga01.intel.com (mga01.intel.com [192.55.52.88]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 94A1A93E2 for ; Thu, 13 Apr 2023 02:54:35 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=intel.com; i=@intel.com; q=dns/txt; s=Intel; t=1681379675; x=1712915675; h=from:to:cc:subject:date:message-id:in-reply-to: references:mime-version:content-transfer-encoding; bh=XZhPM2AyRZtYbBg2TtgqnNirntlmEHLoQnRNFfxhIEo=; b=ZBqtmk9PcOP9dAtYMOp08pJ7PContgqz4HE70SaL1JtgBrGBX6KYsNHJ aoMHnru4hikVqiXRsd2KRyJz27tBBdLIwIUp8l4Vx8DK+oPY8EcTDYXHG C+mlLI0VRa/hT3+Xiew2xXQ8oyiz2bSGcK1UX4XNBb7WU075Al19zEo0P jNkI7WXklHveRwBkiAq7eUo4kqn3wDo9GwUP8/PizzyieWHFrKYyUGzrA x7aikVXBWThjeGw2k+kCi9QqQ3IlmmeVSAWEDSgraTh9/UNiFLenXjZ7b nuq9NnhTJiC85AzuJAoCwZO9OWNbTis119jI5hIXTUSOGExku+mGNSUfR A==; X-IronPort-AV: E=McAfee;i="6600,9927,10678"; a="371992908" X-IronPort-AV: E=Sophos;i="5.98,341,1673942400"; d="scan'208";a="371992908" Received: from orsmga003.jf.intel.com ([10.7.209.27]) by fmsmga101.fm.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 13 Apr 2023 02:54:35 -0700 X-ExtLoop1: 1 X-IronPort-AV: E=McAfee;i="6600,9927,10678"; a="639600008" X-IronPort-AV: E=Sophos;i="5.98,341,1673942400"; d="scan'208";a="639600008" Received: from icg-kernel3.bj.intel.com ([172.16.126.100]) by orsmga003.jf.intel.com with ESMTP; 13 Apr 2023 02:54:31 -0700 From: bingbu.cao@intel.com To: linux-media@vger.kernel.org, sakari.ailus@linux.intel.com, laurent.pinchart@ideasonboard.com, ilpo.jarvinen@linux.intel.com Cc: tfiga@chromium.org, senozhatsky@chromium.org, hdegoede@redhat.com, bingbu.cao@intel.com, bingbu.cao@linux.intel.com, tian.shu.qiu@intel.com, hongju.wang@intel.com, daniel.h.kang@intel.com Subject: [RFC PATCH 02/14] media: intel/ipu6: add IPU virtual bus driver Date: Thu, 13 Apr 2023 18:04:17 +0800 Message-Id: <20230413100429.919622-3-bingbu.cao@intel.com> X-Mailer: git-send-email 2.39.1 In-Reply-To: <20230413100429.919622-1-bingbu.cao@intel.com> References: <20230413100429.919622-1-bingbu.cao@intel.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-media@vger.kernel.org From: Bingbu Cao Even the IPU input system and processing system are a single PCI device, each system has its own power sequence, the processing system power up depends on the input system power up. Besides, input system and processing system have their own MMU hardware for IPU DMA address mapping. Define a virtual bus to help us to implement the power sequence dependency and DMA mapping requirement on specific device. Signed-off-by: Bingbu Cao --- drivers/media/pci/intel/ipu6/ipu6-bus.c | 263 ++++++++++++++++++++++++ drivers/media/pci/intel/ipu6/ipu6-bus.h | 68 ++++++ 2 files changed, 331 insertions(+) create mode 100644 drivers/media/pci/intel/ipu6/ipu6-bus.c create mode 100644 drivers/media/pci/intel/ipu6/ipu6-bus.h diff --git a/drivers/media/pci/intel/ipu6/ipu6-bus.c b/drivers/media/pci/intel/ipu6/ipu6-bus.c new file mode 100644 index 000000000000..9a758d7ae73c --- /dev/null +++ b/drivers/media/pci/intel/ipu6/ipu6-bus.c @@ -0,0 +1,263 @@ +// SPDX-License-Identifier: GPL-2.0-only +// Copyright (C) 2013 - 2023 Intel Corporation + +#include +#include +#include +#include +#include +#include +#include +#include + +#include "ipu6.h" +#include "ipu6-bus.h" +#include "ipu6-buttress.h" +#include "ipu6-dma.h" +#include "ipu6-platform.h" + +static struct bus_type ipu6_bus; + +static int bus_pm_runtime_suspend(struct device *dev) +{ + struct ipu6_bus_device *adev = to_ipu6_bus_device(dev); + int ret; + + ret = pm_generic_runtime_suspend(dev); + if (ret) + return ret; + + ret = ipu6_buttress_power(dev, adev->ctrl, false); + dev_dbg(dev, "buttress power down %d\n", ret); + if (!ret) + return 0; + + dev_err(dev, "power down failed!\n"); + + /* Powering down failed, attempt to resume device now */ + ret = pm_generic_runtime_resume(dev); + if (!ret) + return -EBUSY; + + return -EIO; +} + +static int bus_pm_runtime_resume(struct device *dev) +{ + struct ipu6_bus_device *adev = to_ipu6_bus_device(dev); + int ret; + + ret = ipu6_buttress_power(dev, adev->ctrl, true); + dev_dbg(dev, "buttress power up %d\n", ret); + if (ret) + return ret; + + ret = pm_generic_runtime_resume(dev); + if (ret) + goto out_err; + + return 0; + +out_err: + ipu6_buttress_power(dev, adev->ctrl, false); + + return -EBUSY; +} + +static const struct dev_pm_ops ipu6_bus_pm_ops = { + .runtime_suspend = bus_pm_runtime_suspend, + .runtime_resume = bus_pm_runtime_resume, +}; + +static int ipu6_bus_match(struct device *dev, struct device_driver *drv) +{ + struct ipu6_bus_driver *adrv = to_ipu6_bus_driver(drv); + struct pci_dev *pci_dev = to_pci_dev(dev->parent); + const struct pci_device_id *found_id; + + found_id = pci_match_id(adrv->id_table, pci_dev); + if (found_id) + dev_dbg(dev, "%s %x:%x matched\n", dev_name(dev), + found_id->vendor, found_id->device); + + return found_id ? 1 : 0; +} + +static int ipu6_bus_probe(struct device *dev) +{ + struct ipu6_bus_device *adev = to_ipu6_bus_device(dev); + struct ipu6_bus_driver *adrv = to_ipu6_bus_driver(dev->driver); + int ret; + + if (!adev->isp->bus_ready_to_probe) + return -EPROBE_DEFER; + + dev_dbg(dev, "bus probe dev %s\n", dev_name(dev)); + + adev->adrv = adrv; + if (!adrv->probe) { + ret = -ENODEV; + goto out_err; + } + + ret = pm_runtime_resume_and_get(&adev->dev); + if (ret < 0) { + dev_err(&adev->dev, "Failed to get runtime PM\n"); + goto out_err; + } + + ret = adrv->probe(adev); + pm_runtime_put(&adev->dev); + + if (ret) + goto out_err; + + return 0; + +out_err: + ipu6_bus_set_drvdata(adev, NULL); + adev->adrv = NULL; + + return ret; +} + +static void ipu6_bus_remove(struct device *dev) +{ + struct ipu6_bus_device *adev = to_ipu6_bus_device(dev); + struct ipu6_bus_driver *adrv = to_ipu6_bus_driver(dev->driver); + + if (adrv->remove) + adrv->remove(adev); +} + +static struct bus_type ipu6_bus = { + .name = IPU6_BUS_NAME, + .match = ipu6_bus_match, + .probe = ipu6_bus_probe, + .remove = ipu6_bus_remove, + .pm = &ipu6_bus_pm_ops, +}; + +static DEFINE_MUTEX(ipu6_bus_mutex); + +static void ipu6_bus_release(struct device *dev) +{ + struct ipu6_bus_device *adev = to_ipu6_bus_device(dev); + + kfree(adev); +} + +struct ipu6_bus_device * +ipu6_bus_initialize_device(struct pci_dev *pdev, struct device *parent, + void *pdata, struct ipu6_buttress_ctrl *ctrl, + char *name) +{ + struct ipu6_bus_device *adev; + struct ipu6_device *isp = pci_get_drvdata(pdev); + + adev = kzalloc(sizeof(*adev), GFP_KERNEL); + if (!adev) + return ERR_PTR(-ENOMEM); + + adev->dev.parent = parent; + adev->dev.bus = &ipu6_bus; + adev->dev.release = ipu6_bus_release; + adev->dev.dma_ops = &ipu6_dma_ops; + adev->dma_mask = DMA_BIT_MASK(isp->secure_mode ? IPU6_MMU_ADDR_BITS : + IPU6_MMU_ADDR_BITS_NON_SECURE); + adev->dev.dma_mask = &adev->dma_mask; + adev->dev.dma_parms = pdev->dev.dma_parms; + adev->dev.coherent_dma_mask = adev->dma_mask; + adev->ctrl = ctrl; + adev->pdata = pdata; + adev->isp = isp; + dev_set_name(&adev->dev, "%s", name); + + device_initialize(&adev->dev); + pm_runtime_forbid(&adev->dev); + pm_runtime_enable(&adev->dev); + + return adev; +} + +int ipu6_bus_add_device(struct ipu6_bus_device *adev) +{ + int ret; + + ret = device_add(&adev->dev); + if (ret) { + put_device(&adev->dev); + return ret; + } + + mutex_lock(&ipu6_bus_mutex); + list_add(&adev->list, &adev->isp->devices); + mutex_unlock(&ipu6_bus_mutex); + + pm_runtime_allow(&adev->dev); + return 0; +} + +void ipu6_bus_del_devices(struct pci_dev *pdev) +{ + struct ipu6_device *isp = pci_get_drvdata(pdev); + struct ipu6_bus_device *adev, *save; + + mutex_lock(&ipu6_bus_mutex); + + list_for_each_entry_safe(adev, save, &isp->devices, list) { + pm_runtime_disable(&adev->dev); + list_del(&adev->list); + device_unregister(&adev->dev); + } + + mutex_unlock(&ipu6_bus_mutex); +} + +int ipu6_bus_register_driver(struct ipu6_bus_driver *adrv) +{ + adrv->drv.bus = &ipu6_bus; + return driver_register(&adrv->drv); +} +EXPORT_SYMBOL_NS_GPL(ipu6_bus_register_driver, INTEL_IPU6); + +int ipu6_bus_unregister_driver(struct ipu6_bus_driver *adrv) +{ + driver_unregister(&adrv->drv); + return 0; +} +EXPORT_SYMBOL_NS_GPL(ipu6_bus_unregister_driver, INTEL_IPU6); + +int ipu6_bus_register(void) +{ + return bus_register(&ipu6_bus); +} + +void ipu6_bus_unregister(void) +{ + return bus_unregister(&ipu6_bus); +} + +static int flr_rpm_recovery(struct device *dev, void *p) +{ + /* + * We are not necessarily going through device from child to + * parent. runtime PM refuses to change state for parent if the child + * is still active. At FLR (full reset for whole IPU6) that doesn't + * matter. Everything has been power gated by HW during the FLR cycle + * and we are just cleaning up SW state. Thus, ignore child during + * set_suspended. + */ + dev_dbg(dev, "FLR recovery call\n"); + pm_suspend_ignore_children(dev, true); + pm_runtime_set_suspended(dev); + pm_suspend_ignore_children(dev, false); + + return 0; +} + +int ipu6_bus_flr_recovery(void) +{ + bus_for_each_dev(&ipu6_bus, NULL, NULL, flr_rpm_recovery); + return 0; +} diff --git a/drivers/media/pci/intel/ipu6/ipu6-bus.h b/drivers/media/pci/intel/ipu6/ipu6-bus.h new file mode 100644 index 000000000000..de01bd56e786 --- /dev/null +++ b/drivers/media/pci/intel/ipu6/ipu6-bus.h @@ -0,0 +1,68 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +/* Copyright (C) 2013 - 2023 Intel Corporation */ + +#ifndef IPU6_BUS_H +#define IPU6_BUS_H + +#include +#include +#include +#include +#include + +#define IPU6_BUS_NAME IPU6_NAME "-bus" + +struct ipu6_buttress_ctrl; +struct ipu6_subsystem_trace_config; + +struct ipu6_bus_device { + struct device dev; + struct list_head list; + void *pdata; + struct ipu6_bus_driver *adrv; + struct ipu6_mmu *mmu; + struct ipu6_device *isp; + struct ipu6_subsystem_trace_config *trace_cfg; + struct ipu6_buttress_ctrl *ctrl; + u64 dma_mask; + + const struct firmware *fw; + struct sg_table fw_sgt; + u64 *pkg_dir; + dma_addr_t pkg_dir_dma_addr; + unsigned int pkg_dir_size; +}; + +#define to_ipu6_bus_device(_dev) container_of(_dev, struct ipu6_bus_device, dev) + +struct ipu6_bus_driver { + struct device_driver drv; + const struct pci_device_id *id_table; + int (*probe)(struct ipu6_bus_device *adev); + void (*remove)(struct ipu6_bus_device *adev); + irqreturn_t (*isr)(struct ipu6_bus_device *adev); + irqreturn_t (*isr_threaded)(struct ipu6_bus_device *adev); + bool wake_isr_thread; +}; + +#define to_ipu6_bus_driver(_drv) container_of(_drv, struct ipu6_bus_driver, drv) + +struct ipu6_bus_device * +ipu6_bus_initialize_device(struct pci_dev *pdev, struct device *parent, + void *pdata, struct ipu6_buttress_ctrl *ctrl, + char *name); +int ipu6_bus_add_device(struct ipu6_bus_device *adev); +void ipu6_bus_del_devices(struct pci_dev *pdev); + +int ipu6_bus_register_driver(struct ipu6_bus_driver *adrv); +int ipu6_bus_unregister_driver(struct ipu6_bus_driver *adrv); + +int ipu6_bus_register(void); +void ipu6_bus_unregister(void); + +#define ipu6_bus_set_drvdata(adev, data) dev_set_drvdata(&(adev)->dev, data) +#define ipu6_bus_get_drvdata(adev) dev_get_drvdata(&(adev)->dev) + +int ipu6_bus_flr_recovery(void); + +#endif