169a4237aSYongqiang Niu // SPDX-License-Identifier: GPL-2.0-only
269a4237aSYongqiang Niu /*
369a4237aSYongqiang Niu * Copyright (c) 2021 MediaTek Inc.
469a4237aSYongqiang Niu */
569a4237aSYongqiang Niu
66e46998cSAngeloGioacchino Del Regno #include <linux/bitfield.h>
769a4237aSYongqiang Niu #include <linux/clk.h>
869a4237aSYongqiang Niu #include <linux/component.h>
969a4237aSYongqiang Niu #include <linux/module.h>
10722d4f06SRob Herring #include <linux/of.h>
1169a4237aSYongqiang Niu #include <linux/platform_device.h>
1269a4237aSYongqiang Niu #include <linux/soc/mediatek/mtk-cmdq.h>
1369a4237aSYongqiang Niu
14f5214df8SHsiao Chien Sung #include "mtk_crtc.h"
157026ee0bSHsiao Chien Sung #include "mtk_ddp_comp.h"
1669a4237aSYongqiang Niu #include "mtk_disp_drv.h"
17807e2f3fSMiles Chen #include "mtk_drm_drv.h"
1869a4237aSYongqiang Niu
1969a4237aSYongqiang Niu #define DISP_GAMMA_EN 0x0000
2069a4237aSYongqiang Niu #define GAMMA_EN BIT(0)
2169a4237aSYongqiang Niu #define DISP_GAMMA_CFG 0x0020
22921e902bSAngeloGioacchino Del Regno #define GAMMA_RELAY_MODE BIT(0)
2369a4237aSYongqiang Niu #define GAMMA_LUT_EN BIT(1)
2469a4237aSYongqiang Niu #define GAMMA_DITHERING BIT(2)
25692e1a08SAngeloGioacchino Del Regno #define GAMMA_LUT_TYPE BIT(2)
2669a4237aSYongqiang Niu #define DISP_GAMMA_SIZE 0x0030
276e46998cSAngeloGioacchino Del Regno #define DISP_GAMMA_SIZE_HSIZE GENMASK(28, 16)
286e46998cSAngeloGioacchino Del Regno #define DISP_GAMMA_SIZE_VSIZE GENMASK(12, 0)
294708b01aSAngeloGioacchino Del Regno #define DISP_GAMMA_BANK 0x0100
304708b01aSAngeloGioacchino Del Regno #define DISP_GAMMA_BANK_BANK GENMASK(1, 0)
31af0e042eSAngeloGioacchino Del Regno #define DISP_GAMMA_BANK_DATA_MODE BIT(2)
3269a4237aSYongqiang Niu #define DISP_GAMMA_LUT 0x0700
33af0e042eSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT1 0x0b00
3469a4237aSYongqiang Niu
35af0e042eSAngeloGioacchino Del Regno /* For 10 bit LUT layout, R/G/B are in the same register */
366e46998cSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT_10BIT_R GENMASK(29, 20)
376e46998cSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT_10BIT_G GENMASK(19, 10)
386e46998cSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT_10BIT_B GENMASK(9, 0)
396e46998cSAngeloGioacchino Del Regno
40af0e042eSAngeloGioacchino Del Regno /* For 12 bit LUT layout, R/G are in LUT, B is in LUT1 */
41af0e042eSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT_12BIT_R GENMASK(11, 0)
42af0e042eSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT_12BIT_G GENMASK(23, 12)
43af0e042eSAngeloGioacchino Del Regno #define DISP_GAMMA_LUT_12BIT_B GENMASK(11, 0)
44af0e042eSAngeloGioacchino Del Regno
4569a4237aSYongqiang Niu struct mtk_disp_gamma_data {
464a15d1acSYongqiang Niu bool has_dither;
47ba99d08dSYongqiang Niu bool lut_diff;
484708b01aSAngeloGioacchino Del Regno u16 lut_bank_size;
49d243907bSAngeloGioacchino Del Regno u16 lut_size;
50af0e042eSAngeloGioacchino Del Regno u8 lut_bits;
5169a4237aSYongqiang Niu };
5269a4237aSYongqiang Niu
53a33a56adSAngeloGioacchino Del Regno /**
54a33a56adSAngeloGioacchino Del Regno * struct mtk_disp_gamma - Display Gamma driver structure
55a33a56adSAngeloGioacchino Del Regno * @clk: clock for DISP_GAMMA block
56a33a56adSAngeloGioacchino Del Regno * @regs: MMIO registers base
57a33a56adSAngeloGioacchino Del Regno * @cmdq_reg: CMDQ Client register
58a33a56adSAngeloGioacchino Del Regno * @data: platform data for DISP_GAMMA
5969a4237aSYongqiang Niu */
6069a4237aSYongqiang Niu struct mtk_disp_gamma {
6169a4237aSYongqiang Niu struct clk *clk;
6269a4237aSYongqiang Niu void __iomem *regs;
6369a4237aSYongqiang Niu struct cmdq_client_reg cmdq_reg;
6469a4237aSYongqiang Niu const struct mtk_disp_gamma_data *data;
6569a4237aSYongqiang Niu };
6669a4237aSYongqiang Niu
mtk_gamma_clk_enable(struct device * dev)6769a4237aSYongqiang Niu int mtk_gamma_clk_enable(struct device *dev)
6869a4237aSYongqiang Niu {
6969a4237aSYongqiang Niu struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
7069a4237aSYongqiang Niu
7169a4237aSYongqiang Niu return clk_prepare_enable(gamma->clk);
7269a4237aSYongqiang Niu }
7369a4237aSYongqiang Niu
mtk_gamma_clk_disable(struct device * dev)7469a4237aSYongqiang Niu void mtk_gamma_clk_disable(struct device *dev)
7569a4237aSYongqiang Niu {
7669a4237aSYongqiang Niu struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
7769a4237aSYongqiang Niu
7869a4237aSYongqiang Niu clk_disable_unprepare(gamma->clk);
7969a4237aSYongqiang Niu }
8069a4237aSYongqiang Niu
mtk_gamma_get_lut_size(struct device * dev)81d243907bSAngeloGioacchino Del Regno unsigned int mtk_gamma_get_lut_size(struct device *dev)
82d243907bSAngeloGioacchino Del Regno {
83d243907bSAngeloGioacchino Del Regno struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
84d243907bSAngeloGioacchino Del Regno
85d243907bSAngeloGioacchino Del Regno if (gamma && gamma->data)
86d243907bSAngeloGioacchino Del Regno return gamma->data->lut_size;
87d243907bSAngeloGioacchino Del Regno return 0;
88d243907bSAngeloGioacchino Del Regno }
89d243907bSAngeloGioacchino Del Regno
mtk_gamma_lut_is_descending(struct drm_color_lut * lut,u32 lut_size)90692e1a08SAngeloGioacchino Del Regno static bool mtk_gamma_lut_is_descending(struct drm_color_lut *lut, u32 lut_size)
91692e1a08SAngeloGioacchino Del Regno {
92692e1a08SAngeloGioacchino Del Regno u64 first, last;
93692e1a08SAngeloGioacchino Del Regno int last_entry = lut_size - 1;
94692e1a08SAngeloGioacchino Del Regno
95692e1a08SAngeloGioacchino Del Regno first = lut[0].red + lut[0].green + lut[0].blue;
96692e1a08SAngeloGioacchino Del Regno last = lut[last_entry].red + lut[last_entry].green + lut[last_entry].blue;
97692e1a08SAngeloGioacchino Del Regno
98692e1a08SAngeloGioacchino Del Regno return !!(first > last);
99692e1a08SAngeloGioacchino Del Regno }
100692e1a08SAngeloGioacchino Del Regno
101af0e042eSAngeloGioacchino Del Regno /*
102af0e042eSAngeloGioacchino Del Regno * SoCs supporting 12-bits LUTs are using a new register layout that does
103af0e042eSAngeloGioacchino Del Regno * always support (by HW) both 12-bits and 10-bits LUT but, on those, we
104af0e042eSAngeloGioacchino Del Regno * ignore the support for 10-bits in this driver and always use 12-bits.
105af0e042eSAngeloGioacchino Del Regno *
106af0e042eSAngeloGioacchino Del Regno * Summarizing:
107af0e042eSAngeloGioacchino Del Regno * - SoC HW support 9/10-bits LUT only
108af0e042eSAngeloGioacchino Del Regno * - Old register layout
109af0e042eSAngeloGioacchino Del Regno * - 10-bits LUT supported
110af0e042eSAngeloGioacchino Del Regno * - 9-bits LUT not supported
111af0e042eSAngeloGioacchino Del Regno * - SoC HW support both 10/12bits LUT
112af0e042eSAngeloGioacchino Del Regno * - New register layout
113af0e042eSAngeloGioacchino Del Regno * - 12-bits LUT supported
114af0e042eSAngeloGioacchino Del Regno * - 10-its LUT not supported
115af0e042eSAngeloGioacchino Del Regno */
mtk_gamma_set(struct device * dev,struct drm_crtc_state * state)116a6b39cd2SAngeloGioacchino Del Regno void mtk_gamma_set(struct device *dev, struct drm_crtc_state *state)
11769a4237aSYongqiang Niu {
118a6b39cd2SAngeloGioacchino Del Regno struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
119af0e042eSAngeloGioacchino Del Regno void __iomem *lut0_base = gamma->regs + DISP_GAMMA_LUT;
120af0e042eSAngeloGioacchino Del Regno void __iomem *lut1_base = gamma->regs + DISP_GAMMA_LUT1;
121af0e042eSAngeloGioacchino Del Regno u32 cfg_val, data_mode, lbank_val, word[2];
122af0e042eSAngeloGioacchino Del Regno u8 lut_bits = gamma->data->lut_bits;
1234708b01aSAngeloGioacchino Del Regno int cur_bank, num_lut_banks;
124af0e042eSAngeloGioacchino Del Regno struct drm_color_lut *lut;
125af0e042eSAngeloGioacchino Del Regno unsigned int i;
12669a4237aSYongqiang Niu
127aa5fb24fSAngeloGioacchino Del Regno /* If there's no gamma lut there's nothing to do here. */
128aa5fb24fSAngeloGioacchino Del Regno if (!state->gamma_lut)
129aa5fb24fSAngeloGioacchino Del Regno return;
130aa5fb24fSAngeloGioacchino Del Regno
1314708b01aSAngeloGioacchino Del Regno num_lut_banks = gamma->data->lut_size / gamma->data->lut_bank_size;
13269a4237aSYongqiang Niu lut = (struct drm_color_lut *)state->gamma_lut->data;
1334708b01aSAngeloGioacchino Del Regno
134af0e042eSAngeloGioacchino Del Regno /* Switch to 12 bits data mode if supported */
135af0e042eSAngeloGioacchino Del Regno data_mode = FIELD_PREP(DISP_GAMMA_BANK_DATA_MODE, !!(lut_bits == 12));
136af0e042eSAngeloGioacchino Del Regno
1374708b01aSAngeloGioacchino Del Regno for (cur_bank = 0; cur_bank < num_lut_banks; cur_bank++) {
1384708b01aSAngeloGioacchino Del Regno
1394708b01aSAngeloGioacchino Del Regno /* Switch gamma bank and set data mode before writing LUT */
1404708b01aSAngeloGioacchino Del Regno if (num_lut_banks > 1) {
1414708b01aSAngeloGioacchino Del Regno lbank_val = FIELD_PREP(DISP_GAMMA_BANK_BANK, cur_bank);
142af0e042eSAngeloGioacchino Del Regno lbank_val |= data_mode;
1434708b01aSAngeloGioacchino Del Regno writel(lbank_val, gamma->regs + DISP_GAMMA_BANK);
1444708b01aSAngeloGioacchino Del Regno }
1454708b01aSAngeloGioacchino Del Regno
1464708b01aSAngeloGioacchino Del Regno for (i = 0; i < gamma->data->lut_bank_size; i++) {
1474708b01aSAngeloGioacchino Del Regno int n = cur_bank * gamma->data->lut_bank_size + i;
148c18119deSAngeloGioacchino Del Regno struct drm_color_lut diff, hwlut;
149ba99d08dSYongqiang Niu
150af0e042eSAngeloGioacchino Del Regno hwlut.red = drm_color_lut_extract(lut[n].red, lut_bits);
151af0e042eSAngeloGioacchino Del Regno hwlut.green = drm_color_lut_extract(lut[n].green, lut_bits);
152af0e042eSAngeloGioacchino Del Regno hwlut.blue = drm_color_lut_extract(lut[n].blue, lut_bits);
153c18119deSAngeloGioacchino Del Regno
154a6b39cd2SAngeloGioacchino Del Regno if (!gamma->data->lut_diff || (i % 2 == 0)) {
155af0e042eSAngeloGioacchino Del Regno if (lut_bits == 12) {
156af0e042eSAngeloGioacchino Del Regno word[0] = FIELD_PREP(DISP_GAMMA_LUT_12BIT_R, hwlut.red);
157af0e042eSAngeloGioacchino Del Regno word[0] |= FIELD_PREP(DISP_GAMMA_LUT_12BIT_G, hwlut.green);
158af0e042eSAngeloGioacchino Del Regno word[1] = FIELD_PREP(DISP_GAMMA_LUT_12BIT_B, hwlut.blue);
159af0e042eSAngeloGioacchino Del Regno } else {
160af0e042eSAngeloGioacchino Del Regno word[0] = FIELD_PREP(DISP_GAMMA_LUT_10BIT_R, hwlut.red);
161af0e042eSAngeloGioacchino Del Regno word[0] |= FIELD_PREP(DISP_GAMMA_LUT_10BIT_G, hwlut.green);
162af0e042eSAngeloGioacchino Del Regno word[0] |= FIELD_PREP(DISP_GAMMA_LUT_10BIT_B, hwlut.blue);
163af0e042eSAngeloGioacchino Del Regno }
164c18119deSAngeloGioacchino Del Regno } else {
1654708b01aSAngeloGioacchino Del Regno diff.red = lut[n].red - lut[n - 1].red;
166af0e042eSAngeloGioacchino Del Regno diff.red = drm_color_lut_extract(diff.red, lut_bits);
167c18119deSAngeloGioacchino Del Regno
1684708b01aSAngeloGioacchino Del Regno diff.green = lut[n].green - lut[n - 1].green;
169af0e042eSAngeloGioacchino Del Regno diff.green = drm_color_lut_extract(diff.green, lut_bits);
170c18119deSAngeloGioacchino Del Regno
1714708b01aSAngeloGioacchino Del Regno diff.blue = lut[n].blue - lut[n - 1].blue;
172af0e042eSAngeloGioacchino Del Regno diff.blue = drm_color_lut_extract(diff.blue, lut_bits);
173c18119deSAngeloGioacchino Del Regno
174af0e042eSAngeloGioacchino Del Regno if (lut_bits == 12) {
175af0e042eSAngeloGioacchino Del Regno word[0] = FIELD_PREP(DISP_GAMMA_LUT_12BIT_R, diff.red);
176af0e042eSAngeloGioacchino Del Regno word[0] |= FIELD_PREP(DISP_GAMMA_LUT_12BIT_G, diff.green);
177af0e042eSAngeloGioacchino Del Regno word[1] = FIELD_PREP(DISP_GAMMA_LUT_12BIT_B, diff.blue);
178af0e042eSAngeloGioacchino Del Regno } else {
179af0e042eSAngeloGioacchino Del Regno word[0] = FIELD_PREP(DISP_GAMMA_LUT_10BIT_R, diff.red);
180af0e042eSAngeloGioacchino Del Regno word[0] |= FIELD_PREP(DISP_GAMMA_LUT_10BIT_G, diff.green);
181af0e042eSAngeloGioacchino Del Regno word[0] |= FIELD_PREP(DISP_GAMMA_LUT_10BIT_B, diff.blue);
182ba99d08dSYongqiang Niu }
183af0e042eSAngeloGioacchino Del Regno }
184af0e042eSAngeloGioacchino Del Regno writel(word[0], lut0_base + i * 4);
185af0e042eSAngeloGioacchino Del Regno if (lut_bits == 12)
186af0e042eSAngeloGioacchino Del Regno writel(word[1], lut1_base + i * 4);
18769a4237aSYongqiang Niu }
1884708b01aSAngeloGioacchino Del Regno }
1890d4caaafSAngeloGioacchino Del Regno
190a6b39cd2SAngeloGioacchino Del Regno cfg_val = readl(gamma->regs + DISP_GAMMA_CFG);
1910d4caaafSAngeloGioacchino Del Regno
192692e1a08SAngeloGioacchino Del Regno if (!gamma->data->has_dither) {
193692e1a08SAngeloGioacchino Del Regno /* Descending or Rising LUT */
194692e1a08SAngeloGioacchino Del Regno if (mtk_gamma_lut_is_descending(lut, gamma->data->lut_size - 1))
195692e1a08SAngeloGioacchino Del Regno cfg_val |= FIELD_PREP(GAMMA_LUT_TYPE, 1);
196692e1a08SAngeloGioacchino Del Regno else
197692e1a08SAngeloGioacchino Del Regno cfg_val &= ~GAMMA_LUT_TYPE;
198692e1a08SAngeloGioacchino Del Regno }
199692e1a08SAngeloGioacchino Del Regno
2000d4caaafSAngeloGioacchino Del Regno /* Enable the gamma table */
2016e46998cSAngeloGioacchino Del Regno cfg_val |= FIELD_PREP(GAMMA_LUT_EN, 1);
2020d4caaafSAngeloGioacchino Del Regno
203921e902bSAngeloGioacchino Del Regno /* Disable RELAY mode to pass the processed image */
204921e902bSAngeloGioacchino Del Regno cfg_val &= ~GAMMA_RELAY_MODE;
205921e902bSAngeloGioacchino Del Regno
2069aa6a662SAngeloGioacchino Del Regno writel(cfg_val, gamma->regs + DISP_GAMMA_CFG);
20769a4237aSYongqiang Niu }
20869a4237aSYongqiang Niu
mtk_gamma_config(struct device * dev,unsigned int w,unsigned int h,unsigned int vrefresh,unsigned int bpc,struct cmdq_pkt * cmdq_pkt)20969a4237aSYongqiang Niu void mtk_gamma_config(struct device *dev, unsigned int w,
21069a4237aSYongqiang Niu unsigned int h, unsigned int vrefresh,
21169a4237aSYongqiang Niu unsigned int bpc, struct cmdq_pkt *cmdq_pkt)
21269a4237aSYongqiang Niu {
21369a4237aSYongqiang Niu struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
2146e46998cSAngeloGioacchino Del Regno u32 sz;
21569a4237aSYongqiang Niu
2166e46998cSAngeloGioacchino Del Regno sz = FIELD_PREP(DISP_GAMMA_SIZE_HSIZE, w);
2176e46998cSAngeloGioacchino Del Regno sz |= FIELD_PREP(DISP_GAMMA_SIZE_VSIZE, h);
2186e46998cSAngeloGioacchino Del Regno
2196e46998cSAngeloGioacchino Del Regno mtk_ddp_write(cmdq_pkt, sz, &gamma->cmdq_reg, gamma->regs, DISP_GAMMA_SIZE);
2204a15d1acSYongqiang Niu if (gamma->data && gamma->data->has_dither)
2214a15d1acSYongqiang Niu mtk_dither_set_common(gamma->regs, &gamma->cmdq_reg, bpc,
2224a15d1acSYongqiang Niu DISP_GAMMA_CFG, GAMMA_DITHERING, cmdq_pkt);
22369a4237aSYongqiang Niu }
22469a4237aSYongqiang Niu
mtk_gamma_start(struct device * dev)22569a4237aSYongqiang Niu void mtk_gamma_start(struct device *dev)
22669a4237aSYongqiang Niu {
22769a4237aSYongqiang Niu struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
22869a4237aSYongqiang Niu
22969a4237aSYongqiang Niu writel(GAMMA_EN, gamma->regs + DISP_GAMMA_EN);
23069a4237aSYongqiang Niu }
23169a4237aSYongqiang Niu
mtk_gamma_stop(struct device * dev)23269a4237aSYongqiang Niu void mtk_gamma_stop(struct device *dev)
23369a4237aSYongqiang Niu {
23469a4237aSYongqiang Niu struct mtk_disp_gamma *gamma = dev_get_drvdata(dev);
23569a4237aSYongqiang Niu
23669a4237aSYongqiang Niu writel_relaxed(0x0, gamma->regs + DISP_GAMMA_EN);
23769a4237aSYongqiang Niu }
23869a4237aSYongqiang Niu
mtk_disp_gamma_bind(struct device * dev,struct device * master,void * data)23969a4237aSYongqiang Niu static int mtk_disp_gamma_bind(struct device *dev, struct device *master,
24069a4237aSYongqiang Niu void *data)
24169a4237aSYongqiang Niu {
24269a4237aSYongqiang Niu return 0;
24369a4237aSYongqiang Niu }
24469a4237aSYongqiang Niu
mtk_disp_gamma_unbind(struct device * dev,struct device * master,void * data)24569a4237aSYongqiang Niu static void mtk_disp_gamma_unbind(struct device *dev, struct device *master,
24669a4237aSYongqiang Niu void *data)
24769a4237aSYongqiang Niu {
24869a4237aSYongqiang Niu }
24969a4237aSYongqiang Niu
25069a4237aSYongqiang Niu static const struct component_ops mtk_disp_gamma_component_ops = {
25169a4237aSYongqiang Niu .bind = mtk_disp_gamma_bind,
25269a4237aSYongqiang Niu .unbind = mtk_disp_gamma_unbind,
25369a4237aSYongqiang Niu };
25469a4237aSYongqiang Niu
mtk_disp_gamma_probe(struct platform_device * pdev)25569a4237aSYongqiang Niu static int mtk_disp_gamma_probe(struct platform_device *pdev)
25669a4237aSYongqiang Niu {
25769a4237aSYongqiang Niu struct device *dev = &pdev->dev;
25869a4237aSYongqiang Niu struct mtk_disp_gamma *priv;
25969a4237aSYongqiang Niu struct resource *res;
26069a4237aSYongqiang Niu int ret;
26169a4237aSYongqiang Niu
26269a4237aSYongqiang Niu priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
26369a4237aSYongqiang Niu if (!priv)
26469a4237aSYongqiang Niu return -ENOMEM;
26569a4237aSYongqiang Niu
26669a4237aSYongqiang Niu priv->clk = devm_clk_get(dev, NULL);
267*45b70f71SNícolas F. R. A. Prado if (IS_ERR(priv->clk))
268*45b70f71SNícolas F. R. A. Prado return dev_err_probe(dev, PTR_ERR(priv->clk),
269*45b70f71SNícolas F. R. A. Prado "failed to get gamma clk\n");
27069a4237aSYongqiang Niu
27169a4237aSYongqiang Niu res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
27269a4237aSYongqiang Niu priv->regs = devm_ioremap_resource(dev, res);
273*45b70f71SNícolas F. R. A. Prado if (IS_ERR(priv->regs))
274*45b70f71SNícolas F. R. A. Prado return dev_err_probe(dev, PTR_ERR(priv->regs),
275*45b70f71SNícolas F. R. A. Prado "failed to ioremap gamma\n");
27669a4237aSYongqiang Niu
27769a4237aSYongqiang Niu #if IS_REACHABLE(CONFIG_MTK_CMDQ)
27869a4237aSYongqiang Niu ret = cmdq_dev_get_client_reg(dev, &priv->cmdq_reg, 0);
27969a4237aSYongqiang Niu if (ret)
28069a4237aSYongqiang Niu dev_dbg(dev, "get mediatek,gce-client-reg fail!\n");
28169a4237aSYongqiang Niu #endif
28269a4237aSYongqiang Niu
28369a4237aSYongqiang Niu priv->data = of_device_get_match_data(dev);
28469a4237aSYongqiang Niu platform_set_drvdata(pdev, priv);
28569a4237aSYongqiang Niu
28669a4237aSYongqiang Niu ret = component_add(dev, &mtk_disp_gamma_component_ops);
28769a4237aSYongqiang Niu if (ret)
288*45b70f71SNícolas F. R. A. Prado return dev_err_probe(dev, ret, "Failed to add component\n");
28969a4237aSYongqiang Niu
290*45b70f71SNícolas F. R. A. Prado return 0;
29169a4237aSYongqiang Niu }
29269a4237aSYongqiang Niu
mtk_disp_gamma_remove(struct platform_device * pdev)293b3af12a0SUwe Kleine-König static void mtk_disp_gamma_remove(struct platform_device *pdev)
29469a4237aSYongqiang Niu {
29569a4237aSYongqiang Niu component_del(&pdev->dev, &mtk_disp_gamma_component_ops);
29669a4237aSYongqiang Niu }
29769a4237aSYongqiang Niu
2984a15d1acSYongqiang Niu static const struct mtk_disp_gamma_data mt8173_gamma_driver_data = {
2994a15d1acSYongqiang Niu .has_dither = true,
3004708b01aSAngeloGioacchino Del Regno .lut_bank_size = 512,
301af0e042eSAngeloGioacchino Del Regno .lut_bits = 10,
302d243907bSAngeloGioacchino Del Regno .lut_size = 512,
3034a15d1acSYongqiang Niu };
3044a15d1acSYongqiang Niu
305ba99d08dSYongqiang Niu static const struct mtk_disp_gamma_data mt8183_gamma_driver_data = {
3064708b01aSAngeloGioacchino Del Regno .lut_bank_size = 512,
307af0e042eSAngeloGioacchino Del Regno .lut_bits = 10,
308ba99d08dSYongqiang Niu .lut_diff = true,
309d243907bSAngeloGioacchino Del Regno .lut_size = 512,
310ba99d08dSYongqiang Niu };
311ba99d08dSYongqiang Niu
3126841f6f9SAngeloGioacchino Del Regno static const struct mtk_disp_gamma_data mt8195_gamma_driver_data = {
3136841f6f9SAngeloGioacchino Del Regno .lut_bank_size = 256,
3146841f6f9SAngeloGioacchino Del Regno .lut_bits = 12,
3156841f6f9SAngeloGioacchino Del Regno .lut_diff = true,
3166841f6f9SAngeloGioacchino Del Regno .lut_size = 1024,
3176841f6f9SAngeloGioacchino Del Regno };
3186841f6f9SAngeloGioacchino Del Regno
31969a4237aSYongqiang Niu static const struct of_device_id mtk_disp_gamma_driver_dt_match[] = {
3204a15d1acSYongqiang Niu { .compatible = "mediatek,mt8173-disp-gamma",
3214a15d1acSYongqiang Niu .data = &mt8173_gamma_driver_data},
322ba99d08dSYongqiang Niu { .compatible = "mediatek,mt8183-disp-gamma",
323ba99d08dSYongqiang Niu .data = &mt8183_gamma_driver_data},
3246841f6f9SAngeloGioacchino Del Regno { .compatible = "mediatek,mt8195-disp-gamma",
3256841f6f9SAngeloGioacchino Del Regno .data = &mt8195_gamma_driver_data},
32669a4237aSYongqiang Niu {},
32769a4237aSYongqiang Niu };
32869a4237aSYongqiang Niu MODULE_DEVICE_TABLE(of, mtk_disp_gamma_driver_dt_match);
32969a4237aSYongqiang Niu
33069a4237aSYongqiang Niu struct platform_driver mtk_disp_gamma_driver = {
33169a4237aSYongqiang Niu .probe = mtk_disp_gamma_probe,
332b3af12a0SUwe Kleine-König .remove_new = mtk_disp_gamma_remove,
33369a4237aSYongqiang Niu .driver = {
33469a4237aSYongqiang Niu .name = "mediatek-disp-gamma",
33569a4237aSYongqiang Niu .of_match_table = mtk_disp_gamma_driver_dt_match,
33669a4237aSYongqiang Niu },
33769a4237aSYongqiang Niu };
338