/*
  Copyright (c), 2001-2022, Shenshu Tech. Co., Ltd.
 */

#include <sys/ioctl.h>
#include <fcntl.h>
#include <unistd.h>
#include "sample_comm.h"
#include "ot_mipi_tx.h"

#ifdef __cplusplus
#if __cplusplus
extern "C" {
#endif
#endif /* end of #ifdef __cplusplus */

#if VO_MIPI_SUPPORT

#ifdef OT_FPGA
#define SAMPLE_COMM_MIPI_TX_MAX_PHY_DATA_RATE 594
#else
#define SAMPLE_COMM_MIPI_TX_MAX_PHY_DATA_RATE 945
#endif

static td_s32 g_sample_comm_mipi_fd = OT_INVALID_VALUE;

static const combo_dev_cfg_t g_sample_comm_mipi_tx_720x576_50_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 64,
        .hbp_pixels  = 68,
        .hact_pixels = 720,
        .hfp_pixels  = 12,
        .vsa_lines   = 5,
        .vbp_lines   = 39,
        .vact_lines  = 576,
        .vfp_lines   = 5,
    },
    .phy_data_rate = 162,
    .pixel_clk = 27000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1024x768_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 136,
        .hbp_pixels  = 160,
        .hact_pixels = 1024,
        .hfp_pixels  = 24,
        .vsa_lines   = 6,
        .vbp_lines   = 29,
        .vact_lines  = 768,
        .vfp_lines   = 3,
    },
    .phy_data_rate = 390,
    .pixel_clk = 65000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1280x720_50_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 40,
        .hbp_pixels  = 220,
        .hact_pixels = 1280,
        .hfp_pixels  = 440,
        .vsa_lines   = 5,
        .vbp_lines   = 20,
        .vact_lines  = 720,
        .vfp_lines   = 5,
    },
    .phy_data_rate = 446,
    .pixel_clk = 74250,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1280x720_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 40,
        .hbp_pixels  = 220,
        .hact_pixels = 1280,
        .hfp_pixels  = 110,
        .vsa_lines   = 5,
        .vbp_lines   = 20,
        .vact_lines  = 720,
        .vfp_lines   = 5,
    },
    .phy_data_rate = 446,
    .pixel_clk = 74250,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1280x1024_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 112,
        .hbp_pixels  = 248,
        .hact_pixels = 1280,
        .hfp_pixels  = 48,
        .vsa_lines   = 3,
        .vbp_lines   = 38,
        .vact_lines  = 1024,
        .vfp_lines   = 1,
    },
    .phy_data_rate = 648, /* 486 */
    .pixel_clk = 108000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1920x1080_24_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 44,
        .hbp_pixels  = 148,
        .hact_pixels = 1920,
        .hfp_pixels  = 638,
        .vsa_lines   = 5,
        .vbp_lines   = 36,
        .vact_lines  = 1080,
        .vfp_lines   = 4,
    },
    .phy_data_rate = 446,
    .pixel_clk = 74250,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1920x1080_25_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 44,
        .hbp_pixels  = 148,
        .hact_pixels = 1920,
        .hfp_pixels  = 528,
        .vsa_lines   = 5,
        .vbp_lines   = 36,
        .vact_lines  = 1080,
        .vfp_lines   = 4,
    },
    .phy_data_rate = 446,
    .pixel_clk = 74250,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1920x1080_30_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 44,
        .hbp_pixels  = 148,
        .hact_pixels = 1920,
        .hfp_pixels  = 88,
        .vsa_lines   = 5,
        .vbp_lines   = 36,
        .vact_lines  = 1080,
        .vfp_lines   = 4,
    },
    .phy_data_rate = 446,
    .pixel_clk = 74250,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1920x1080_50_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 44,
        .hbp_pixels  = 148,
        .hact_pixels = 1920,
        .hfp_pixels  = 528,
        .vsa_lines   = 5,
        .vbp_lines   = 36,
        .vact_lines  = 1080,
        .vfp_lines   = 4,
    },
    .phy_data_rate = 891,
    .pixel_clk = 148500,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1920x1080_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 44,
        .hbp_pixels  = 148,
        .hact_pixels = 1920,
        .hfp_pixels  = 88,
        .vsa_lines   = 5,
        .vbp_lines   = 36,
        .vact_lines  = 1080,
        .vfp_lines   = 4,
    },
    .phy_data_rate = 891,
    .pixel_clk = 148500,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_3840x2160_24_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 88,
        .hbp_pixels  = 296,
        .hact_pixels = 3840,
        .hfp_pixels  = 1276,
        .vsa_lines   = 10,
        .vbp_lines   = 72,
        .vact_lines  = 2160,
        .vfp_lines   = 8,
    },
    .phy_data_rate = 1782,
    .pixel_clk = 297000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_3840x2160_25_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 88,
        .hbp_pixels  = 296,
        .hact_pixels = 3840,
        .hfp_pixels  = 1056,
        .vsa_lines   = 10,
        .vbp_lines   = 72,
        .vact_lines  = 2160,
        .vfp_lines   = 8,
    },
    .phy_data_rate = 1782,
    .pixel_clk = 297000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_3840x2160_30_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 88,
        .hbp_pixels  = 296,
        .hact_pixels = 3840,
        .hfp_pixels  = 176,
        .vsa_lines   = 10,
        .vbp_lines   = 72,
        .vact_lines  = 2160,
        .vfp_lines   = 8,
    },
    .phy_data_rate = 1782, /* lt9611's max data rate < 2000Mbps */
    .pixel_clk = 297000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_3840x2160_50_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_CSI,
    .out_format = OUT_FORMAT_RAW_16BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 88,
        .hbp_pixels  = 296,
        .hact_pixels = 3840,
        .hfp_pixels  = 1056,
        .vsa_lines   = 10,
        .vbp_lines   = 72,
        .vact_lines  = 2160,
        .vfp_lines   = 8,
    },
    .phy_data_rate = 2259, /* 2376 is larger than the max 2259, set to 2259 */
    .pixel_clk = 594000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_3840x2160_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_CSI,
    .out_format = OUT_FORMAT_RAW_16BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 88,
        .hbp_pixels  = 296,
        .hact_pixels = 3840,
        .hfp_pixels  = 176,
        .vsa_lines   = 10,
        .vbp_lines   = 72,
        .vact_lines  = 2160,
        .vfp_lines   = 8,
    },
    .phy_data_rate = 2259, /* 2376 is larger than the max 2259, set to 2259 */
    .pixel_clk = 594000,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_720x1280_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels  = 24,
        .hbp_pixels  = 99,
        .hact_pixels = 720,
        .hfp_pixels  = 99,
        .vsa_lines   = 4,
        .vbp_lines   = 20,
        .vact_lines  = 1280,
        .vfp_lines   = 8,
    },
    .phy_data_rate = 459,
    .pixel_clk = 74250,
};

