Commit ecb23f2e authored by Dmitry Baryshkov's avatar Dmitry Baryshkov
Browse files

drm/msm: split the main platform driver



Currently the msm platform driver is a multiplex handling several cases:
- headless GPU-only driver,
- MDP4 with flat device nodes,
- MDP5/DPU MDSS with all the nodes being children of MDSS node.

This results in not-so-perfect code, checking the hardware version
(MDP4/MDP5/DPU) in several places, checking for mdss even when it can
not exist, etc. Split the code into three handling subdrivers (mdp4,
mdss and headless msm).

Reviewed-by: default avatarAbhinav Kumar <quic_abhinavk@quicinc.com>
Reported-by: default avatarkernel test robot <lkp@intel.com>
Reviewed-by: default avatarStephen Boyd <swboyd@chromium.org>
Signed-off-by: default avatarDmitry Baryshkov <dmitry.baryshkov@linaro.org>
Patchwork: https://patchwork.freedesktop.org/patch/482507/
Link: https://lore.kernel.org/r/20220419155346.1272627-4-dmitry.baryshkov@linaro.org


Signed-off-by: default avatarDmitry Baryshkov <dmitry.baryshkov@linaro.org>
parent e1072257
Loading
Loading
Loading
Loading
+56 −0
Original line number Diff line number Diff line
@@ -569,3 +569,59 @@ static struct mdp4_platform_config *mdp4_get_config(struct platform_device *dev)

	return &config;
}

static const struct dev_pm_ops mdp4_pm_ops = {
	.prepare = msm_pm_prepare,
	.complete = msm_pm_complete,
};

static int mdp4_probe(struct platform_device *pdev)
{
	struct msm_drm_private *priv;

	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	platform_set_drvdata(pdev, priv);

	/*
	 * on MDP4 based platforms, the MDP platform device is the component
	 * that adds other display interface components to itself.
	 */
	return msm_drv_probe(&pdev->dev, &pdev->dev);
}

static int mdp4_remove(struct platform_device *pdev)
{
	component_master_del(&pdev->dev, &msm_drm_ops);

	return 0;
}

static const struct of_device_id mdp4_dt_match[] = {
	{ .compatible = "qcom,mdp4", .data = (void *)KMS_MDP4 },
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, mdp4_dt_match);

static struct platform_driver mdp4_platform_driver = {
	.probe      = mdp4_probe,
	.remove     = mdp4_remove,
	.shutdown   = msm_drv_shutdown,
	.driver     = {
		.name   = "mdp4",
		.of_match_table = mdp4_dt_match,
		.pm     = &mdp4_pm_ops,
	},
};

void __init msm_mdp4_register(void)
{
	platform_driver_register(&mdp4_platform_driver);
}

void __exit msm_mdp4_unregister(void)
{
	platform_driver_unregister(&mdp4_platform_driver);
}
+38 −190
Original line number Diff line number Diff line
@@ -256,10 +256,6 @@ static int msm_drm_uninit(struct device *dev)
	return 0;
}

#define KMS_MDP4 4
#define KMS_MDP5 5
#define KMS_DPU  3

