forked from ~ljy/RK356X_SDK_RELEASE

blame | history | patch | commit | commitdiff
hc
2024-05-10 9999e48639b3cecb08ffb37358bcba3b48161b29 
 kernel/drivers/media/platform/mtk-vcodec/mtk_vcodec_enc_pm.c
....@@ -1,15 +1,7 @@
1
+// SPDX-License-Identifier: GPL-2.0
12 /*
23 * Copyright (c) 2016 MediaTek Inc.
34 * Author: Tiffany Lin <tiffany.lin@mediatek.com>
4
-*
5
-* This program is free software; you can redistribute it and/or modify
6
-* it under the terms of the GNU General Public License version 2 as
7
-* published by the Free Software Foundation.
8
-*
9
-* This program is distributed in the hope that it will be useful,
10
-* but WITHOUT ANY WARRANTY; without even the implied warranty of
11
-* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12
-* GNU General Public License for more details.
135 */
146 
157 #include <linux/clk.h>
....@@ -20,16 +12,16 @@
2012 
2113 #include "mtk_vcodec_enc_pm.h"
2214 #include "mtk_vcodec_util.h"
23
-#include "mtk_vpu.h"
24
-
2515 
2616 int mtk_vcodec_init_enc_pm(struct mtk_vcodec_dev *mtkdev)
2717 {
2818 	struct device_node *node;
2919 	struct platform_device *pdev;
30
-	struct device *dev;
3120 	struct mtk_vcodec_pm *pm;
32
-	int ret = 0;
21
+	struct mtk_vcodec_clk *enc_clk;
22
+	struct mtk_vcodec_clk_info *clk_info;
23
+	int ret = 0, i = 0;
24
+	struct device *dev;
3325 
3426 	pdev = mtkdev->plat_dev;
3527 	pm = &mtkdev->pm;
....@@ -37,6 +29,7 @@
3729 	pm->mtkdev = mtkdev;
3830 	pm->dev = &pdev->dev;
3931 	dev = &pdev->dev;
32
+	enc_clk = &pm->venc_clk;
4033 
4134 	node = of_parse_phandle(dev->of_node, "mediatek,larb", 0);
4235 	if (!node) {
....@@ -54,44 +47,62 @@
5447 	node = of_parse_phandle(dev->of_node, "mediatek,larb", 1);
5548 	if (!node) {
5649 		mtk_v4l2_err("no mediatek,larb found");
57
-		return -ENODEV;
50
+		ret = -ENODEV;
51
+		goto put_larbvenc;
5852 	}
5953 
6054 	pdev = of_find_device_by_node(node);
6155 	of_node_put(node);
6256 	if (!pdev) {
6357 		mtk_v4l2_err("no mediatek,larb device found");
64
-		return -ENODEV;
58
+		ret = -ENODEV;
59
+		goto put_larbvenc;
6560 	}
6661 
6762 	pm->larbvenclt = &pdev->dev;
6863 	pdev = mtkdev->plat_dev;
6964 	pm->dev = &pdev->dev;
7065 
71
-	pm->vencpll_d2 = devm_clk_get(&pdev->dev, "venc_sel_src");
72
-	if (IS_ERR(pm->vencpll_d2)) {
73
-		mtk_v4l2_err("devm_clk_get vencpll_d2 fail");
74
-		ret = PTR_ERR(pm->vencpll_d2);
66
+	enc_clk->clk_num = of_property_count_strings(pdev->dev.of_node,
67
+		"clock-names");
68
+	if (enc_clk->clk_num > 0) {
69
+		enc_clk->clk_info = devm_kcalloc(&pdev->dev,
70
+			enc_clk->clk_num, sizeof(*clk_info),
71
+			GFP_KERNEL);
72
+		if (!enc_clk->clk_info) {
73
+			ret = -ENOMEM;
74
+			goto put_larbvenclt;
75
+		}
76
+	} else {
77
+		mtk_v4l2_err("Failed to get venc clock count");
78
+		ret = -EINVAL;
79
+		goto put_larbvenclt;
7580 	}
7681 
77
-	pm->venc_sel = devm_clk_get(&pdev->dev, "venc_sel");
78
-	if (IS_ERR(pm->venc_sel)) {
79
-		mtk_v4l2_err("devm_clk_get venc_sel fail");
80
-		ret = PTR_ERR(pm->venc_sel);
82
+	for (i = 0; i < enc_clk->clk_num; i++) {
83
+		clk_info = &enc_clk->clk_info[i];
84
+		ret = of_property_read_string_index(pdev->dev.of_node,
85
+			"clock-names", i, &clk_info->clk_name);
86
+		if (ret) {
87
+			mtk_v4l2_err("venc failed to get clk name %d", i);
88
+			goto put_larbvenclt;
89
+		}
90
+		clk_info->vcodec_clk = devm_clk_get(&pdev->dev,
91
+			clk_info->clk_name);
92
+		if (IS_ERR(clk_info->vcodec_clk)) {
93
+			mtk_v4l2_err("venc devm_clk_get (%d)%s fail", i,
94
+				clk_info->clk_name);
95
+			ret = PTR_ERR(clk_info->vcodec_clk);
96
+			goto put_larbvenclt;
97
+		}
8198 	}
8299 
83
-	pm->univpll1_d2 = devm_clk_get(&pdev->dev, "venc_lt_sel_src");
84
-	if (IS_ERR(pm->univpll1_d2)) {
85
-		mtk_v4l2_err("devm_clk_get univpll1_d2 fail");
86
-		ret = PTR_ERR(pm->univpll1_d2);
87
-	}
100
+	return 0;
88101 
89
-	pm->venc_lt_sel = devm_clk_get(&pdev->dev, "venc_lt_sel");
90
-	if (IS_ERR(pm->venc_lt_sel)) {
91
-		mtk_v4l2_err("devm_clk_get venc_lt_sel fail");
92
-		ret = PTR_ERR(pm->venc_lt_sel);
93
-	}
94
-
102
+put_larbvenclt:
103
+	put_device(pm->larbvenclt);
104
+put_larbvenc:
105
+	put_device(pm->larbvenc);
95106 	return ret;
96107 }
97108 
....@@ -102,38 +113,45 @@
102113 
103114 void mtk_vcodec_enc_clock_on(struct mtk_vcodec_pm *pm)
104115 {
105
-	int ret;
116
+	struct mtk_vcodec_clk *enc_clk = &pm->venc_clk;
117
+	int ret, i = 0;
106118 
107
-	ret = clk_prepare_enable(pm->venc_sel);
108
-	if (ret)
109
-		mtk_v4l2_err("clk_prepare_enable fail %d", ret);
110
-
111
-	ret = clk_set_parent(pm->venc_sel, pm->vencpll_d2);
112
-	if (ret)
113
-		mtk_v4l2_err("clk_set_parent fail %d", ret);
114
-
115
-	ret = clk_prepare_enable(pm->venc_lt_sel);
116
-	if (ret)
117
-		mtk_v4l2_err("clk_prepare_enable fail %d", ret);
118
-
119
-	ret = clk_set_parent(pm->venc_lt_sel, pm->univpll1_d2);
120
-	if (ret)
121
-		mtk_v4l2_err("clk_set_parent fail %d", ret);
119
+	for (i = 0; i < enc_clk->clk_num; i++) {
120
+		ret = clk_prepare_enable(enc_clk->clk_info[i].vcodec_clk);
121
+		if (ret) {
122
+			mtk_v4l2_err("venc clk_prepare_enable %d %s fail %d", i,
123
+				enc_clk->clk_info[i].clk_name, ret);
124
+			goto clkerr;
125
+		}
126
+	}
122127 
123128 	ret = mtk_smi_larb_get(pm->larbvenc);
124
-	if (ret)
129
+	if (ret) {
125130 		mtk_v4l2_err("mtk_smi_larb_get larb3 fail %d", ret);
126
-
131
+		goto larbvencerr;
132
+	}
127133 	ret = mtk_smi_larb_get(pm->larbvenclt);
128
-	if (ret)
134
+	if (ret) {
129135 		mtk_v4l2_err("mtk_smi_larb_get larb4 fail %d", ret);
136
+		goto larbvenclterr;
137
+	}
138
+	return;
130139 
140
+larbvenclterr:
141
+	mtk_smi_larb_put(pm->larbvenc);
142
+larbvencerr:
143
+clkerr:
144
+	for (i -= 1; i >= 0; i--)
145
+		clk_disable_unprepare(enc_clk->clk_info[i].vcodec_clk);
131146 }
132147 
133148 void mtk_vcodec_enc_clock_off(struct mtk_vcodec_pm *pm)
134149 {
150
+	struct mtk_vcodec_clk *enc_clk = &pm->venc_clk;
151
+	int i = 0;
152
+
135153 	mtk_smi_larb_put(pm->larbvenc);
136154 	mtk_smi_larb_put(pm->larbvenclt);
137
-	clk_disable_unprepare(pm->venc_lt_sel);
138
-	clk_disable_unprepare(pm->venc_sel);
155
+	for (i = enc_clk->clk_num - 1; i >= 0; i--)
156
+		clk_disable_unprepare(enc_clk->clk_info[i].vcodec_clk);
139157 }