static const combo_dev_cfg_t g_sample_comm_mipi_tx_1080x1920_60_config = {
    .devno = 0,
    .lane_id = {0, 1, 2, 3},
    .out_mode = OUT_MODE_DSI_VIDEO,
    .out_format = OUT_FORMAT_RGB_24BIT,
    .video_mode =  BURST_MODE,
    .sync_info = {
        .hsa_pixels = 8,
        .hbp_pixels = 20,
        .hact_pixels = 1080,
        .hfp_pixels = 130,
        .vsa_lines = 10,
        .vbp_lines = 26,
        .vact_lines = 1920,
        .vfp_lines = 16,
    },
    .phy_data_rate = 891,
    .pixel_clk = 148500,
};

typedef struct {
    enum_mipi_tx_intf_sync index;
    const combo_dev_cfg_t *mipi_tx_combo_dev_cfg;
} mipi_tx_intf_sync_cfg;

typedef struct {
    ot_vo_intf_sync intf_sync;
    enum_mipi_tx_intf_sync mipi_tx_sync;
    td_char *mipi_fmt_name;
} vo_mst_sync_mipi_tx;

static const mipi_tx_intf_sync_cfg g_sample_mipi_tx_timing[OT_MIPI_TX_OUT_USER] = {
    {OT_MIPI_TX_OUT_576P50,       &g_sample_comm_mipi_tx_720x576_50_config},
    {OT_MIPI_TX_OUT_1024X768_60,  &g_sample_comm_mipi_tx_1024x768_60_config},
    {OT_MIPI_TX_OUT_720P50,       &g_sample_comm_mipi_tx_1280x720_50_config},
    {OT_MIPI_TX_OUT_720P60,       &g_sample_comm_mipi_tx_1280x720_60_config},
    {OT_MIPI_TX_OUT_1280X1024_60, &g_sample_comm_mipi_tx_1280x1024_60_config},
    {OT_MIPI_TX_OUT_1080P24,      &g_sample_comm_mipi_tx_1920x1080_24_config},
    {OT_MIPI_TX_OUT_1080P25,      &g_sample_comm_mipi_tx_1920x1080_25_config},
    {OT_MIPI_TX_OUT_1080P30,      &g_sample_comm_mipi_tx_1920x1080_30_config},
    {OT_MIPI_TX_OUT_1080P50,      &g_sample_comm_mipi_tx_1920x1080_50_config},
    {OT_MIPI_TX_OUT_1080P60,      &g_sample_comm_mipi_tx_1920x1080_60_config},
    {OT_MIPI_TX_OUT_3840X2160_24, &g_sample_comm_mipi_tx_3840x2160_24_config},
    {OT_MIPI_TX_OUT_3840X2160_25, &g_sample_comm_mipi_tx_3840x2160_25_config},
    {OT_MIPI_TX_OUT_3840X2160_30, &g_sample_comm_mipi_tx_3840x2160_30_config},
    {OT_MIPI_TX_OUT_3840X2160_50, &g_sample_comm_mipi_tx_3840x2160_50_config},
    {OT_MIPI_TX_OUT_3840X2160_60, &g_sample_comm_mipi_tx_3840x2160_60_config},

    {OT_MIPI_TX_OUT_720X1280_60,  &g_sample_comm_mipi_tx_720x1280_60_config},
    {OT_MIPI_TX_OUT_1080X1920_60, &g_sample_comm_mipi_tx_1080x1920_60_config},
    {0},
};

