android13/kernel-5.10/drivers/video/rockchip/rga/RGA_API.c

/* SPDX-License-Identifier: GPL-2.0 */

#include <linux/memory.h>
#include "RGA_API.h"
#include "rga.h"
//#include "rga_angle.h"

#define IS_YUV_420(format) \
     ((format == RK_FORMAT_YCbCr_420_P) | (format == RK_FORMAT_YCbCr_420_SP) | \
      (format == RK_FORMAT_YCrCb_420_P) | (format == RK_FORMAT_YCrCb_420_SP))

#define IS_YUV_422(format) \
     ((format == RK_FORMAT_YCbCr_422_P) | (format == RK_FORMAT_YCbCr_422_SP) | \
      (format == RK_FORMAT_YCrCb_422_P) | (format == RK_FORMAT_YCrCb_422_SP))

#define IS_YUV(format) \
     ((format == RK_FORMAT_YCbCr_420_P) | (format == RK_FORMAT_YCbCr_420_SP) | \
      (format == RK_FORMAT_YCrCb_420_P) | (format == RK_FORMAT_YCrCb_420_SP) | \
      (format == RK_FORMAT_YCbCr_422_P) | (format == RK_FORMAT_YCbCr_422_SP) | \
      (format == RK_FORMAT_YCrCb_422_P) | (format == RK_FORMAT_YCrCb_422_SP))


extern rga_service_info rga_service;


void
matrix_cal(const struct rga_req *msg, TILE_INFO *tile)
{
    uint64_t x_time, y_time;
    uint64_t sina, cosa;

    int s_act_w, s_act_h, d_act_w, d_act_h;

    s_act_w = msg->src.act_w;
    s_act_h = msg->src.act_h;
    d_act_w = msg->dst.act_w;
    d_act_h = msg->dst.act_h;

    if (s_act_w == 1) s_act_w += 1;
    if (s_act_h == 1) s_act_h += 1;
    if (d_act_h == 1) d_act_h += 1;
    if (d_act_w == 1) d_act_w += 1;

    x_time = ((s_act_w - 1)<<16) / (d_act_w - 1);
    y_time = ((s_act_h - 1)<<16) / (d_act_h - 1);

    sina = msg->sina;
    cosa = msg->cosa;

    switch(msg->rotate_mode)
    {
        /* 16.16 x 16.16 */
        /* matrix[] is 64 bit wide */
        case 1 :
            tile->matrix[0] =  cosa*x_time;
            tile->matrix[1] = -sina*y_time;
            tile->matrix[2] =  sina*x_time;
            tile->matrix[3] =  cosa*y_time;
            break;
        case 2 :
            tile->matrix[0] = -(x_time<<16);
            tile->matrix[1] = 0;
            tile->matrix[2] = 0;
            tile->matrix[3] = (y_time<<16);
            break;
        case 3 :
            tile->matrix[0] = (x_time<<16);
            tile->matrix[1] = 0;
            tile->matrix[2] = 0;
            tile->matrix[3] = -(y_time<<16);
            break;
        default :
            tile->matrix[0] =  (uint64_t)1<<32;
            tile->matrix[1] =  0;
            tile->matrix[2] =  0;
            tile->matrix[3] =  (uint64_t)1<<32;
            break;
    }
}


int32_t RGA_gen_two_pro(struct rga_req *msg, struct rga_req *msg1)
{

    struct rga_req *mp;
    uint32_t w_ratio, h_ratio;
    uint32_t stride;

    uint32_t daw, dah;
    uint32_t pl;

    daw = dah = 0;

    mp = msg1;

    if(msg->dst.act_w == 0)
    {
        printk("%s, [%d] rga dst act_w is zero\n", __FUNCTION__, __LINE__);
        return -EINVAL;
    }

    if (msg->dst.act_h == 0)
    {
        printk("%s, [%d] rga dst act_w is zero\n", __FUNCTION__, __LINE__);
        return -EINVAL;
    }
    w_ratio = (msg->src.act_w << 16) / msg->dst.act_w;
    h_ratio = (msg->src.act_h << 16) / msg->dst.act_h;

    memcpy(msg1, msg, sizeof(struct rga_req));

    msg->dst.format = msg->src.format;

    /*pre_scale_w cal*/
    if ((w_ratio >= (2<<16)) && (w_ratio < (4<<16))) {
        daw = (msg->src.act_w + 1) >> 1;
        if((IS_YUV_420(msg->dst.format)) && (daw & 1)) {
            daw -= 1;
            msg->src.act_w = daw << 1;
        }
    }
    else if ((w_ratio >= (4<<16)) && (w_ratio < (8<<16))) {
        daw = (msg->src.act_w + 3) >> 2;
        if((IS_YUV_420(msg->dst.format)) && (daw & 1)) {
            daw -= 1;
            msg->src.act_w = daw << 2;
        }
    }
    else if ((w_ratio >= (8<<16)) && (w_ratio < (16<<16))) {
        daw = (msg->src.act_w + 7) >> 3;
        if((IS_YUV_420(msg->dst.format)) && (daw & 1)) {
            daw -= 1;
            msg->src.act_w = daw << 3;
        }
    }
    else
    {
        daw = msg->src.act_w;
    }

    pl = (RGA_pixel_width_init(msg->src.format));
    stride = (pl * daw + 3) & (~3);
    msg->dst.act_w = daw;
    msg->dst.vir_w = stride / pl;

    /*pre_scale_h cal*/
    if ((h_ratio >= (2<<16)) && (h_ratio < (4<<16))) {
        dah = (msg->src.act_h + 1) >> 1;
        if((IS_YUV(msg->dst.format)) && (dah & 1)) {
            dah -= 1;
            msg->src.act_h = dah << 1;
        }
    }
    else if ((h_ratio >= (4<<16)) && (h_ratio < (8<<16))) {
        dah = (msg->src.act_h + 3) >> 2;
        if((IS_YUV(msg->dst.format)) && (dah & 1)) {
            dah -= 1;
            msg->src.act_h = dah << 2;

        }
    }
    else if ((h_ratio >= (8<<16)) && (h_ratio < (16<<16))) {
        dah = (msg->src.act_h + 7) >> 3;
        if((IS_YUV(msg->dst.format)) && (dah & 1)) {
            dah -= 1;
            msg->src.act_h = dah << 3;
        }
    }
    else
    {
        dah = msg->src.act_h;
    }

    msg->dst.act_h = dah;
    msg->dst.vir_h = dah;

    msg->dst.x_offset = 0;
    msg->dst.y_offset = 0;

    msg->dst.yrgb_addr = (unsigned long)rga_service.pre_scale_buf;
    msg->dst.uv_addr = msg->dst.yrgb_addr + stride * dah;
    msg->dst.v_addr = msg->dst.uv_addr + ((stride * dah) >> 1);

    msg->render_mode = pre_scaling_mode;

    msg1->src.yrgb_addr = msg->dst.yrgb_addr;
    msg1->src.uv_addr = msg->dst.uv_addr;
    msg1->src.v_addr = msg->dst.v_addr;

    msg1->src.act_w = msg->dst.act_w;
    msg1->src.act_h = msg->dst.act_h;
    msg1->src.vir_w = msg->dst.vir_w;
    msg1->src.vir_h = msg->dst.vir_h;

    msg1->src.x_offset = 0;
    msg1->src.y_offset = 0;

    return 0;
}