drivers/media/platform/mtk-mdp/mtk_mdp_regs.c

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