1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2016 MediaTek Inc.
4 * Author: Ming Hsiu Tsai <minghsiu.tsai@mediatek.com>
5 */
6
7 #include <linux/clk.h>
8 #include <linux/device.h>
9 #include <linux/of.h>
10 #include <linux/of_address.h>
11 #include <linux/of_platform.h>
12
13 #include "mtk_mdp_comp.h"
14
15
mtk_mdp_comp_clock_on(struct device * dev,struct mtk_mdp_comp * comp)16 void mtk_mdp_comp_clock_on(struct device *dev, struct mtk_mdp_comp *comp)
17 {
18 int i, err;
19
20 for (i = 0; i < ARRAY_SIZE(comp->clk); i++) {
21 if (IS_ERR(comp->clk[i]))
22 continue;
23 err = clk_prepare_enable(comp->clk[i]);
24 if (err)
25 dev_err(dev,
26 "failed to enable clock, err %d. type:%d i:%d\n",
27 err, comp->type, i);
28 }
29 }
30
mtk_mdp_comp_clock_off(struct device * dev,struct mtk_mdp_comp * comp)31 void mtk_mdp_comp_clock_off(struct device *dev, struct mtk_mdp_comp *comp)
32 {
33 int i;
34
35 for (i = 0; i < ARRAY_SIZE(comp->clk); i++) {
36 if (IS_ERR(comp->clk[i]))
37 continue;
38 clk_disable_unprepare(comp->clk[i]);
39 }
40 }
41
mtk_mdp_comp_init(struct device * dev,struct device_node * node,struct mtk_mdp_comp * comp,enum mtk_mdp_comp_type comp_type)42 int mtk_mdp_comp_init(struct device *dev, struct device_node *node,
43 struct mtk_mdp_comp *comp,
44 enum mtk_mdp_comp_type comp_type)
45 {
46 int ret;
47 int i;
48
49 comp->dev_node = of_node_get(node);
50 comp->type = comp_type;
51
52 for (i = 0; i < ARRAY_SIZE(comp->clk); i++) {
53 comp->clk[i] = of_clk_get(node, i);
54 if (IS_ERR(comp->clk[i])) {
55 if (PTR_ERR(comp->clk[i]) != -EPROBE_DEFER)
56 dev_err(dev, "Failed to get clock\n");
57 ret = PTR_ERR(comp->clk[i]);
58 goto put_dev;
59 }
60
61 /* Only RDMA needs two clocks */
62 if (comp->type != MTK_MDP_RDMA)
63 break;
64 }
65
66 return 0;
67
68 put_dev:
69 of_node_put(comp->dev_node);
70
71 return ret;
72 }
73
mtk_mdp_comp_deinit(struct device * dev,struct mtk_mdp_comp * comp)74 void mtk_mdp_comp_deinit(struct device *dev, struct mtk_mdp_comp *comp)
75 {
76 of_node_put(comp->dev_node);
77 }
78