static int get_mdp_ver(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
@@ -994,50 +990,7 @@ static const struct drm_driver msm_driver = {
	.patchlevel         = MSM_VERSION_PATCHLEVEL,
};

static int __maybe_unused msm_runtime_suspend(struct device *dev)
{
	struct msm_drm_private *priv = dev_get_drvdata(dev);
	struct msm_mdss *mdss = priv->mdss;

	DBG("");

	if (mdss)
		return msm_mdss_disable(mdss);

	return 0;
}

static int __maybe_unused msm_runtime_resume(struct device *dev)
{
	struct msm_drm_private *priv = dev_get_drvdata(dev);
	struct msm_mdss *mdss = priv->mdss;

	DBG("");

	if (mdss)
		return msm_mdss_enable(mdss);

	return 0;
}

static int __maybe_unused msm_pm_suspend(struct device *dev)
{

	if (pm_runtime_suspended(dev))
		return 0;

	return msm_runtime_suspend(dev);
}

static int __maybe_unused msm_pm_resume(struct device *dev)
{
	if (pm_runtime_suspended(dev))
		return 0;

	return msm_runtime_resume(dev);
}

static int __maybe_unused msm_pm_prepare(struct device *dev)
int msm_pm_prepare(struct device *dev)
{
	struct msm_drm_private *priv = dev_get_drvdata(dev);
	struct drm_device *ddev = priv ? priv->dev : NULL;
@@ -1048,7 +1001,7 @@ static int __maybe_unused msm_pm_prepare(struct device *dev)
	return drm_mode_config_helper_suspend(ddev);
}

static void __maybe_unused msm_pm_complete(struct device *dev)
void msm_pm_complete(struct device *dev)
{
	struct msm_drm_private *priv = dev_get_drvdata(dev);
	struct drm_device *ddev = priv ? priv->dev : NULL;
@@ -1060,8 +1013,6 @@ static void __maybe_unused msm_pm_complete(struct device *dev)
}

static const struct dev_pm_ops msm_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(msm_pm_suspend, msm_pm_resume)
	SET_RUNTIME_PM_OPS(msm_runtime_suspend, msm_runtime_resume, NULL)
	.prepare = msm_pm_prepare,
	.complete = msm_pm_complete,
};
@@ -1076,25 +1027,11 @@ static const struct dev_pm_ops msm_pm_ops = {
 * is no external component that we need to add since LVDS is within MDP4
 * itself.
 */
static int add_components_mdp(struct device *mdp_dev,
static int add_components_mdp(struct device *master_dev, struct device *mdp_dev,
			      struct component_match **matchptr)
{
	struct device_node *np = mdp_dev->of_node;
	struct device_node *ep_node;
	struct device *master_dev;

	/*
	 * on MDP4 based platforms, the MDP platform device is the component
	 * master that adds other display interface components to itself.
	 *
	 * on MDP5 based platforms, the MDSS platform device is the component
	 * master that adds MDP5 and other display interface components to
	 * itself.
	 */
	if (of_device_is_compatible(np, "qcom,mdp4"))
		master_dev = mdp_dev;
	else
		master_dev = mdp_dev->parent;

	for_each_endpoint_of_node(np, ep_node) {
		struct device_node *intf;
@@ -1135,60 +1072,6 @@ static int add_components_mdp(struct device *mdp_dev,
	return 0;
}

static int find_mdp_node(struct device *dev, void *data)
{
	return of_match_node(dpu_dt_match, dev->of_node) ||
		of_match_node(mdp5_dt_match, dev->of_node);
}

static int add_display_components(struct platform_device *pdev,
				  struct component_match **matchptr)
{
	struct device *mdp_dev;
	struct device *dev = &pdev->dev;
	int ret;

	/*
	 * MDP5/DPU based devices don't have a flat hierarchy. There is a top
	 * level parent: MDSS, and children: MDP5/DPU, DSI, HDMI, eDP etc.
	 * Populate the children devices, find the MDP5/DPU node, and then add
	 * the interfaces to our components list.
	 */
	switch (get_mdp_ver(pdev)) {
	case KMS_MDP5:
	case KMS_DPU:
		ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
		if (ret) {
			DRM_DEV_ERROR(dev, "failed to populate children devices\n");
			return ret;
		}

		mdp_dev = device_find_child(dev, NULL, find_mdp_node);
		if (!mdp_dev) {
			DRM_DEV_ERROR(dev, "failed to find MDSS MDP node\n");
			of_platform_depopulate(dev);
			return -ENODEV;
		}

		put_device(mdp_dev);

		/* add the MDP component itself */
		drm_of_component_match_add(dev, matchptr, component_compare_of,
					   mdp_dev->of_node);
		break;
	case KMS_MDP4:
		/* MDP4 */
		mdp_dev = dev;
		break;
	}

	ret = add_components_mdp(mdp_dev, matchptr);
	if (ret)
		of_platform_depopulate(dev);

	return ret;
}

/*
 * We don't know what's the best binding to link the gpu with the drm device.
 * Fow now, we just hunt for all the possible gpus that we support, and add them
@@ -1229,93 +1112,70 @@ static void msm_drm_unbind(struct device *dev)
	msm_drm_uninit(dev);
}

static const struct component_master_ops msm_drm_ops = {
const struct component_master_ops msm_drm_ops = {
	.bind = msm_drm_bind,
	.unbind = msm_drm_unbind,
};

/*
 * Platform driver:
 */

static int msm_pdev_probe(struct platform_device *pdev)
int msm_drv_probe(struct device *master_dev, struct device *mdp_dev)
{
	struct component_match *match = NULL;
	struct msm_mdss *mdss;
	struct msm_drm_private *priv;
	int ret;

	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	platform_set_drvdata(pdev, priv);

	switch (get_mdp_ver(pdev)) {
	case KMS_MDP5:
		mdss = msm_mdss_init(pdev, true);
		break;
	case KMS_DPU:
		mdss = msm_mdss_init(pdev, false);
		break;
	default:
		mdss = NULL;
		break;
	}
	if (IS_ERR(mdss)) {
		ret = PTR_ERR(mdss);
		return ret;
	}

	priv->mdss = mdss;
	if (mdp_dev) {
		/* add the MDP component itself */
		drm_of_component_match_add(master_dev, &match, component_compare_of,
				mdp_dev->of_node);

	if (get_mdp_ver(pdev)) {
		ret = add_display_components(pdev, &match);
		ret = add_components_mdp(master_dev, mdp_dev, &match);
		if (ret)
			goto fail;
			return ret;
	}

	ret = add_gpu_components(&pdev->dev, &match);
	ret = add_gpu_components(master_dev, &match);
	if (ret)
		goto fail;
		return ret;

	/* on all devices that I am aware of, iommu's which can map
	 * any address the cpu can see are used:
	 */
	ret = dma_set_mask_and_coherent(&pdev->dev, ~0);
	ret = dma_set_mask_and_coherent(master_dev, ~0);
	if (ret)
		goto fail;
		return ret;

	ret = component_master_add_with_match(&pdev->dev, &msm_drm_ops, match);
	ret = component_master_add_with_match(master_dev, &msm_drm_ops, match);
	if (ret)
		goto fail;
		return ret;

	return 0;
}

/*
 * Platform driver:
 * Used only for headlesss GPU instances
 */

fail:
	of_platform_depopulate(&pdev->dev);
static int msm_pdev_probe(struct platform_device *pdev)
{
	struct msm_drm_private *priv;

	if (priv->mdss)
		msm_mdss_destroy(priv->mdss);
	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	return ret;
	platform_set_drvdata(pdev, priv);

	return msm_drv_probe(&pdev->dev, NULL);
}

static int msm_pdev_remove(struct platform_device *pdev)
{
	struct msm_drm_private *priv = platform_get_drvdata(pdev);
	struct msm_mdss *mdss = priv->mdss;

	component_master_del(&pdev->dev, &msm_drm_ops);
	of_platform_depopulate(&pdev->dev);

	if (mdss)
		msm_mdss_destroy(mdss);

	return 0;
}

static void msm_pdev_shutdown(struct platform_device *pdev)
void msm_drv_shutdown(struct platform_device *pdev)
{
	struct msm_drm_private *priv = platform_get_drvdata(pdev);
	struct drm_device *drm = priv ? priv->dev : NULL;
@@ -1326,28 +1186,12 @@ static void msm_pdev_shutdown(struct platform_device *pdev)
	drm_atomic_helper_shutdown(drm);
}

static const struct of_device_id dt_match[] = {
	{ .compatible = "qcom,mdp4", .data = (void *)KMS_MDP4 },
	{ .compatible = "qcom,mdss", .data = (void *)KMS_MDP5 },
	{ .compatible = "qcom,msm8998-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,qcm2290-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sdm845-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sc7180-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sc7280-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sc8180x-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sm8150-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sm8250-mdss", .data = (void *)KMS_DPU },
	{}
};
MODULE_DEVICE_TABLE(of, dt_match);

static struct platform_driver msm_platform_driver = {
	.probe      = msm_pdev_probe,
	.remove     = msm_pdev_remove,
	.shutdown   = msm_pdev_shutdown,
	.shutdown   = msm_drv_shutdown,
	.driver     = {
		.name   = "msm",
		.of_match_table = dt_match,
		.pm     = &msm_pm_ops,
	},
};
@@ -1364,6 +1208,8 @@ static int __init msm_drm_register(void)
	msm_hdmi_register();
	msm_dp_register();
	adreno_register();
	msm_mdp4_register();
	msm_mdss_register();
	return platform_driver_register(&msm_platform_driver);
}

@@ -1371,6 +1217,8 @@ static void __exit msm_drm_unregister(void)
{
	DBG("fini");
	platform_driver_unregister(&msm_platform_driver);
	msm_mdss_unregister();
	msm_mdp4_unregister();
	msm_dp_unregister();
	msm_hdmi_unregister();
	adreno_unregister();
+23 −4
Original line number Diff line number Diff line
@@ -408,10 +408,18 @@ static inline void msm_dp_debugfs_init(struct msm_dp *dp_display,

#endif

void __init msm_mdp_register(void);
void __exit msm_mdp_unregister(void);
void __init msm_dpu_register(void);
void __exit msm_dpu_unregister(void);
#define KMS_MDP4 4
#define KMS_MDP5 5
#define KMS_DPU  3

void msm_mdp4_register(void);
void msm_mdp4_unregister(void);
void msm_mdp_register(void);
void msm_mdp_unregister(void);
void msm_dpu_register(void);
void msm_dpu_unregister(void);
void msm_mdss_register(void);
void msm_mdss_unregister(void);

#ifdef CONFIG_DEBUG_FS
void msm_framebuffer_describe(struct drm_framebuffer *fb, struct seq_file *m);
@@ -511,4 +519,15 @@ static inline unsigned long timeout_to_jiffies(const ktime_t *timeout)
	return clamp(remaining_jiffies, 0LL, (s64)INT_MAX);
}

/* Driver helpers */

extern const struct component_master_ops msm_drm_ops;

int msm_pm_prepare(struct device *dev);
void msm_pm_complete(struct device *dev);

int msm_drv_probe(struct device *master_dev, struct device *mdp_dev);
void msm_drv_shutdown(struct platform_device *pdev);


#endif /* __MSM_DRV_H__ */
+0 −7
Original line number Diff line number Diff line
@@ -201,13 +201,6 @@ struct msm_kms *dpu_kms_init(struct drm_device *dev);
extern const struct of_device_id dpu_dt_match[];
extern const struct of_device_id mdp5_dt_match[];

struct msm_mdss;

struct msm_mdss *msm_mdss_init(struct platform_device *pdev, bool is_mdp5);
int msm_mdss_enable(struct msm_mdss *mdss);
int msm_mdss_disable(struct msm_mdss *mdss);
void msm_mdss_destroy(struct msm_mdss *mdss);

#define for_each_crtc_mask(dev, crtc, crtc_mask) \
	drm_for_each_crtc(crtc, dev) \
		for_each_if (drm_crtc_mask(crtc) & (crtc_mask))
+171 −4
Original line number Diff line number Diff line
@@ -10,6 +10,9 @@
#include <linux/irqchip/chained_irq.h>
#include <linux/pm_runtime.h>

#include "msm_drv.h"
#include "msm_kms.h"

/* for DPU_HW_* defines */
#include "disp/dpu1/dpu_hw_catalog.h"

@@ -127,7 +130,7 @@ static int _msm_mdss_irq_domain_add(struct msm_mdss *msm_mdss)
	return 0;
}

int msm_mdss_enable(struct msm_mdss *msm_mdss)
static int msm_mdss_enable(struct msm_mdss *msm_mdss)
{
	int ret;

@@ -170,14 +173,14 @@ int msm_mdss_enable(struct msm_mdss *msm_mdss)
	return ret;
}

int msm_mdss_disable(struct msm_mdss *msm_mdss)
static int msm_mdss_disable(struct msm_mdss *msm_mdss)
{
	clk_bulk_disable_unprepare(msm_mdss->num_clocks, msm_mdss->clocks);

	return 0;
}

void msm_mdss_destroy(struct msm_mdss *msm_mdss)
static void msm_mdss_destroy(struct msm_mdss *msm_mdss)
{
	struct platform_device *pdev = to_platform_device(msm_mdss->dev);
	int irq;
@@ -220,7 +223,7 @@ static int mdp5_mdss_parse_clock(struct platform_device *pdev, struct clk_bulk_d
	return num_clocks;
}

struct msm_mdss *msm_mdss_init(struct platform_device *pdev, bool is_mdp5)
static struct msm_mdss *msm_mdss_init(struct platform_device *pdev, bool is_mdp5)
{
	struct msm_mdss *msm_mdss;
	int ret;
@@ -264,3 +267,167 @@ struct msm_mdss *msm_mdss_init(struct platform_device *pdev, bool is_mdp5)

	return msm_mdss;
}

static int __maybe_unused mdss_runtime_suspend(struct device *dev)
{
	struct msm_drm_private *priv = dev_get_drvdata(dev);

	DBG("");

	return msm_mdss_disable(priv->mdss);
}

static int __maybe_unused mdss_runtime_resume(struct device *dev)
{
	struct msm_drm_private *priv = dev_get_drvdata(dev);

	DBG("");

	return msm_mdss_enable(priv->mdss);
}

static int __maybe_unused mdss_pm_suspend(struct device *dev)
{

	if (pm_runtime_suspended(dev))
		return 0;

	return mdss_runtime_suspend(dev);
}

static int __maybe_unused mdss_pm_resume(struct device *dev)
{
	if (pm_runtime_suspended(dev))
		return 0;

	return mdss_runtime_resume(dev);
}

static const struct dev_pm_ops mdss_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(mdss_pm_suspend, mdss_pm_resume)
	SET_RUNTIME_PM_OPS(mdss_runtime_suspend, mdss_runtime_resume, NULL)
	.prepare = msm_pm_prepare,
	.complete = msm_pm_complete,
};

static int get_mdp_ver(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;

	return (int) (unsigned long) of_device_get_match_data(dev);
}

static int find_mdp_node(struct device *dev, void *data)
{
	return of_match_node(dpu_dt_match, dev->of_node) ||
		of_match_node(mdp5_dt_match, dev->of_node);
}

static int mdss_probe(struct platform_device *pdev)
{
	struct msm_mdss *mdss;
	struct msm_drm_private *priv;
	int mdp_ver = get_mdp_ver(pdev);
	struct device *mdp_dev;
	struct device *dev = &pdev->dev;
	int ret;

	mdss = msm_mdss_init(pdev, mdp_ver == KMS_MDP5);
	if (IS_ERR(mdss))
		return PTR_ERR(mdss);

	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv) {
		ret = -ENOMEM;
		goto fail;
	}

	priv->mdss = mdss;
	platform_set_drvdata(pdev, priv);

	/*
	 * MDP5/DPU based devices don't have a flat hierarchy. There is a top
	 * level parent: MDSS, and children: MDP5/DPU, DSI, HDMI, eDP etc.
	 * Populate the children devices, find the MDP5/DPU node, and then add
	 * the interfaces to our components list.
	 */
	ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
	if (ret) {
		DRM_DEV_ERROR(dev, "failed to populate children devices\n");
		goto fail;
	}

	mdp_dev = device_find_child(dev, NULL, find_mdp_node);
	if (!mdp_dev) {
		DRM_DEV_ERROR(dev, "failed to find MDSS MDP node\n");
		of_platform_depopulate(dev);
		ret = -ENODEV;
		goto fail;
	}

	/*
	 * on MDP5 based platforms, the MDSS platform device is the component
	 * that adds MDP5 and other display interface components to
	 * itself.
	 */
	ret = msm_drv_probe(dev, mdp_dev);
	put_device(mdp_dev);
	if (ret)
		goto fail;

	return 0;

fail:
	of_platform_depopulate(dev);
	msm_mdss_destroy(priv->mdss);

	return ret;
}

static int mdss_remove(struct platform_device *pdev)
{
	struct msm_drm_private *priv = platform_get_drvdata(pdev);
	struct msm_mdss *mdss = priv->mdss;

	component_master_del(&pdev->dev, &msm_drm_ops);
	of_platform_depopulate(&pdev->dev);

	msm_mdss_destroy(mdss);

	return 0;
}

static const struct of_device_id mdss_dt_match[] = {
	{ .compatible = "qcom,mdss", .data = (void *)KMS_MDP5 },
	{ .compatible = "qcom,msm8998-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,qcm2290-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sdm845-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sc7180-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sc7280-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sc8180x-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sm8150-mdss", .data = (void *)KMS_DPU },
	{ .compatible = "qcom,sm8250-mdss", .data = (void *)KMS_DPU },
	{}
};
MODULE_DEVICE_TABLE(of, mdss_dt_match);

static struct platform_driver mdss_platform_driver = {
	.probe      = mdss_probe,
	.remove     = mdss_remove,
	.shutdown   = msm_drv_shutdown,
	.driver     = {
		.name   = "msm-mdss",
		.of_match_table = mdss_dt_match,
		.pm     = &mdss_pm_ops,
	},
};

void __init msm_mdss_register(void)
{
	platform_driver_register(&mdss_platform_driver);
}

void __exit msm_mdss_unregister(void)
{
	platform_driver_unregister(&mdss_platform_driver);
}