static const combo_dev_cfg_t *sample_mipi_tx_get_combo_dev_config(enum_mipi_tx_intf_sync mipi_intf_sync)
{
    td_u32 loop;
    td_u32 loop_num = sizeof(g_sample_mipi_tx_timing) / sizeof(mipi_tx_intf_sync_cfg);

    for (loop = 0; loop < loop_num; loop++) {
        if (g_sample_mipi_tx_timing[loop].index == mipi_intf_sync) {
            return g_sample_mipi_tx_timing[loop].mipi_tx_combo_dev_cfg;
        }
    }
    return TD_NULL;
}

static td_s32 vo_mst_mipi_tx_send_one_cmd(cmd_info_t *cmd_info)
{
    td_s32 ret;
    ret = ioctl(g_sample_comm_mipi_fd, OT_MIPI_TX_SET_CMD, cmd_info);
    if (ret != TD_SUCCESS) {
        printf("MIPI_TX SET CMD failed\n");
        return TD_FAILURE;
    }

    return TD_SUCCESS;
}

static td_s32 vo_mst_mipi_tx_init_screen(const struct_mipi_tx_config *tx_config)
{
    td_s32 ret;
    cmd_info_t ci = { 0 };
    td_u32 loop;
    td_u32 loop_num = tx_config->cmd_count;

    for (loop = 0; loop < loop_num; loop++) {
        (td_void)memcpy_s(&ci, sizeof(cmd_info_t), &(tx_config->cmd_info[loop].cmd_info), sizeof(cmd_info_t));
        ret = vo_mst_mipi_tx_send_one_cmd(&ci);
        if (ret != TD_SUCCESS) {
            printf("loop(%d): MIPI_TX SET CMD failed\n", loop);

            return TD_FAILURE;
        }
        usleep(tx_config->cmd_info[loop].usleep_value);
    }

    return TD_SUCCESS;
}

static td_s32 sample_comm_mipi_tx_check_config(const struct_mipi_tx_config *tx_config)
{
    enum_mipi_tx_intf_sync mipi_intf_sync;

    if (tx_config == NULL) {
        sample_print("tx_config is null\n");
        return TD_FAILURE;
    }

    mipi_intf_sync = tx_config->intf_sync;
    if ((mipi_intf_sync >= OT_MIPI_TX_OUT_BUTT)) {
        sample_print("mipi tx sync illegal\n");
        return TD_FAILURE;
    }
    return TD_SUCCESS;
}

static td_s32 sample_comm_mipi_tx_get_config(const struct_mipi_tx_config *tx_config,
    const combo_dev_cfg_t **mipi_tx_config)
{
    enum_mipi_tx_intf_sync mipi_intf_sync;
    mipi_intf_sync = tx_config->intf_sync;

    if (mipi_intf_sync == OT_MIPI_TX_OUT_USER) {
        *mipi_tx_config = &tx_config->combo_dev_cfg;
        if ((*mipi_tx_config)->phy_data_rate == 0) {
            printf("error: not set mipi tx user config\n");
            return TD_FAILURE;
        }
    } else {
        *mipi_tx_config = sample_mipi_tx_get_combo_dev_config(mipi_intf_sync);
        if (*mipi_tx_config == TD_NULL) {
            sample_print("error: mipi tx combo config is null\n");
            return TD_FAILURE;
        }
    }
    return TD_SUCCESS;
}

