1d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek/* drivers/video/msm/mdp_ppp.c 2d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * 3d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * Copyright (C) 2007 QUALCOMM Incorporated 4d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * Copyright (C) 2007 Google Incorporated 5d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * 6d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * This software is licensed under the terms of the GNU General Public 7d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * License version 2, as published by the Free Software Foundation, and 8d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * may be copied, distributed, and modified under those terms. 9d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * 10d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * This program is distributed in the hope that it will be useful, 11d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * but WITHOUT ANY WARRANTY; without even the implied warranty of 12d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * GNU General Public License for more details. 14d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek */ 15d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#include <linux/fb.h> 16d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#include <linux/file.h> 17d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#include <linux/delay.h> 18d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#include <linux/msm_mdp.h> 191ef21f6343ff08309955d1ad56ad0f5504a4dd94Arnd Bergmann#include <linux/platform_data/video-msm_fb.h> 20d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 21d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#include "mdp_hw.h" 22d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#include "mdp_scale_tables.h" 23d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 24d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define DLOG(x...) do {} while (0) 25d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 26d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define MDP_DOWNSCALE_BLUR (MDP_DOWNSCALE_MAX + 1) 27d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int downscale_y_table = MDP_DOWNSCALE_MAX; 28d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int downscale_x_table = MDP_DOWNSCALE_MAX; 29d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 30d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstruct mdp_regs { 31d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src0; 32d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src1; 33d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst0; 34d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst1; 35d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src_cfg; 36d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_cfg; 37d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src_pack; 38d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_pack; 39d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src_rect; 40d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_rect; 41d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src_ystride; 42d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_ystride; 43d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t op; 44d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src_bpp; 45d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_bpp; 46d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t edge; 47d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t phasex_init; 48d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t phasey_init; 49d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t phasex_step; 50d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t phasey_step; 51d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 52d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 53d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t pack_pattern[] = { 54d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ARRAY0(PACK_PATTERN) 55d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 56d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 57d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t src_img_cfg[] = { 58d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ARRAY1(CFG, SRC) 59d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 60d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 61d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t dst_img_cfg[] = { 62d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ARRAY1(CFG, DST) 63d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 64d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 65d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t bytes_per_pixel[] = { 66d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_RGB_565] = 2, 67d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_RGB_888] = 3, 68d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_XRGB_8888] = 4, 69d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_ARGB_8888] = 4, 70d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_RGBA_8888] = 4, 71d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_BGRA_8888] = 4, 72a8d380f30a7d8cc507fd5cc84b2dc5ee2b2144d7Dima Zavin [MDP_RGBX_8888] = 4, 73d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_Y_CBCR_H2V1] = 1, 74d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_Y_CBCR_H2V2] = 1, 75d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_Y_CRCB_H2V1] = 1, 76d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_Y_CRCB_H2V2] = 1, 77d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek [MDP_YCRYCB_H2V1] = 2 78d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 79d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 80d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t dst_op_chroma[] = { 81d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ARRAY1(CHROMA_SAMP, DST) 82d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 83d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 84d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t src_op_chroma[] = { 85d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ARRAY1(CHROMA_SAMP, SRC) 86d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 87d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 88d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t bg_op_chroma[] = { 89d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ARRAY1(CHROMA_SAMP, BG) 90d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 91d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 92d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void rotate_dst_addr_x(struct mdp_blit_req *req, struct mdp_regs *regs) 93d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 94d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst0 += (req->dst_rect.w - 95d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek min((uint32_t)16, req->dst_rect.w)) * regs->dst_bpp; 96d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst1 += (req->dst_rect.w - 97d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek min((uint32_t)16, req->dst_rect.w)) * regs->dst_bpp; 98d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 99d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 100d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void rotate_dst_addr_y(struct mdp_blit_req *req, struct mdp_regs *regs) 101d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 102d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst0 += (req->dst_rect.h - 103d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek min((uint32_t)16, req->dst_rect.h)) * 104d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst_ystride; 105d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst1 += (req->dst_rect.h - 106d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek min((uint32_t)16, req->dst_rect.h)) * 107d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst_ystride; 108d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 109d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 110d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void blit_rotate(struct mdp_blit_req *req, 111d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_regs *regs) 112d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 113d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags == MDP_ROT_NOP) 114d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return; 115d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 116d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_ROT_ON; 117d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if ((req->flags & MDP_ROT_90 || req->flags & MDP_FLIP_LR) && 118d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek !(req->flags & MDP_ROT_90 && req->flags & MDP_FLIP_LR)) 119d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek rotate_dst_addr_x(req, regs); 120d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags & MDP_ROT_90) 121d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_ROT_90; 122d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags & MDP_FLIP_UD) { 123d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_FLIP_UD; 124d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek rotate_dst_addr_y(req, regs); 125d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 126d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags & MDP_FLIP_LR) 127d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_FLIP_LR; 128d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 129d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 130d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void blit_convert(struct mdp_blit_req *req, struct mdp_regs *regs) 131d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 132d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->src.format == req->dst.format) 133d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return; 134d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (IS_RGB(req->src.format) && IS_YCRCB(req->dst.format)) { 135d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_CONVERT_RGB2YCBCR | PPP_OP_CONVERT_ON; 136d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else if (IS_YCRCB(req->src.format) && IS_RGB(req->dst.format)) { 137d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_CONVERT_YCBCR2RGB | PPP_OP_CONVERT_ON; 138d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->dst.format == MDP_RGB_565) 139d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_CONVERT_MATRIX_SECONDARY; 140d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 141d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 142d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 143d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define GET_BIT_RANGE(value, high, low) \ 144d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (((1 << (high - low + 1)) - 1) & (value >> low)) 145d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic uint32_t transp_convert(struct mdp_blit_req *req) 146d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 147d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t transp = 0; 148d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->src.format == MDP_RGB_565) { 149d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* pad each value to 8 bits by copying the high bits into the 150d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * low end, convert RGB to RBG by switching low 2 components */ 151d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek transp |= ((GET_BIT_RANGE(req->transp_mask, 15, 11) << 3) | 152d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (GET_BIT_RANGE(req->transp_mask, 15, 13))) << 16; 153d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 154d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek transp |= ((GET_BIT_RANGE(req->transp_mask, 4, 0) << 3) | 155d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (GET_BIT_RANGE(req->transp_mask, 4, 2))) << 8; 156d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 157d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek transp |= (GET_BIT_RANGE(req->transp_mask, 10, 5) << 2) | 158d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (GET_BIT_RANGE(req->transp_mask, 10, 9)); 159d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 160d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* convert RGB to RBG */ 161d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek transp |= (GET_BIT_RANGE(req->transp_mask, 15, 8)) | 162d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (GET_BIT_RANGE(req->transp_mask, 23, 16) << 16) | 163d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (GET_BIT_RANGE(req->transp_mask, 7, 0) << 8); 164d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 165d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return transp; 166d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 167d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#undef GET_BIT_RANGE 168d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 169d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void blit_blend(struct mdp_blit_req *req, struct mdp_regs *regs) 170d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 171d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* TRANSP BLEND */ 172d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->transp_mask != MDP_TRANSP_NOP) { 173d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->transp_mask = transp_convert(req); 174d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->alpha != MDP_ALPHA_NOP) { 175d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* use blended transparancy mode 176d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * pixel = (src == transp) ? dst : blend 177d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * blend is combo of blend_eq_sel and 178d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * blend_alpha_sel */ 179d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_ROT_ON | PPP_OP_BLEND_ON | 180d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_OP_BLEND_ALPHA_BLEND_NORMAL | 181d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_OP_BLEND_CONSTANT_ALPHA | 182d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_BLEND_ALPHA_TRANSP; 183d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 184d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* simple transparancy mode 185d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * pixel = (src == transp) ? dst : src */ 186d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_ROT_ON | PPP_OP_BLEND_ON | 187d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_OP_BLEND_SRCPIXEL_TRANSP; 188d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 189d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 190d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 191d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->alpha &= 0xff; 192d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* ALPHA BLEND */ 193d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (HAS_ALPHA(req->src.format)) { 194d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_ROT_ON | PPP_OP_BLEND_ON | 195d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_OP_BLEND_SRCPIXEL_ALPHA; 196d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else if (req->alpha < MDP_ALPHA_NOP) { 197d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* just blend by alpha */ 198d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= PPP_OP_ROT_ON | PPP_OP_BLEND_ON | 199d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_OP_BLEND_ALPHA_BLEND_NORMAL | 200d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_OP_BLEND_CONSTANT_ALPHA; 201d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 202d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 203d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= bg_op_chroma[req->dst.format]; 204d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 205d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 206d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define ONE_HALF (1LL << 32) 207d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define ONE (1LL << 33) 208d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define TWO (2LL << 33) 209d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define THREE (3LL << 33) 210d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define FRAC_MASK (ONE - 1) 211d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define INT_MASK (~FRAC_MASK) 212d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 213d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int scale_params(uint32_t dim_in, uint32_t dim_out, uint32_t origin, 214d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t *phase_init, uint32_t *phase_step) 215d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 216d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* to improve precicsion calculations are done in U31.33 and converted 217d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek * to U3.29 at the end */ 218d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int64_t k1, k2, k3, k4, tmp; 219d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint64_t n, d, os, os_p, od, od_p, oreq; 220d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek unsigned rpa = 0; 221d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int64_t ip64, delta; 222d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 223d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (dim_out % 3 == 0) 224d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek rpa = !(dim_in % (dim_out / 3)); 225d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 226d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek n = ((uint64_t)dim_out) << 34; 227d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek d = dim_in; 228d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!d) 229d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 230d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek do_div(n, d); 231d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek k3 = (n + 1) >> 1; 232d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if ((k3 >> 4) < (1LL << 27) || (k3 >> 4) > (1LL << 31)) { 233d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek DLOG("crap bad scale\n"); 234d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 235d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 236d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek n = ((uint64_t)dim_in) << 34; 237d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek d = (uint64_t)dim_out; 238d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!d) 239d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 240d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek do_div(n, d); 241d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek k1 = (n + 1) >> 1; 242d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek k2 = (k1 - ONE) >> 1; 243d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 244d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *phase_init = (int)(k2 >> 4); 245d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek k4 = (k3 - ONE) >> 1; 246d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 247d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (rpa) { 248d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek os = ((uint64_t)origin << 33) - ONE_HALF; 249d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek tmp = (dim_out * os) + ONE_HALF; 250d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!dim_in) 251d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 252d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek do_div(tmp, dim_in); 253d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek od = tmp - ONE_HALF; 254d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 255d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek os = ((uint64_t)origin << 1) - 1; 256d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek od = (((k3 * os) >> 1) + k4); 257d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 258d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 259d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek od_p = od & INT_MASK; 260d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (od_p != od) 261d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek od_p += ONE; 262d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 263d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (rpa) { 264d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek tmp = (dim_in * od_p) + ONE_HALF; 265d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!dim_in) 266d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 267d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek do_div(tmp, dim_in); 268d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek os_p = tmp - ONE_HALF; 269d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 270d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek os_p = ((k1 * (od_p >> 33)) + k2); 271d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 272d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 273d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek oreq = (os_p & INT_MASK) - ONE; 274d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 275d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek ip64 = os_p - oreq; 276d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek delta = ((int64_t)(origin) << 33) - oreq; 277d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek ip64 -= delta; 278d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* limit to valid range before the left shift */ 279d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek delta = (ip64 & (1LL << 63)) ? 4 : -4; 280d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek delta <<= 33; 281d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek while (abs((int)(ip64 >> 33)) > 4) 282d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek ip64 += delta; 283d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *phase_init = (int)(ip64 >> 4); 284d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *phase_step = (uint32_t)(k1 >> 4); 285d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 286d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 287d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 288d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void load_scale_table(const struct mdp_info *mdp, 289d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_table_entry *table, int len) 290d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 291d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int i; 292d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek for (i = 0; i < len; i++) 293d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, table[i].val, table[i].reg); 294d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 295d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 296d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekenum { 297d480ace08d5b59133575e672a0bd1c97b0f8400fPavel MachekIMG_LEFT, 298d480ace08d5b59133575e672a0bd1c97b0f8400fPavel MachekIMG_RIGHT, 299d480ace08d5b59133575e672a0bd1c97b0f8400fPavel MachekIMG_TOP, 300d480ace08d5b59133575e672a0bd1c97b0f8400fPavel MachekIMG_BOTTOM, 301d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek}; 302d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 303d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void get_edge_info(uint32_t src, uint32_t src_coord, uint32_t dst, 304d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t *interp1, uint32_t *interp2, 305d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t *repeat1, uint32_t *repeat2) { 306d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (src > 3 * dst) { 307d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp1 = 0; 308d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp2 = src - 1; 309d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat1 = 0; 310d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat2 = 0; 311d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else if (src == 3 * dst) { 312d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp1 = 0; 313d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp2 = src; 314d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat1 = 0; 315d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat2 = 1; 316d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else if (src > dst && src < 3 * dst) { 317d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp1 = -1; 318d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp2 = src; 319d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat1 = 1; 320d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat2 = 1; 321d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else if (src == dst) { 322d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp1 = -1; 323d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp2 = src + 1; 324d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat1 = 1; 325d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat2 = 2; 326d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 327d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp1 = -2; 328d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp2 = src + 1; 329d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat1 = 2; 330d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *repeat2 = 2; 331d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 332d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp1 += src_coord; 333d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *interp2 += src_coord; 334d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 335d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 336d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int get_edge_cond(struct mdp_blit_req *req, struct mdp_regs *regs) 337d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 338d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int32_t luma_interp[4]; 339d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int32_t luma_repeat[4]; 340d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int32_t chroma_interp[4]; 341d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int32_t chroma_bound[4]; 342d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek int32_t chroma_repeat[4]; 343d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_w, dst_h; 344d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 345d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek memset(&luma_interp, 0, sizeof(int32_t) * 4); 346d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek memset(&luma_repeat, 0, sizeof(int32_t) * 4); 347d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek memset(&chroma_interp, 0, sizeof(int32_t) * 4); 348d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek memset(&chroma_bound, 0, sizeof(int32_t) * 4); 349d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek memset(&chroma_repeat, 0, sizeof(int32_t) * 4); 350d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge = 0; 351d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 352d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags & MDP_ROT_90) { 353d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_w = req->dst_rect.h; 354d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_h = req->dst_rect.w; 355d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 356d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_w = req->dst_rect.w; 357d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_h = req->dst_rect.h; 358d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 359d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 360d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->op & (PPP_OP_SCALE_Y_ON | PPP_OP_SCALE_X_ON)) { 361d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek get_edge_info(req->src_rect.h, req->src_rect.y, dst_h, 362d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &luma_interp[IMG_TOP], &luma_interp[IMG_BOTTOM], 363d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &luma_repeat[IMG_TOP], &luma_repeat[IMG_BOTTOM]); 364d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek get_edge_info(req->src_rect.w, req->src_rect.x, dst_w, 365d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &luma_interp[IMG_LEFT], &luma_interp[IMG_RIGHT], 366d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &luma_repeat[IMG_LEFT], &luma_repeat[IMG_RIGHT]); 367d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 368d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_interp[IMG_LEFT] = req->src_rect.x; 369d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_interp[IMG_RIGHT] = req->src_rect.x + req->src_rect.w - 1; 370d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_interp[IMG_TOP] = req->src_rect.y; 371d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_interp[IMG_BOTTOM] = req->src_rect.y + req->src_rect.h - 1; 372d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_LEFT] = 0; 373d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_TOP] = 0; 374d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_RIGHT] = 0; 375d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_BOTTOM] = 0; 376d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 377d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 378d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_LEFT] = luma_interp[IMG_LEFT]; 379d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_RIGHT] = luma_interp[IMG_RIGHT]; 380d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_TOP] = luma_interp[IMG_TOP]; 381d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_BOTTOM] = luma_interp[IMG_BOTTOM]; 382d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 383d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_LEFT] = req->src_rect.x; 384d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_RIGHT] = req->src_rect.x + req->src_rect.w - 1; 385d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_TOP] = req->src_rect.y; 386d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_BOTTOM] = req->src_rect.y + req->src_rect.h - 1; 387d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 388d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (IS_YCRCB(req->src.format)) { 389d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_LEFT] = chroma_interp[IMG_LEFT] >> 1; 390d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_RIGHT] = (chroma_interp[IMG_RIGHT] + 1) >> 1; 391d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 392d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_LEFT] = chroma_bound[IMG_LEFT] >> 1; 393d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_RIGHT] = chroma_bound[IMG_RIGHT] >> 1; 394d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 395d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 396d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->src.format == MDP_Y_CBCR_H2V2 || 397d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->src.format == MDP_Y_CRCB_H2V2) { 398d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_TOP] = (chroma_interp[IMG_TOP] - 1) >> 1; 399d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_BOTTOM] = (chroma_interp[IMG_BOTTOM] + 1) 400d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek >> 1; 401d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_TOP] = (chroma_bound[IMG_TOP] + 1) >> 1; 402d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_BOTTOM] = chroma_bound[IMG_BOTTOM] >> 1; 403d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 404d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 405d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_LEFT] = chroma_bound[IMG_LEFT] - 406d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_LEFT]; 407d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_RIGHT] = chroma_interp[IMG_RIGHT] - 408d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_RIGHT]; 409d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_TOP] = chroma_bound[IMG_TOP] - 410d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_interp[IMG_TOP]; 411d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_BOTTOM] = chroma_interp[IMG_BOTTOM] - 412d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_bound[IMG_BOTTOM]; 413d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 414d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (chroma_repeat[IMG_LEFT] < 0 || chroma_repeat[IMG_LEFT] > 3 || 415d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_RIGHT] < 0 || chroma_repeat[IMG_RIGHT] > 3 || 416d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_TOP] < 0 || chroma_repeat[IMG_TOP] > 3 || 417d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek chroma_repeat[IMG_BOTTOM] < 0 || chroma_repeat[IMG_BOTTOM] > 3 || 418d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_LEFT] < 0 || luma_repeat[IMG_LEFT] > 3 || 419d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_RIGHT] < 0 || luma_repeat[IMG_RIGHT] > 3 || 420d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_TOP] < 0 || luma_repeat[IMG_TOP] > 3 || 421d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek luma_repeat[IMG_BOTTOM] < 0 || luma_repeat[IMG_BOTTOM] > 3) 422d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 423d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 424d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (chroma_repeat[IMG_LEFT] & 3) << MDP_LEFT_CHROMA; 425d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (chroma_repeat[IMG_RIGHT] & 3) << MDP_RIGHT_CHROMA; 426d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (chroma_repeat[IMG_TOP] & 3) << MDP_TOP_CHROMA; 427d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (chroma_repeat[IMG_BOTTOM] & 3) << MDP_BOTTOM_CHROMA; 428d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (luma_repeat[IMG_LEFT] & 3) << MDP_LEFT_LUMA; 429d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (luma_repeat[IMG_RIGHT] & 3) << MDP_RIGHT_LUMA; 430d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (luma_repeat[IMG_TOP] & 3) << MDP_TOP_LUMA; 431d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->edge |= (luma_repeat[IMG_BOTTOM] & 3) << MDP_BOTTOM_LUMA; 432d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 433d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 434d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 435d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int blit_scale(const struct mdp_info *mdp, struct mdp_blit_req *req, 436d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_regs *regs) 437d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 438d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t phase_init_x, phase_init_y, phase_step_x, phase_step_y; 439d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t scale_factor_x, scale_factor_y; 440d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t downscale; 441d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t dst_w, dst_h; 442d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 443d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags & MDP_ROT_90) { 444d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_w = req->dst_rect.h; 445d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_h = req->dst_rect.w; 446d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 447d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_w = req->dst_rect.w; 448d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek dst_h = req->dst_rect.h; 449d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 450d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if ((req->src_rect.w == dst_w) && (req->src_rect.h == dst_h) && 451d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek !(req->flags & MDP_BLUR)) { 452d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasex_init = 0; 453d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasey_init = 0; 454d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasex_step = 0; 455d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasey_step = 0; 456d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 457d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 458d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 459d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (scale_params(req->src_rect.w, dst_w, 1, &phase_init_x, 460d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &phase_step_x) || 461d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek scale_params(req->src_rect.h, dst_h, 1, &phase_init_y, 462d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &phase_step_y)) 463d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -1; 464d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 465d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek scale_factor_x = (dst_w * 10) / req->src_rect.w; 466d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek scale_factor_y = (dst_h * 10) / req->src_rect.h; 467d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 468d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (scale_factor_x > 8) 469d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT8TO1; 470d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else if (scale_factor_x > 6) 471d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT6TOPT8; 472d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else if (scale_factor_x > 4) 473d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT4TOPT6; 474d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else 475d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT2TOPT4; 476d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (downscale != downscale_x_table) { 477d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek load_scale_table(mdp, mdp_downscale_x_table[downscale], 64); 478d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale_x_table = downscale; 479d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 480d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 481d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (scale_factor_y > 8) 482d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT8TO1; 483d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else if (scale_factor_y > 6) 484d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT6TOPT8; 485d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else if (scale_factor_y > 4) 486d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT4TOPT6; 487d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else 488d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale = MDP_DOWNSCALE_PT2TOPT4; 489d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (downscale != downscale_y_table) { 490d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek load_scale_table(mdp, mdp_downscale_y_table[downscale], 64); 491d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale_y_table = downscale; 492d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 493d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 494d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasex_init = phase_init_x; 495d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasey_init = phase_init_y; 496d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasex_step = phase_step_x; 497d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->phasey_step = phase_step_y; 498d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= (PPP_OP_SCALE_Y_ON | PPP_OP_SCALE_X_ON); 499d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 500d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 501d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 502d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 503d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void blit_blur(const struct mdp_info *mdp, struct mdp_blit_req *req, 504d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_regs *regs) 505d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 506d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!(req->flags & MDP_BLUR)) 507d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return; 508d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 509d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!(downscale_x_table == MDP_DOWNSCALE_BLUR && 510d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale_y_table == MDP_DOWNSCALE_BLUR)) { 511d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek load_scale_table(mdp, mdp_gaussian_blur_table, 128); 512d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale_x_table = MDP_DOWNSCALE_BLUR; 513d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek downscale_y_table = MDP_DOWNSCALE_BLUR; 514d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 515d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 516d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->op |= (PPP_OP_SCALE_Y_ON | PPP_OP_SCALE_X_ON); 517d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 518d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 519d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 520d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define IMG_LEN(rect_h, w, rect_w, bpp) (((rect_h) * w) * bpp) 521d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 522d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek#define Y_TO_CRCB_RATIO(format) \ 523d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek ((format == MDP_Y_CBCR_H2V2 || format == MDP_Y_CRCB_H2V2) ? 2 :\ 524d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek (format == MDP_Y_CBCR_H2V1 || format == MDP_Y_CRCB_H2V1) ? 1 : 1) 525d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 526d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void get_len(struct mdp_img *img, struct mdp_rect *rect, uint32_t bpp, 527d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t *len0, uint32_t *len1) 528d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 529d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *len0 = IMG_LEN(rect->h, img->width, rect->w, bpp); 530d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (IS_PSEUDOPLNR(img->format)) 531d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *len1 = *len0/Y_TO_CRCB_RATIO(img->format); 532d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek else 533d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *len1 = 0; 534d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 535d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 536d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int valid_src_dst(unsigned long src_start, unsigned long src_len, 537d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek unsigned long dst_start, unsigned long dst_len, 538d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_blit_req *req, struct mdp_regs *regs) 539d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 540d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek unsigned long src_min_ok = src_start; 541d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek unsigned long src_max_ok = src_start + src_len; 542d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek unsigned long dst_min_ok = dst_start; 543d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek unsigned long dst_max_ok = dst_start + dst_len; 544d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t src0_len, src1_len, dst0_len, dst1_len; 545d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek get_len(&req->src, &req->src_rect, regs->src_bpp, &src0_len, 546d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &src1_len); 547d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek get_len(&req->dst, &req->dst_rect, regs->dst_bpp, &dst0_len, 548d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek &dst1_len); 549d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 550d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->src0 < src_min_ok || regs->src0 > src_max_ok || 551d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->src0 + src0_len > src_max_ok) { 552d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek DLOG("invalid_src %x %x %lx %lx\n", regs->src0, 553d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek src0_len, src_min_ok, src_max_ok); 554d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 555d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 556d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->src_cfg & PPP_SRC_PLANE_PSEUDOPLNR) { 557d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->src1 < src_min_ok || regs->src1 > src_max_ok || 558d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->src1 + src1_len > src_max_ok) { 559d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek DLOG("invalid_src1"); 560d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 561d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 562d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 563d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->dst0 < dst_min_ok || regs->dst0 > dst_max_ok || 564d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst0 + dst0_len > dst_max_ok) { 565d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek DLOG("invalid_dst"); 566d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 567d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 568d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->dst_cfg & PPP_SRC_PLANE_PSEUDOPLNR) { 569d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->dst1 < dst_min_ok || regs->dst1 > dst_max_ok || 570d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs->dst1 + dst1_len > dst_max_ok) { 571d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek DLOG("invalid_dst1"); 572d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 573d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 574d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 575d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 1; 576d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 577d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 578d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 579d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void flush_imgs(struct mdp_blit_req *req, struct mdp_regs *regs, 580d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct file *src_file, struct file *dst_file) 581d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 582d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 583d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 584d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic void get_chroma_addr(struct mdp_img *img, struct mdp_rect *rect, 585d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t base, uint32_t bpp, uint32_t cfg, 586d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t *addr, uint32_t *ystride) 587d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 588d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t compress_v = Y_TO_CRCB_RATIO(img->format); 589d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t compress_h = 2; 590d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek uint32_t offset; 591d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 592d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (IS_PSEUDOPLNR(img->format)) { 593d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek offset = (rect->x / compress_h) * compress_h; 594d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek offset += rect->y == 0 ? 0 : 595d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek ((rect->y + 1) / compress_v) * img->width; 596d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *addr = base + (img->width * img->height * bpp); 597d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *addr += offset * bpp; 598d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *ystride |= *ystride << 16; 599d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } else { 600d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek *addr = 0; 601d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 602d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 603d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 604d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekstatic int send_blit(const struct mdp_info *mdp, struct mdp_blit_req *req, 605d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_regs *regs, struct file *src_file, 606d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct file *dst_file) 607d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 608d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, 1, 0x060); 609d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->src_rect, PPP_ADDR_SRC_ROI); 610d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->src0, PPP_ADDR_SRC0); 611d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->src1, PPP_ADDR_SRC1); 612d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->src_ystride, PPP_ADDR_SRC_YSTRIDE); 613d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->src_cfg, PPP_ADDR_SRC_CFG); 614d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->src_pack, PPP_ADDR_SRC_PACK_PATTERN); 615d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 616d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->op, PPP_ADDR_OPERATION); 617d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->phasex_init, PPP_ADDR_PHASEX_INIT); 618d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->phasey_init, PPP_ADDR_PHASEY_INIT); 619d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->phasex_step, PPP_ADDR_PHASEX_STEP); 620d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->phasey_step, PPP_ADDR_PHASEY_STEP); 621d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 622d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, (req->alpha << 24) | (req->transp_mask & 0xffffff), 623d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ADDR_ALPHA_TRANSP); 624d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 625d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst_cfg, PPP_ADDR_DST_CFG); 626d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst_pack, PPP_ADDR_DST_PACK_PATTERN); 627d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst_rect, PPP_ADDR_DST_ROI); 628d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst0, PPP_ADDR_DST0); 629d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst1, PPP_ADDR_DST1); 630d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst_ystride, PPP_ADDR_DST_YSTRIDE); 631d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 632d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->edge, PPP_ADDR_EDGE); 633d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (regs->op & PPP_OP_BLEND_ON) { 634d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst0, PPP_ADDR_BG0); 635d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst1, PPP_ADDR_BG1); 636d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, regs->dst_ystride, PPP_ADDR_BG_YSTRIDE); 637d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, src_img_cfg[req->dst.format], PPP_ADDR_BG_CFG); 638d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, pack_pattern[req->dst.format], 639d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek PPP_ADDR_BG_PACK_PATTERN); 640d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 641d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek flush_imgs(req, regs, src_file, dst_file); 642d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek mdp_writel(mdp, 0x1000, MDP_DISPLAY0_START); 643d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 644d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 645d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 646d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machekint mdp_ppp_blit(const struct mdp_info *mdp, struct mdp_blit_req *req, 647d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct file *src_file, unsigned long src_start, unsigned long src_len, 648d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct file *dst_file, unsigned long dst_start, unsigned long dst_len) 649d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek{ 650d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek struct mdp_regs regs = {0}; 651d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 652d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (unlikely(req->src.format >= MDP_IMGTYPE_LIMIT || 653d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->dst.format >= MDP_IMGTYPE_LIMIT)) { 654d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek printk(KERN_ERR "mpd_ppp: img is of wrong format\n"); 655d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -EINVAL; 656d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 657d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 658d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (unlikely(req->src_rect.x > req->src.width || 659d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->src_rect.y > req->src.height || 660d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->dst_rect.x > req->dst.width || 661d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->dst_rect.y > req->dst.height)) { 662d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek printk(KERN_ERR "mpd_ppp: img rect is outside of img!\n"); 663d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -EINVAL; 664d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 665d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 666d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* set the src image configuration */ 667d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_cfg = src_img_cfg[req->src.format]; 668d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_cfg |= (req->src_rect.x & 0x1) ? PPP_SRC_BPP_ROI_ODD_X : 0; 669d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_cfg |= (req->src_rect.y & 0x1) ? PPP_SRC_BPP_ROI_ODD_Y : 0; 670d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_rect = (req->src_rect.h << 16) | req->src_rect.w; 671d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_pack = pack_pattern[req->src.format]; 672d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 673d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* set the dest image configuration */ 674d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_cfg = dst_img_cfg[req->dst.format] | PPP_DST_OUT_SEL_AXI; 675d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_rect = (req->dst_rect.h << 16) | req->dst_rect.w; 676d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_pack = pack_pattern[req->dst.format]; 677d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 678d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* set src, bpp, start pixel and ystride */ 679d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_bpp = bytes_per_pixel[req->src.format]; 680d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src0 = src_start + req->src.offset; 681d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_ystride = req->src.width * regs.src_bpp; 682d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek get_chroma_addr(&req->src, &req->src_rect, regs.src0, regs.src_bpp, 683d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_cfg, ®s.src1, ®s.src_ystride); 684d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src0 += (req->src_rect.x + (req->src_rect.y * req->src.width)) * 685d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.src_bpp; 686d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 687d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* set dst, bpp, start pixel and ystride */ 688d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_bpp = bytes_per_pixel[req->dst.format]; 689d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst0 = dst_start + req->dst.offset; 690d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_ystride = req->dst.width * regs.dst_bpp; 691d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek get_chroma_addr(&req->dst, &req->dst_rect, regs.dst0, regs.dst_bpp, 692d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_cfg, ®s.dst1, ®s.dst_ystride); 693d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst0 += (req->dst_rect.x + (req->dst_rect.y * req->dst.width)) * 694d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.dst_bpp; 695d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 696d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (!valid_src_dst(src_start, src_len, dst_start, dst_len, req, 697d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek ®s)) { 698d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek printk(KERN_ERR "mpd_ppp: final src or dst location is " 699d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek "invalid, are you trying to make an image too large " 700d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek "or to place it outside the screen?\n"); 701d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -EINVAL; 702d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 703d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 704d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* set up operation register */ 705d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.op = 0; 706d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek blit_rotate(req, ®s); 707d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek blit_convert(req, ®s); 708d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (req->flags & MDP_DITHER) 709d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.op |= PPP_OP_DITHER_EN; 710d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek blit_blend(req, ®s); 711d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (blit_scale(mdp, req, ®s)) { 712d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek printk(KERN_ERR "mpd_ppp: error computing scale for img.\n"); 713d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -EINVAL; 714d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 715d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek blit_blur(mdp, req, ®s); 716d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek regs.op |= dst_op_chroma[req->dst.format] | 717d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek src_op_chroma[req->src.format]; 718d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 719d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek /* if the image is YCRYCB, the x and w must be even */ 720d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (unlikely(req->src.format == MDP_YCRYCB_H2V1)) { 721d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->src_rect.x = req->src_rect.x & (~0x1); 722d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->src_rect.w = req->src_rect.w & (~0x1); 723d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->dst_rect.x = req->dst_rect.x & (~0x1); 724d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek req->dst_rect.w = req->dst_rect.w & (~0x1); 725d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek } 726d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek if (get_edge_cond(req, ®s)) 727d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return -EINVAL; 728d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek 729d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek send_blit(mdp, req, ®s, src_file, dst_file); 730d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek return 0; 731d480ace08d5b59133575e672a0bd1c97b0f8400fPavel Machek} 732