1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2015-2016 MediaTek Inc.
4 * Author: Houlong Wei <houlong.wei@mediatek.com>
5 * Ming Hsiu Tsai <minghsiu.tsai@mediatek.com>
6 */
7
8 #include <linux/platform_device.h>
9
10 #include "mtk_mdp_core.h"
11 #include "mtk_mdp_regs.h"
12
13
14 #define MDP_COLORFMT_PACK(VIDEO, PLANE, COPLANE, HF, VF, BITS, GROUP, SWAP, ID)\
15 (((VIDEO) << 27) | ((PLANE) << 24) | ((COPLANE) << 22) |\
16 ((HF) << 20) | ((VF) << 18) | ((BITS) << 8) | ((GROUP) << 6) |\
17 ((SWAP) << 5) | ((ID) << 0))
18
19 enum MDP_COLOR_ENUM {
20 MDP_COLOR_UNKNOWN = 0,
21 MDP_COLOR_NV12 = MDP_COLORFMT_PACK(0, 2, 1, 1, 1, 8, 1, 0, 12),
22 MDP_COLOR_I420 = MDP_COLORFMT_PACK(0, 3, 0, 1, 1, 8, 1, 0, 8),
23 MDP_COLOR_YV12 = MDP_COLORFMT_PACK(0, 3, 0, 1, 1, 8, 1, 1, 8),
24 /* Mediatek proprietary format */
25 MDP_COLOR_420_MT21 = MDP_COLORFMT_PACK(5, 2, 1, 1, 1, 256, 1, 0, 12),
26 };
27
mtk_mdp_map_color_format(int v4l2_format)28 static int32_t mtk_mdp_map_color_format(int v4l2_format)
29 {
30 switch (v4l2_format) {
31 case V4L2_PIX_FMT_NV12M:
32 case V4L2_PIX_FMT_NV12:
33 return MDP_COLOR_NV12;
34 case V4L2_PIX_FMT_MT21C:
35 return MDP_COLOR_420_MT21;
36 case V4L2_PIX_FMT_YUV420M:
37 case V4L2_PIX_FMT_YUV420:
38 return MDP_COLOR_I420;
39 case V4L2_PIX_FMT_YVU420:
40 return MDP_COLOR_YV12;
41 }
42
43 mtk_mdp_err("Unknown format 0x%x", v4l2_format);
44
45 return MDP_COLOR_UNKNOWN;
46 }
47
mtk_mdp_hw_set_input_addr(struct mtk_mdp_ctx * ctx,struct mtk_mdp_addr * addr)48 void mtk_mdp_hw_set_input_addr(struct mtk_mdp_ctx *ctx,
49 struct mtk_mdp_addr *addr)
50 {
51 struct mdp_buffer *src_buf = &ctx->vpu.vsi->src_buffer;
52 int i;
53
54 for (i = 0; i < ARRAY_SIZE(addr->addr); i++)
55 src_buf->addr_mva[i] = (uint64_t)addr->addr[i];
56 }
57
mtk_mdp_hw_set_output_addr(struct mtk_mdp_ctx * ctx,struct mtk_mdp_addr * addr)58 void mtk_mdp_hw_set_output_addr(struct mtk_mdp_ctx *ctx,
59 struct mtk_mdp_addr *addr)
60 {
61 struct mdp_buffer *dst_buf = &ctx->vpu.vsi->dst_buffer;
62 int i;
63
64 for (i = 0; i < ARRAY_SIZE(addr->addr); i++)
65 dst_buf->addr_mva[i] = (uint64_t)addr->addr[i];
66 }
67
mtk_mdp_hw_set_in_size(struct mtk_mdp_ctx * ctx)68 void mtk_mdp_hw_set_in_size(struct mtk_mdp_ctx *ctx)
69 {
70 struct mtk_mdp_frame *frame = &ctx->s_frame;
71 struct mdp_config *config = &ctx->vpu.vsi->src_config;
72
73 /* Set input pixel offset */
74 config->crop_x = frame->crop.left;
75 config->crop_y = frame->crop.top;
76
77 /* Set input cropped size */
78 config->crop_w = frame->crop.width;
79 config->crop_h = frame->crop.height;
80
81 /* Set input original size */
82 config->x = 0;
83 config->y = 0;
84 config->w = frame->width;
85 config->h = frame->height;
86 }
87
mtk_mdp_hw_set_in_image_format(struct mtk_mdp_ctx * ctx)88 void mtk_mdp_hw_set_in_image_format(struct mtk_mdp_ctx *ctx)
89 {
90 unsigned int i;
91 struct mtk_mdp_frame *frame = &ctx->s_frame;
92 struct mdp_config *config = &ctx->vpu.vsi->src_config;
93 struct mdp_buffer *src_buf = &ctx->vpu.vsi->src_buffer;
94
95 src_buf->plane_num = frame->fmt->num_comp;
96 config->format = mtk_mdp_map_color_format(frame->fmt->pixelformat);
97 config->w_stride = 0; /* MDP will calculate it by color format. */
98 config->h_stride = 0; /* MDP will calculate it by color format. */
99
100 for (i = 0; i < src_buf->plane_num; i++)
101 src_buf->plane_size[i] = frame->payload[i];
102 }
103
mtk_mdp_hw_set_out_size(struct mtk_mdp_ctx * ctx)104 void mtk_mdp_hw_set_out_size(struct mtk_mdp_ctx *ctx)
105 {
106 struct mtk_mdp_frame *frame = &ctx->d_frame;
107 struct mdp_config *config = &ctx->vpu.vsi->dst_config;
108
109 config->crop_x = frame->crop.left;
110 config->crop_y = frame->crop.top;
111 config->crop_w = frame->crop.width;
112 config->crop_h = frame->crop.height;
113 config->x = 0;
114 config->y = 0;
115 config->w = frame->width;
116 config->h = frame->height;
117 }
118
mtk_mdp_hw_set_out_image_format(struct mtk_mdp_ctx * ctx)119 void mtk_mdp_hw_set_out_image_format(struct mtk_mdp_ctx *ctx)
120 {
121 unsigned int i;
122 struct mtk_mdp_frame *frame = &ctx->d_frame;
123 struct mdp_config *config = &ctx->vpu.vsi->dst_config;
124 struct mdp_buffer *dst_buf = &ctx->vpu.vsi->dst_buffer;
125
126 dst_buf->plane_num = frame->fmt->num_comp;
127 config->format = mtk_mdp_map_color_format(frame->fmt->pixelformat);
128 config->w_stride = 0; /* MDP will calculate it by color format. */
129 config->h_stride = 0; /* MDP will calculate it by color format. */
130 for (i = 0; i < dst_buf->plane_num; i++)
131 dst_buf->plane_size[i] = frame->payload[i];
132 }
133
mtk_mdp_hw_set_rotation(struct mtk_mdp_ctx * ctx)134 void mtk_mdp_hw_set_rotation(struct mtk_mdp_ctx *ctx)
135 {
136 struct mdp_config_misc *misc = &ctx->vpu.vsi->misc;
137
138 misc->orientation = ctx->ctrls.rotate->val;
139 misc->hflip = ctx->ctrls.hflip->val;
140 misc->vflip = ctx->ctrls.vflip->val;
141 }
142
mtk_mdp_hw_set_global_alpha(struct mtk_mdp_ctx * ctx)143 void mtk_mdp_hw_set_global_alpha(struct mtk_mdp_ctx *ctx)
144 {
145 struct mdp_config_misc *misc = &ctx->vpu.vsi->misc;
146
147 misc->alpha = ctx->ctrls.global_alpha->val;
148 }
149