1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2021 MediaTek Inc.
4  */
5 
6 #include <linux/clk.h>
7 #include <linux/component.h>
8 #include <linux/module.h>
9 #include <linux/of.h>
10 #include <linux/platform_device.h>
11 #include <linux/soc/mediatek/mtk-cmdq.h>
12 
13 #include "mtk_disp_drv.h"
14 #include "mtk_drm_crtc.h"
15 #include "mtk_drm_ddp_comp.h"
16 #include "mtk_drm_drv.h"
17 
18 #define DISP_CCORR_EN				0x0000
19 #define CCORR_EN					BIT(0)
20 #define DISP_CCORR_CFG				0x0020
21 #define CCORR_RELAY_MODE				BIT(0)
22 #define CCORR_ENGINE_EN					BIT(1)
23 #define CCORR_GAMMA_OFF					BIT(2)
24 #define CCORR_WGAMUT_SRC_CLIP				BIT(3)
25 #define DISP_CCORR_SIZE				0x0030
26 #define DISP_CCORR_COEF_0			0x0080
27 #define DISP_CCORR_COEF_1			0x0084
28 #define DISP_CCORR_COEF_2			0x0088
29 #define DISP_CCORR_COEF_3			0x008C
30 #define DISP_CCORR_COEF_4			0x0090
31 
32 struct mtk_disp_ccorr_data {
33 	u32 matrix_bits;
34 };
35 
36 struct mtk_disp_ccorr {
37 	struct clk *clk;
38 	void __iomem *regs;
39 	struct cmdq_client_reg cmdq_reg;
40 	const struct mtk_disp_ccorr_data	*data;
41 };
42 
mtk_ccorr_clk_enable(struct device * dev)43 int mtk_ccorr_clk_enable(struct device *dev)
44 {
45 	struct mtk_disp_ccorr *ccorr = dev_get_drvdata(dev);
46 
47 	return clk_prepare_enable(ccorr->clk);
48 }
49 
mtk_ccorr_clk_disable(struct device * dev)50 void mtk_ccorr_clk_disable(struct device *dev)
51 {
52 	struct mtk_disp_ccorr *ccorr = dev_get_drvdata(dev);
53 
54 	clk_disable_unprepare(ccorr->clk);
55 }
56 
mtk_ccorr_config(struct device * dev,unsigned int w,unsigned int h,unsigned int vrefresh,unsigned int bpc,struct cmdq_pkt * cmdq_pkt)57 void mtk_ccorr_config(struct device *dev, unsigned int w,
58 			     unsigned int h, unsigned int vrefresh,
59 			     unsigned int bpc, struct cmdq_pkt *cmdq_pkt)
60 {
61 	struct mtk_disp_ccorr *ccorr = dev_get_drvdata(dev);
62 
63 	mtk_ddp_write(cmdq_pkt, w << 16 | h, &ccorr->cmdq_reg, ccorr->regs,
64 		      DISP_CCORR_SIZE);
65 	mtk_ddp_write(cmdq_pkt, CCORR_ENGINE_EN, &ccorr->cmdq_reg, ccorr->regs,
66 		      DISP_CCORR_CFG);
67 }
68 
mtk_ccorr_start(struct device * dev)69 void mtk_ccorr_start(struct device *dev)
70 {
71 	struct mtk_disp_ccorr *ccorr = dev_get_drvdata(dev);
72 
73 	writel(CCORR_EN, ccorr->regs + DISP_CCORR_EN);
74 }
75 
mtk_ccorr_stop(struct device * dev)76 void mtk_ccorr_stop(struct device *dev)
77 {
78 	struct mtk_disp_ccorr *ccorr = dev_get_drvdata(dev);
79 
80 	writel_relaxed(0x0, ccorr->regs + DISP_CCORR_EN);
81 }
82 
83 /* Converts a DRM S31.32 value to the HW S1.n format. */
mtk_ctm_s31_32_to_s1_n(u64 in,u32 n)84 static u16 mtk_ctm_s31_32_to_s1_n(u64 in, u32 n)
85 {
86 	u16 r;
87 
88 	/* Sign bit. */
89 	r = in & BIT_ULL(63) ? BIT(n + 1) : 0;
90 
91 	if ((in & GENMASK_ULL(62, 33)) > 0) {
92 		/* identity value 0x100000000 -> 0x400(mt8183), */
93 		/* identity value 0x100000000 -> 0x800(mt8192), */
94 		/* if bigger this, set it to max 0x7ff. */
95 		r |= GENMASK(n, 0);
96 	} else {
97 		/* take the n+1 most important bits. */
98 		r |= (in >> (32 - n)) & GENMASK(n, 0);
99 	}
100 
101 	return r;
102 }
103 
mtk_ccorr_ctm_set(struct device * dev,struct drm_crtc_state * state)104 void mtk_ccorr_ctm_set(struct device *dev, struct drm_crtc_state *state)
105 {
106 	struct mtk_disp_ccorr *ccorr = dev_get_drvdata(dev);
107 	struct drm_property_blob *blob = state->ctm;
108 	struct drm_color_ctm *ctm;
109 	const u64 *input;
110 	uint16_t coeffs[9] = { 0 };
111 	int i;
112 	struct cmdq_pkt *cmdq_pkt = NULL;
113 	u32 matrix_bits = ccorr->data->matrix_bits;
114 
115 	if (!blob)
116 		return;
117 
118 	ctm = (struct drm_color_ctm *)blob->data;
119 	input = ctm->matrix;
120 
121 	for (i = 0; i < ARRAY_SIZE(coeffs); i++)
122 		coeffs[i] = mtk_ctm_s31_32_to_s1_n(input[i], matrix_bits);
123 
124 	mtk_ddp_write(cmdq_pkt, coeffs[0] << 16 | coeffs[1],
125 		      &ccorr->cmdq_reg, ccorr->regs, DISP_CCORR_COEF_0);
126 	mtk_ddp_write(cmdq_pkt, coeffs[2] << 16 | coeffs[3],
127 		      &ccorr->cmdq_reg, ccorr->regs, DISP_CCORR_COEF_1);
128 	mtk_ddp_write(cmdq_pkt, coeffs[4] << 16 | coeffs[5],
129 		      &ccorr->cmdq_reg, ccorr->regs, DISP_CCORR_COEF_2);
130 	mtk_ddp_write(cmdq_pkt, coeffs[6] << 16 | coeffs[7],
131 		      &ccorr->cmdq_reg, ccorr->regs, DISP_CCORR_COEF_3);
132 	mtk_ddp_write(cmdq_pkt, coeffs[8] << 16,
133 		      &ccorr->cmdq_reg, ccorr->regs, DISP_CCORR_COEF_4);
134 }
135 
mtk_disp_ccorr_bind(struct device * dev,struct device * master,void * data)136 static int mtk_disp_ccorr_bind(struct device *dev, struct device *master,
137 			       void *data)
138 {
139 	return 0;
140 }
141 
mtk_disp_ccorr_unbind(struct device * dev,struct device * master,void * data)142 static void mtk_disp_ccorr_unbind(struct device *dev, struct device *master,
143 				  void *data)
144 {
145 }
146 
147 static const struct component_ops mtk_disp_ccorr_component_ops = {
148 	.bind	= mtk_disp_ccorr_bind,
149 	.unbind	= mtk_disp_ccorr_unbind,
150 };
151 
mtk_disp_ccorr_probe(struct platform_device * pdev)152 static int mtk_disp_ccorr_probe(struct platform_device *pdev)
153 {
154 	struct device *dev = &pdev->dev;
155 	struct mtk_disp_ccorr *priv;
156 	struct resource *res;
157 	int ret;
158 
159 	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
160 	if (!priv)
161 		return -ENOMEM;
162 
163 	priv->clk = devm_clk_get(dev, NULL);
164 	if (IS_ERR(priv->clk)) {
165 		dev_err(dev, "failed to get ccorr clk\n");
166 		return PTR_ERR(priv->clk);
167 	}
168 
169 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
170 	priv->regs = devm_ioremap_resource(dev, res);
171 	if (IS_ERR(priv->regs)) {
172 		dev_err(dev, "failed to ioremap ccorr\n");
173 		return PTR_ERR(priv->regs);
174 	}
175 
176 #if IS_REACHABLE(CONFIG_MTK_CMDQ)
177 	ret = cmdq_dev_get_client_reg(dev, &priv->cmdq_reg, 0);
178 	if (ret)
179 		dev_dbg(dev, "get mediatek,gce-client-reg fail!\n");
180 #endif
181 
182 	priv->data = of_device_get_match_data(dev);
183 	platform_set_drvdata(pdev, priv);
184 
185 	ret = component_add(dev, &mtk_disp_ccorr_component_ops);
186 	if (ret)
187 		dev_err(dev, "Failed to add component: %d\n", ret);
188 
189 	return ret;
190 }
191 
mtk_disp_ccorr_remove(struct platform_device * pdev)192 static void mtk_disp_ccorr_remove(struct platform_device *pdev)
193 {
194 	component_del(&pdev->dev, &mtk_disp_ccorr_component_ops);
195 }
196 
197 static const struct mtk_disp_ccorr_data mt8183_ccorr_driver_data = {
198 	.matrix_bits = 10,
199 };
200 
201 static const struct mtk_disp_ccorr_data mt8192_ccorr_driver_data = {
202 	.matrix_bits = 11,
203 };
204 
205 static const struct of_device_id mtk_disp_ccorr_driver_dt_match[] = {
206 	{ .compatible = "mediatek,mt8183-disp-ccorr",
207 	  .data = &mt8183_ccorr_driver_data},
208 	{ .compatible = "mediatek,mt8192-disp-ccorr",
209 	  .data = &mt8192_ccorr_driver_data},
210 	{},
211 };
212 MODULE_DEVICE_TABLE(of, mtk_disp_ccorr_driver_dt_match);
213 
214 struct platform_driver mtk_disp_ccorr_driver = {
215 	.probe		= mtk_disp_ccorr_probe,
216 	.remove_new	= mtk_disp_ccorr_remove,
217 	.driver		= {
218 		.name	= "mediatek-disp-ccorr",
219 		.owner	= THIS_MODULE,
220 		.of_match_table = mtk_disp_ccorr_driver_dt_match,
221 	},
222 };
223