tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright 2024 NXP
4 */
5
6#include <linux/component.h>
7#include <linux/ioport.h>
8#include <linux/mod_devicetable.h>
9#include <linux/module.h>
10#include <linux/platform_device.h>
11#include <linux/regmap.h>
12
13#include <drm/drm_fourcc.h>
14
15#include "dc-drv.h"
16#include "dc-fu.h"
17
18#define BASEADDRESS(x) (0x10 + FRAC_OFFSET * (x))
19#define SOURCEBUFFERATTRIBUTES(x) (0x14 + FRAC_OFFSET * (x))
20#define SOURCEBUFFERDIMENSION(x) (0x18 + FRAC_OFFSET * (x))
21#define COLORCOMPONENTBITS(x) (0x1c + FRAC_OFFSET * (x))
22#define COLORCOMPONENTSHIFT(x) (0x20 + FRAC_OFFSET * (x))
23#define LAYEROFFSET(x) (0x24 + FRAC_OFFSET * (x))
24#define CLIPWINDOWOFFSET(x) (0x28 + FRAC_OFFSET * (x))
25#define CLIPWINDOWDIMENSIONS(x) (0x2c + FRAC_OFFSET * (x))
26#define CONSTANTCOLOR(x) (0x30 + FRAC_OFFSET * (x))
27#define LAYERPROPERTY(x) (0x34 + FRAC_OFFSET * (x))
28#define FRAMEDIMENSIONS 0x150
29
30struct dc_fl {
31 struct dc_fu fu;
32};
33
34static const struct dc_subdev_info dc_fl_info[] = {
35 { .reg_start = 0x56180ac0, .id = 0, },
36};
37
38static const struct regmap_range dc_fl_regmap_ranges[] = {
39 regmap_reg_range(STATICCONTROL, FRAMEDIMENSIONS),
40};
41
42static const struct regmap_access_table dc_fl_regmap_access_table = {
43 .yes_ranges = dc_fl_regmap_ranges,
44 .n_yes_ranges = ARRAY_SIZE(dc_fl_regmap_ranges),
45};
46
47static const struct regmap_config dc_fl_cfg_regmap_config = {
48 .name = "cfg",
49 .reg_bits = 32,
50 .reg_stride = 4,
51 .val_bits = 32,
52 .fast_io = true,
53 .wr_table = &dc_fl_regmap_access_table,
54 .rd_table = &dc_fl_regmap_access_table,
55 .max_register = FRAMEDIMENSIONS,
56};
57
58static void dc_fl_set_fmt(struct dc_fu *fu, enum dc_fu_frac frac,
59 const struct drm_format_info *format)
60{
61 u32 bits = 0, shifts = 0;
62
63 dc_fu_set_src_bpp(fu, frac, format->cpp[0] * 8);
64
65 regmap_write_bits(fu->reg_cfg, LAYERPROPERTY(frac),
66 YUVCONVERSIONMODE_MASK,
67 YUVCONVERSIONMODE(YUVCONVERSIONMODE_OFF));
68
69 dc_fu_get_pixel_format_bits(fu, format->format, &bits);
70 dc_fu_get_pixel_format_shifts(fu, format->format, &shifts);
71
72 regmap_write(fu->reg_cfg, COLORCOMPONENTBITS(frac), bits);
73 regmap_write(fu->reg_cfg, COLORCOMPONENTSHIFT(frac), shifts);
74}
75
76static void dc_fl_set_framedimensions(struct dc_fu *fu, int w, int h)
77{
78 regmap_write(fu->reg_cfg, FRAMEDIMENSIONS,
79 FRAMEWIDTH(w) | FRAMEHEIGHT(h));
80}
81
82static void dc_fl_init(struct dc_fu *fu)
83{
84 dc_fu_common_hw_init(fu);
85 dc_fu_shdldreq_sticky(fu, 0xff);
86}
87
88static void dc_fl_set_ops(struct dc_fu *fu)
89{
90 memcpy(&fu->ops, &dc_fu_common_ops, sizeof(dc_fu_common_ops));
91 fu->ops.init = dc_fl_init;
92 fu->ops.set_fmt = dc_fl_set_fmt;
93 fu->ops.set_framedimensions = dc_fl_set_framedimensions;
94}
95
96static int dc_fl_bind(struct device *dev, struct device *master, void *data)
97{
98 struct platform_device *pdev = to_platform_device(dev);
99 struct dc_drm_device *dc_drm = data;
100 struct resource *res_pec;
101 void __iomem *base_cfg;
102 struct dc_fl *fl;
103 struct dc_fu *fu;
104 int i, id;
105
106 fl = devm_kzalloc(dev, sizeof(*fl), GFP_KERNEL);
107 if (!fl)
108 return -ENOMEM;
109
110 fu = &fl->fu;
111
112 res_pec = platform_get_resource(pdev, IORESOURCE_MEM, 0);
113
114 base_cfg = devm_platform_ioremap_resource_byname(pdev, "cfg");
115 if (IS_ERR(base_cfg))
116 return PTR_ERR(base_cfg);
117
118 fu->reg_cfg = devm_regmap_init_mmio(dev, base_cfg,
119 &dc_fl_cfg_regmap_config);
120 if (IS_ERR(fu->reg_cfg))
121 return PTR_ERR(fu->reg_cfg);
122
123 id = dc_subdev_get_id(dc_fl_info, ARRAY_SIZE(dc_fl_info), res_pec);
124 if (id < 0) {
125 dev_err(dev, "failed to get instance number: %d\n", id);
126 return id;
127 }
128
129 fu->link_id = LINK_ID_FETCHLAYER0;
130 fu->id = DC_FETCHUNIT_FL0;
131 for (i = 0; i < DC_FETCHUNIT_FRAC_NUM; i++) {
132 fu->reg_baseaddr[i] = BASEADDRESS(i);
133 fu->reg_sourcebufferattributes[i] = SOURCEBUFFERATTRIBUTES(i);
134 fu->reg_sourcebufferdimension[i] = SOURCEBUFFERDIMENSION(i);
135 fu->reg_layeroffset[i] = LAYEROFFSET(i);
136 fu->reg_clipwindowoffset[i] = CLIPWINDOWOFFSET(i);
137 fu->reg_clipwindowdimensions[i] = CLIPWINDOWDIMENSIONS(i);
138 fu->reg_constantcolor[i] = CONSTANTCOLOR(i);
139 fu->reg_layerproperty[i] = LAYERPROPERTY(i);
140 }
141 snprintf(fu->name, sizeof(fu->name), "FetchLayer%d", id);
142
143 dc_fl_set_ops(fu);
144
145 dc_drm->fu_disp[fu->id] = fu;
146
147 return 0;
148}
149
150static const struct component_ops dc_fl_ops = {
151 .bind = dc_fl_bind,
152};
153
154static int dc_fl_probe(struct platform_device *pdev)
155{
156 int ret;
157
158 ret = component_add(&pdev->dev, &dc_fl_ops);
159 if (ret)
160 return dev_err_probe(&pdev->dev, ret,
161 "failed to add component\n");
162
163 return 0;
164}
165
166static void dc_fl_remove(struct platform_device *pdev)
167{
168 component_del(&pdev->dev, &dc_fl_ops);
169}
170
171static const struct of_device_id dc_fl_dt_ids[] = {
172 { .compatible = "fsl,imx8qxp-dc-fetchlayer" },
173 { /* sentinel */ }
174};
175MODULE_DEVICE_TABLE(of, dc_fl_dt_ids);
176
177struct platform_driver dc_fl_driver = {
178 .probe = dc_fl_probe,
179 .remove = dc_fl_remove,
180 .driver = {
181 .name = "imx8-dc-fetchlayer",
182 .suppress_bind_attrs = true,
183 .of_match_table = dc_fl_dt_ids,
184 },
185};