1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
3  */
4 
5 #include "dpu_kms.h"
6 #include "dpu_hw_catalog.h"
7 #include "dpu_hwio.h"
8 #include "dpu_hw_lm.h"
9 #include "dpu_hw_mdss.h"
10 
11 #define LM_OP_MODE                        0x00
12 #define LM_OUT_SIZE                       0x04
13 #define LM_BORDER_COLOR_0                 0x08
14 #define LM_BORDER_COLOR_1                 0x010
15 
16 /* These register are offset to mixer base + stage base */
17 #define LM_BLEND0_OP                     0x00
18 #define LM_BLEND0_CONST_ALPHA            0x04
19 #define LM_FG_COLOR_FILL_COLOR_0         0x08
20 #define LM_FG_COLOR_FILL_COLOR_1         0x0C
21 #define LM_FG_COLOR_FILL_SIZE            0x10
22 #define LM_FG_COLOR_FILL_XY              0x14
23 
24 #define LM_BLEND0_FG_ALPHA               0x04
25 #define LM_BLEND0_BG_ALPHA               0x08
26 
27 static const struct dpu_lm_cfg *_lm_offset(enum dpu_lm mixer,
28 		const struct dpu_mdss_cfg *m,
29 		void __iomem *addr,
30 		struct dpu_hw_blk_reg_map *b)
31 {
32 	int i;
33 
34 	for (i = 0; i < m->mixer_count; i++) {
35 		if (mixer == m->mixer[i].id) {
36 			b->base_off = addr;
37 			b->blk_off = m->mixer[i].base;
38 			b->length = m->mixer[i].len;
39 			b->hwversion = m->hwversion;
40 			b->log_mask = DPU_DBG_MASK_LM;
41 			return &m->mixer[i];
42 		}
43 	}
44 
45 	return ERR_PTR(-ENOMEM);
46 }
47 
48 /**
49  * _stage_offset(): returns the relative offset of the blend registers
50  * for the stage to be setup
51  * @c:     mixer ctx contains the mixer to be programmed
52  * @stage: stage index to setup
53  */
54 static inline int _stage_offset(struct dpu_hw_mixer *ctx, enum dpu_stage stage)
55 {
56 	const struct dpu_lm_sub_blks *sblk = ctx->cap->sblk;
57 	if (stage != DPU_STAGE_BASE && stage <= sblk->maxblendstages)
58 		return sblk->blendstage_base[stage - DPU_STAGE_0];
59 
60 	return -EINVAL;
61 }
62 
63 static void dpu_hw_lm_setup_out(struct dpu_hw_mixer *ctx,
64 		struct dpu_hw_mixer_cfg *mixer)
65 {
66 	struct dpu_hw_blk_reg_map *c = &ctx->hw;
67 	u32 outsize;
68 	u32 op_mode;
69 
70 	op_mode = DPU_REG_READ(c, LM_OP_MODE);
71 
72 	outsize = mixer->out_height << 16 | mixer->out_width;
73 	DPU_REG_WRITE(c, LM_OUT_SIZE, outsize);
74 
75 	/* SPLIT_LEFT_RIGHT */
76 	if (mixer->right_mixer)
77 		op_mode |= BIT(31);
78 	else
79 		op_mode &= ~BIT(31);
80 	DPU_REG_WRITE(c, LM_OP_MODE, op_mode);
81 }
82 
83 static void dpu_hw_lm_setup_border_color(struct dpu_hw_mixer *ctx,
84 		struct dpu_mdss_color *color,
85 		u8 border_en)
86 {
87 	struct dpu_hw_blk_reg_map *c = &ctx->hw;
88 
89 	if (border_en) {
90 		DPU_REG_WRITE(c, LM_BORDER_COLOR_0,
91 			(color->color_0 & 0xFFF) |
92 			((color->color_1 & 0xFFF) << 0x10));
93 		DPU_REG_WRITE(c, LM_BORDER_COLOR_1,
94 			(color->color_2 & 0xFFF) |
95 			((color->color_3 & 0xFFF) << 0x10));
96 	}
97 }
98 
99 static void dpu_hw_lm_setup_blend_config_sdm845(struct dpu_hw_mixer *ctx,
100 	u32 stage, u32 fg_alpha, u32 bg_alpha, u32 blend_op)
101 {
102 	struct dpu_hw_blk_reg_map *c = &ctx->hw;
103 	int stage_off;
104 	u32 const_alpha;
105 
106 	if (stage == DPU_STAGE_BASE)
107 		return;
108 
109 	stage_off = _stage_offset(ctx, stage);
110 	if (WARN_ON(stage_off < 0))
111 		return;
112 
113 	const_alpha = (bg_alpha & 0xFF) | ((fg_alpha & 0xFF) << 16);
114 	DPU_REG_WRITE(c, LM_BLEND0_CONST_ALPHA + stage_off, const_alpha);
115 	DPU_REG_WRITE(c, LM_BLEND0_OP + stage_off, blend_op);
116 }
117 
118 static void dpu_hw_lm_setup_blend_config(struct dpu_hw_mixer *ctx,
119 	u32 stage, u32 fg_alpha, u32 bg_alpha, u32 blend_op)
120 {
121 	struct dpu_hw_blk_reg_map *c = &ctx->hw;
122 	int stage_off;
123 
124 	if (stage == DPU_STAGE_BASE)
125 		return;
126 
127 	stage_off = _stage_offset(ctx, stage);
128 	if (WARN_ON(stage_off < 0))
129 		return;
130 
131 	DPU_REG_WRITE(c, LM_BLEND0_FG_ALPHA + stage_off, fg_alpha);
132 	DPU_REG_WRITE(c, LM_BLEND0_BG_ALPHA + stage_off, bg_alpha);
133 	DPU_REG_WRITE(c, LM_BLEND0_OP + stage_off, blend_op);
134 }
135 
136 static void dpu_hw_lm_setup_color3(struct dpu_hw_mixer *ctx,
137 	uint32_t mixer_op_mode)
138 {
139 	struct dpu_hw_blk_reg_map *c = &ctx->hw;
140 	int op_mode;
141 
142 	/* read the existing op_mode configuration */
143 	op_mode = DPU_REG_READ(c, LM_OP_MODE);
144 
145 	op_mode = (op_mode & (BIT(31) | BIT(30))) | mixer_op_mode;
146 
147 	DPU_REG_WRITE(c, LM_OP_MODE, op_mode);
148 }
149 
150 static void _setup_mixer_ops(const struct dpu_mdss_cfg *m,
151 		struct dpu_hw_lm_ops *ops,
152 		unsigned long features)
153 {
154 	ops->setup_mixer_out = dpu_hw_lm_setup_out;
155 	if (m->hwversion >= DPU_HW_VER_400)
156 		ops->setup_blend_config = dpu_hw_lm_setup_blend_config_sdm845;
157 	else
158 		ops->setup_blend_config = dpu_hw_lm_setup_blend_config;
159 	ops->setup_alpha_out = dpu_hw_lm_setup_color3;
160 	ops->setup_border_color = dpu_hw_lm_setup_border_color;
161 }
162 
163 static struct dpu_hw_blk_ops dpu_hw_ops;
164 
165 struct dpu_hw_mixer *dpu_hw_lm_init(enum dpu_lm idx,
166 		void __iomem *addr,
167 		const struct dpu_mdss_cfg *m)
168 {
169 	struct dpu_hw_mixer *c;
170 	const struct dpu_lm_cfg *cfg;
171 
172 	c = kzalloc(sizeof(*c), GFP_KERNEL);
173 	if (!c)
174 		return ERR_PTR(-ENOMEM);
175 
176 	cfg = _lm_offset(idx, m, addr, &c->hw);
177 	if (IS_ERR_OR_NULL(cfg)) {
178 		kfree(c);
179 		return ERR_PTR(-EINVAL);
180 	}
181 
182 	/* Assign ops */
183 	c->idx = idx;
184 	c->cap = cfg;
185 	_setup_mixer_ops(m, &c->ops, c->cap->features);
186 
187 	dpu_hw_blk_init(&c->base, DPU_HW_BLK_LM, idx, &dpu_hw_ops);
188 
189 	return c;
190 }
191 
192 void dpu_hw_lm_destroy(struct dpu_hw_mixer *lm)
193 {
194 	if (lm)
195 		dpu_hw_blk_destroy(&lm->base);
196 	kfree(lm);
197 }
198