dc-cf.c

  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * Copyright 2024 NXP
  4 */
  5
  6#include <linux/bitfield.h>
  7#include <linux/bits.h>
  8#include <linux/component.h>
  9#include <linux/ioport.h>
 10#include <linux/mod_devicetable.h>
 11#include <linux/module.h>
 12#include <linux/platform_device.h>
 13#include <linux/regmap.h>
 14
 15#include "dc-drv.h"
 16#include "dc-pe.h"
 17
 18#define STATICCONTROL		0x8
 19
 20#define FRAMEDIMENSIONS		0xc
 21#define  HEIGHT(x)		FIELD_PREP(GENMASK(29, 16), ((x) - 1))
 22#define  WIDTH(x)		FIELD_PREP(GENMASK(13, 0), ((x) - 1))
 23
 24#define CONSTANTCOLOR		0x10
 25#define  BLUE(x)		FIELD_PREP(GENMASK(15, 8), (x))
 26
 27static const struct dc_subdev_info dc_cf_info[] = {
 28	{ .reg_start = 0x56180960, .id = 0, },
 29	{ .reg_start = 0x561809e0, .id = 1, },
 30	{ .reg_start = 0x561809a0, .id = 4, },
 31	{ .reg_start = 0x56180a20, .id = 5, },
 32};
 33
 34static const struct regmap_range dc_cf_regmap_ranges[] = {
 35	regmap_reg_range(STATICCONTROL, CONSTANTCOLOR),
 36};
 37
 38static const struct regmap_access_table dc_cf_regmap_access_table = {
 39	.yes_ranges = dc_cf_regmap_ranges,
 40	.n_yes_ranges = ARRAY_SIZE(dc_cf_regmap_ranges),
 41};
 42
 43static const struct regmap_config dc_cf_cfg_regmap_config = {
 44	.name = "cfg",
 45	.reg_bits = 32,
 46	.reg_stride = 4,
 47	.val_bits = 32,
 48	.fast_io = true,
 49	.wr_table = &dc_cf_regmap_access_table,
 50	.rd_table = &dc_cf_regmap_access_table,
 51	.max_register = CONSTANTCOLOR,
 52};
 53
 54static inline void dc_cf_enable_shden(struct dc_cf *cf)
 55{
 56	regmap_write(cf->reg_cfg, STATICCONTROL, SHDEN);
 57}
 58
 59enum dc_link_id dc_cf_get_link_id(struct dc_cf *cf)
 60{
 61	return cf->link;
 62}
 63
 64void dc_cf_framedimensions(struct dc_cf *cf, unsigned int w,
 65			   unsigned int h)
 66{
 67	regmap_write(cf->reg_cfg, FRAMEDIMENSIONS, WIDTH(w) | HEIGHT(h));
 68}
 69
 70void dc_cf_constantcolor_black(struct dc_cf *cf)
 71{
 72	regmap_write(cf->reg_cfg, CONSTANTCOLOR, 0);
 73}
 74
 75void dc_cf_constantcolor_blue(struct dc_cf *cf)
 76{
 77	regmap_write(cf->reg_cfg, CONSTANTCOLOR, BLUE(0xff));
 78}
 79
 80void dc_cf_init(struct dc_cf *cf)
 81{
 82	dc_cf_enable_shden(cf);
 83}
 84
 85static int dc_cf_bind(struct device *dev, struct device *master, void *data)
 86{
 87	struct platform_device *pdev = to_platform_device(dev);
 88	struct dc_drm_device *dc_drm = data;
 89	struct resource *res_pec;
 90	void __iomem *base_cfg;
 91	struct dc_cf *cf;
 92	int id;
 93
 94	cf = devm_kzalloc(dev, sizeof(*cf), GFP_KERNEL);
 95	if (!cf)
 96		return -ENOMEM;
 97
 98	res_pec = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 99
100	base_cfg = devm_platform_ioremap_resource_byname(pdev, "cfg");
101	if (IS_ERR(base_cfg))
102		return PTR_ERR(base_cfg);
103
104	cf->reg_cfg = devm_regmap_init_mmio(dev, base_cfg,
105					    &dc_cf_cfg_regmap_config);
106	if (IS_ERR(cf->reg_cfg))
107		return PTR_ERR(cf->reg_cfg);
108
109	id = dc_subdev_get_id(dc_cf_info, ARRAY_SIZE(dc_cf_info), res_pec);
110	if (id < 0) {
111		dev_err(dev, "failed to get instance number: %d\n", id);
112		return id;
113	}
114
115	switch (id) {
116	case 0:
117		cf->link = LINK_ID_CONSTFRAME0;
118		dc_drm->cf_cont[0] = cf;
119		break;
120	case 1:
121		cf->link = LINK_ID_CONSTFRAME1;
122		dc_drm->cf_cont[1] = cf;
123		break;
124	case 4:
125		cf->link = LINK_ID_CONSTFRAME4;
126		dc_drm->cf_safe[0] = cf;
127		break;
128	case 5:
129		cf->link = LINK_ID_CONSTFRAME5;
130		dc_drm->cf_safe[1] = cf;
131		break;
132	}
133
134	return 0;
135}
136
137static const struct component_ops dc_cf_ops = {
138	.bind = dc_cf_bind,
139};
140
141static int dc_cf_probe(struct platform_device *pdev)
142{
143	int ret;
144
145	ret = component_add(&pdev->dev, &dc_cf_ops);
146	if (ret)
147		return dev_err_probe(&pdev->dev, ret,
148				     "failed to add component\n");
149
150	return 0;
151}
152
153static void dc_cf_remove(struct platform_device *pdev)
154{
155	component_del(&pdev->dev, &dc_cf_ops);
156}
157
158static const struct of_device_id dc_cf_dt_ids[] = {
159	{ .compatible = "fsl,imx8qxp-dc-constframe" },
160	{ /* sentinel */ }
161};
162MODULE_DEVICE_TABLE(of, dc_cf_dt_ids);
163
164struct platform_driver dc_cf_driver = {
165	.probe = dc_cf_probe,
166	.remove = dc_cf_remove,
167	.driver = {
168		.name = "imx8-dc-constframe",
169		.suppress_bind_attrs = true,
170		.of_match_table = dc_cf_dt_ids,
171	},
172};