static td_void sample_comm_mipi_tx_do_close_fd(td_void)
{
    if (g_sample_comm_mipi_fd != OT_INVALID_VALUE) {
        close(g_sample_comm_mipi_fd);
        g_sample_comm_mipi_fd = OT_INVALID_VALUE;
    }
}

td_s32 libapi_comm_start_mipi_tx(const struct_mipi_tx_config *tx_config)
{
    enum_mipi_tx_intf_sync mipi_intf_sync;
    const combo_dev_cfg_t *combo_config = TD_NULL;
    td_s32 ret;

    ret = sample_comm_mipi_tx_check_config(tx_config);
    if (ret != TD_SUCCESS) {
        return ret;
    }

    g_sample_comm_mipi_fd = open(MIPI_TX_DEV_NAME, O_RDONLY);
    if (g_sample_comm_mipi_fd < 0) {
        printf("open mipi dev file (%s) fail\n", MIPI_TX_DEV_NAME);
        return TD_FAILURE;
    }

    mipi_intf_sync = tx_config->intf_sync;
    printf("mipi intf sync = %d\n", mipi_intf_sync);

    ret = sample_comm_mipi_tx_get_config(tx_config, &combo_config);
    if (ret != TD_SUCCESS) {
        printf("%s,%d, get mipi tx config fail\n", __FUNCTION__, __LINE__);
        sample_comm_mipi_tx_do_close_fd();
        return ret;
    }

    /* step1 */
    ret = ioctl(g_sample_comm_mipi_fd, OT_MIPI_TX_DISABLE, NULL);
    if (ret != TD_SUCCESS) {
        printf("%s,%d, ioctl mipi tx (%s) fail at ret(%d)\n", __FUNCTION__, __LINE__, MIPI_TX_DEV_NAME, ret);
        sample_comm_mipi_tx_do_close_fd();
        return ret;
    }

    /* step2 */
    ret = ioctl(g_sample_comm_mipi_fd, OT_MIPI_TX_SET_DEV_CFG, combo_config);
    if (ret != TD_SUCCESS) {
        printf("%s,%d, ioctl mipi tx (%s) fail at ret(%d)\n", __FUNCTION__, __LINE__, MIPI_TX_DEV_NAME, ret);
        sample_comm_mipi_tx_do_close_fd();
        return ret;
    }

    /* step3 */
    ret = vo_mst_mipi_tx_init_screen(tx_config);
    if (ret != TD_SUCCESS) {
        printf("%s,%d, init screen failed\n", __FUNCTION__, __LINE__);
        sample_comm_mipi_tx_do_close_fd();
        return ret;
    }

    /* step4 */
    ret = ioctl(g_sample_comm_mipi_fd, OT_MIPI_TX_ENABLE, NULL);
    if (ret != TD_SUCCESS) {
        printf("%s,%d, ioctl mipi tx (%s) fail at ret(%d)\n", __FUNCTION__, __LINE__, MIPI_TX_DEV_NAME, ret);
    }

    sample_comm_mipi_tx_do_close_fd();
    return ret;
}

td_void libapi_comm_stop_mipi_tx(ot_vo_intf_type intf_type)
{
    if (!((intf_type & OT_VO_INTF_MIPI) ||
        (intf_type & OT_VO_INTF_MIPI_SLAVE))) {
        sample_print("intf is not mipi\n");
        return;
    }

    g_sample_comm_mipi_fd = open(MIPI_TX_DEV_NAME, O_RDONLY);
    if (g_sample_comm_mipi_fd < 0) {
        printf("open mipi dev file (%s) fail\n", MIPI_TX_DEV_NAME);
        return;
    }

    if (ioctl(g_sample_comm_mipi_fd, OT_MIPI_TX_DISABLE, NULL) < 0) {
        printf("ioctl mipi tx (%s) fail\n", MIPI_TX_DEV_NAME);
        return;
    }

    close(g_sample_comm_mipi_fd);
    g_sample_comm_mipi_fd = OT_INVALID_VALUE;
}

#else

td_void sample_comm_mipi_tx_set_intf_sync(enum_mipi_tx_intf_sync intf_sync)
{
}

td_void libapi_comm_start_mipi_tx(ot_vo_pub_attr *pub_attr)
{
}

td_void libapi_comm_stop_mipi_tx(ot_vo_intf_type intf_type)
{
}
#endif /* end of #if VO_MIPI_SUPPORT */

#ifdef __cplusplus
#if __cplusplus
}
#endif
#endif /* end of #ifdef __cplusplus */