1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2016-2018, 2020-2021 The Linux Foundation. All rights reserved.
  4 * Copyright (C) 2013 Red Hat
  5 * Author: Rob Clark <robdclark@gmail.com>
  6 */
  7
  8#include <linux/interconnect.h>
  9
 10#include "msm_drv.h"
 11
 12/*
 13 * Util/helpers:
 14 */
 15
 16struct clk *msm_clk_bulk_get_clock(struct clk_bulk_data *bulk, int count,
 17		const char *name)
 18{
 19	int i;
 20	char n[32];
 21
 22	snprintf(n, sizeof(n), "%s_clk", name);
 23
 24	for (i = 0; bulk && i < count; i++) {
 25		if (!strcmp(bulk[i].id, name) || !strcmp(bulk[i].id, n))
 26			return bulk[i].clk;
 27	}
 28
 29
 30	return NULL;
 31}
 32
 33struct clk *msm_clk_get(struct platform_device *pdev, const char *name)
 34{
 35	struct clk *clk;
 36	char name2[32];
 37
 38	clk = devm_clk_get(&pdev->dev, name);
 39	if (!IS_ERR(clk) || PTR_ERR(clk) == -EPROBE_DEFER)
 40		return clk;
 41
 42	snprintf(name2, sizeof(name2), "%s_clk", name);
 43
 44	clk = devm_clk_get(&pdev->dev, name2);
 45	if (!IS_ERR(clk))
 46		dev_warn(&pdev->dev, "Using legacy clk name binding.  Use "
 47				"\"%s\" instead of \"%s\"\n", name, name2);
 48
 49	return clk;
 50}
 51
 52static void __iomem *_msm_ioremap(struct platform_device *pdev, const char *name,
 53				  bool quiet, phys_addr_t *psize)
 54{
 55	struct resource *res;
 56	unsigned long size;
 57	void __iomem *ptr;
 58
 59	if (name)
 60		res = platform_get_resource_byname(pdev, IORESOURCE_MEM, name);
 61	else
 62		res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 63
 64	if (!res) {
 65		if (!quiet)
 66			DRM_DEV_ERROR(&pdev->dev, "failed to get memory resource: %s\n", name);
 67		return ERR_PTR(-EINVAL);
 68	}
 69
 70	size = resource_size(res);
 71
 72	ptr = devm_ioremap(&pdev->dev, res->start, size);
 73	if (!ptr) {
 74		if (!quiet)
 75			DRM_DEV_ERROR(&pdev->dev, "failed to ioremap: %s\n", name);
 76		return ERR_PTR(-ENOMEM);
 77	}
 78
 79	if (psize)
 80		*psize = size;
 81
 82	return ptr;
 83}
 84
 85void __iomem *msm_ioremap(struct platform_device *pdev, const char *name)
 86{
 87	return _msm_ioremap(pdev, name, false, NULL);
 88}
 89
 90void __iomem *msm_ioremap_quiet(struct platform_device *pdev, const char *name)
 91{
 92	return _msm_ioremap(pdev, name, true, NULL);
 93}
 94
 95void __iomem *msm_ioremap_size(struct platform_device *pdev, const char *name,
 96			  phys_addr_t *psize)
 97{
 98	return _msm_ioremap(pdev, name, false, psize);
 99}
100
101static enum hrtimer_restart msm_hrtimer_worktimer(struct hrtimer *t)
102{
103	struct msm_hrtimer_work *work = container_of(t,
104			struct msm_hrtimer_work, timer);
105
106	kthread_queue_work(work->worker, &work->work);
107
108	return HRTIMER_NORESTART;
109}
110
111void msm_hrtimer_queue_work(struct msm_hrtimer_work *work,
112			    ktime_t wakeup_time,
113			    enum hrtimer_mode mode)
114{
115	hrtimer_start(&work->timer, wakeup_time, mode);
116}
117
118void msm_hrtimer_work_init(struct msm_hrtimer_work *work,
119			   struct kthread_worker *worker,
120			   kthread_work_func_t fn,
121			   clockid_t clock_id,
122			   enum hrtimer_mode mode)
123{
124	hrtimer_init(&work->timer, clock_id, mode);
125	work->timer.function = msm_hrtimer_worktimer;
126	work->worker = worker;
127	kthread_init_work(&work->work, fn);
128}
129
130struct icc_path *msm_icc_get(struct device *dev, const char *name)
131{
132	struct device *mdss_dev = dev->parent;
133	struct icc_path *path;
134
135	path = of_icc_get(dev, name);
136	if (path)
137		return path;
138
139	/*
140	 * If there are no interconnects attached to the corresponding device
141	 * node, of_icc_get() will return NULL.
142	 *
143	 * If the MDP5/DPU device node doesn't have interconnects, lookup the
144	 * path in the parent (MDSS) device.
145	 */
146	return of_icc_get(mdss_dev, name);
147
148}