1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
3  */
4 
5 #include <linux/iopoll.h>
6 
7 #include "dpu_hw_mdss.h"
8 #include "dpu_hwio.h"
9 #include "dpu_hw_catalog.h"
10 #include "dpu_hw_merge3d.h"
11 #include "dpu_kms.h"
12 #include "dpu_trace.h"
13 
14 #define MERGE_3D_MUX  0x000
15 #define MERGE_3D_MODE 0x004
16 
_merge_3d_offset(enum dpu_merge_3d idx,const struct dpu_mdss_cfg * m,void __iomem * addr,struct dpu_hw_blk_reg_map * b)17 static const struct dpu_merge_3d_cfg *_merge_3d_offset(enum dpu_merge_3d idx,
18 		const struct dpu_mdss_cfg *m,
19 		void __iomem *addr,
20 		struct dpu_hw_blk_reg_map *b)
21 {
22 	int i;
23 
24 	for (i = 0; i < m->merge_3d_count; i++) {
25 		if (idx == m->merge_3d[i].id) {
26 			b->base_off = addr;
27 			b->blk_off = m->merge_3d[i].base;
28 			b->length = m->merge_3d[i].len;
29 			b->hwversion = m->hwversion;
30 			b->log_mask = DPU_DBG_MASK_PINGPONG;
31 			return &m->merge_3d[i];
32 		}
33 	}
34 
35 	return ERR_PTR(-EINVAL);
36 }
37 
dpu_hw_merge_3d_setup_3d_mode(struct dpu_hw_merge_3d * merge_3d,enum dpu_3d_blend_mode mode_3d)38 static void dpu_hw_merge_3d_setup_3d_mode(struct dpu_hw_merge_3d *merge_3d,
39 			enum dpu_3d_blend_mode mode_3d)
40 {
41 	struct dpu_hw_blk_reg_map *c;
42 	u32 data;
43 
44 
45 	c = &merge_3d->hw;
46 	if (mode_3d == BLEND_3D_NONE) {
47 		DPU_REG_WRITE(c, MERGE_3D_MODE, 0);
48 		DPU_REG_WRITE(c, MERGE_3D_MUX, 0);
49 	} else {
50 		data = BIT(0) | ((mode_3d - 1) << 1);
51 		DPU_REG_WRITE(c, MERGE_3D_MODE, data);
52 	}
53 }
54 
_setup_merge_3d_ops(struct dpu_hw_merge_3d * c,unsigned long features)55 static void _setup_merge_3d_ops(struct dpu_hw_merge_3d *c,
56 				unsigned long features)
57 {
58 	c->ops.setup_3d_mode = dpu_hw_merge_3d_setup_3d_mode;
59 };
60 
dpu_hw_merge_3d_init(enum dpu_merge_3d idx,void __iomem * addr,const struct dpu_mdss_cfg * m)61 struct dpu_hw_merge_3d *dpu_hw_merge_3d_init(enum dpu_merge_3d idx,
62 		void __iomem *addr,
63 		const struct dpu_mdss_cfg *m)
64 {
65 	struct dpu_hw_merge_3d *c;
66 	const struct dpu_merge_3d_cfg *cfg;
67 
68 	c = kzalloc(sizeof(*c), GFP_KERNEL);
69 	if (!c)
70 		return ERR_PTR(-ENOMEM);
71 
72 	cfg = _merge_3d_offset(idx, m, addr, &c->hw);
73 	if (IS_ERR_OR_NULL(cfg)) {
74 		kfree(c);
75 		return ERR_PTR(-EINVAL);
76 	}
77 
78 	c->idx = idx;
79 	c->caps = cfg;
80 	_setup_merge_3d_ops(c, c->caps->features);
81 
82 	return c;
83 }
84 
dpu_hw_merge_3d_destroy(struct dpu_hw_merge_3d * hw)85 void dpu_hw_merge_3d_destroy(struct dpu_hw_merge_3d *hw)
86 {
87 	kfree(hw);
88 }
89