10.1_demo/extern/qlibquammapi/sample/display/fb/debian_display_init.c

232 lines
7.3 KiB
C

/*******************************************************************************************
# Copyright (c) 2023~2024 Quaming Intelligent Technology Co., Ltd.
# All Rights Reserved.
# Confidential and Proprietary - Quaming Intelligent Technology Co., Ltd.
#*******************************************************************************************/
#include <unistd.h>
#include <string.h>
#include "common/qua_mm_common.h"
#include "common/qua_sys_platform.h"
#include "system/qua_mm_system.h"
#include "display/qua_mm_display.h"
#define VO_DEV_DHD 0
#define ALIGN_UP(x, a) ((x+a-1)&(~(a-1)))
int main(int argc, char** argv)
{
QUA_CONST_CHAR *chip_name = "qm108h";
QUA_CONST_CHAR *os_name = "debian";
QUA_CHAR platform[32];
QUA_CHAR tmp_buf[8];
QUA_S32 ret, img_width, img_height;
printf("get os_name=%s\n", os_name);
ret = qua_get_cmdline_arg(argc, argv, QUA_ARG_IMAGE_WIDTH, tmp_buf, sizeof(tmp_buf));
if (ret == QUA_FAILURE) {
printf("get image width error!\n");
return ret;
}
img_width = atoi(tmp_buf);
printf("get img_width=%d\n", img_width);
ret = qua_get_cmdline_arg(argc, argv, QUA_ARG_IMAGE_HEIGHT, tmp_buf, sizeof(tmp_buf));
if (ret == QUA_FAILURE) {
printf("get image height error!\n");
return ret;
}
img_height = atoi(tmp_buf);
printf("get img_height=%d\n", img_height);
ret = qua_get_cmdline_arg(argc, argv, QUA_ARG_PRIMARY_USER, tmp_buf, sizeof(tmp_buf));
if (ret == QUA_FAILURE) {
printf("get primary user error!\n");
return ret;
}
QUA_BOOL is_primary_user = atoi(tmp_buf);
printf("get primary_user=%d\n", is_primary_user);
ret = qua_make_platform(chip_name, os_name, platform, sizeof(platform));
if (ret == QUA_FAILURE) {
printf("make platform name error!\n");
return ret;
}
qua_mm_system_t *system = NULL;
printf("make platform=%s\n", platform);
ret = qua_mm_init(is_primary_user, platform, &system);
if (ret != QUA_SUCCESS || system == NULL) {
printf("qua_mm_init error!\n");
return ret;
}
qua_mm_system_ops_t *sys_ops = (qua_mm_system_ops_t *)system;
if (is_primary_user) {
QUA_U32 blk_size;
qua_vb_config_t vb_cfg;
memset(&vb_cfg, 0, sizeof(qua_vb_config_t));
blk_size = img_width*img_height*2;
vb_cfg.max_pool_cnt = QUA_VB_MAX_POOLS;
vb_cfg.common_pools[0].block_size = blk_size;
vb_cfg.common_pools[0].block_cnt = 6;
sys_ops->sys_init(&vb_cfg);
}
const qua_mm_module_t *display_module = NULL;
ret = qua_mm_load_module(QUA_MM_MODULE_DISPLAY, &display_module);
if (ret != QUA_SUCCESS || display_module == NULL) {
printf("load display module failed\n");
return -1;
}
printf("Module %s, API version %d\n", display_module->id, display_module->api_version);
qua_mm_device_t *mm_device = NULL;
QUA_VO_DEV dev_num = VO_DEV_DHD;
ret = display_module->open_device(display_module, QUA_MM_DISP_DEV_VO, dev_num, &mm_device);
if (ret != QUA_SUCCESS || mm_device == NULL) {
printf("open vo dev failed\n");
return -1;
}
qua_mm_vo_device_t *vo_device = (qua_mm_vo_device_t *)mm_device;
printf("Device %s, number %d\n", vo_device->parent.id, vo_device->dev_num);
qua_vo_pub_attr_t dev_attr = {0};
ret = qua_get_cmdline_arg(argc, argv, QUA_ARG_INTF_TYPE, tmp_buf, sizeof(tmp_buf));
if (ret == QUA_FAILURE) {
printf("get intf type error!\n");
return ret;
}
dev_attr.intf_type = atoi(tmp_buf);
printf("get intf_type=%d\n", dev_attr.intf_type);
dev_attr.bg_color = 0;
ret = qua_get_cmdline_arg(argc, argv, QUA_ARG_INTF_SYNC, tmp_buf, sizeof(tmp_buf));
if (ret == QUA_FAILURE) {
printf("get intf sync error!\n");
return ret;
}
dev_attr.intf_sync = atoi(tmp_buf);
printf("get intf_sync=%d\n", dev_attr.intf_sync);
ret = vo_device->set_public_attr(dev_num, &dev_attr);
if (ret != QUA_SUCCESS) {
printf("Error: set_public_attr return %d\n", ret);
return -1;
}
if (vo_device->set_hdmi_fmt != NULL && (dev_attr.intf_type & QUA_VO_INTF_HDMI) != 0) {
qua_vo_hdmi_fmt_t hdmi_fmt;
hdmi_fmt.hdmi_fmt = QUA_HDMI_FORMAT_EXT_YUV422_16BIT;
ret = vo_device->set_hdmi_fmt(dev_num, &hdmi_fmt);
if (ret != QUA_SUCCESS) {
printf("Error: set_hdmi_fmt return %d\n", ret);
return -1;
}
}
ret = vo_device->enable(dev_num);
if (ret != QUA_SUCCESS) {
printf("Error: enable return %d\n", ret);
return -1;
}
// setup fb flow
mm_device = NULL;
ret = display_module->open_device(display_module, QUA_MM_DISP_DEV_FB, QUA_FB_DEV0, &mm_device);
if (ret != QUA_SUCCESS || mm_device == NULL) {
printf("open fb dev failed\n");
return -1;
}
qua_mm_fb_device_t *fb_device = (qua_mm_fb_device_t *)mm_device;
printf("Device %s, number %d\n", fb_device->parent.id, fb_device->dev_num);
QUA_CHAR *vaddr;
qua_fb_fix_screeninfo_t fix_info;
qua_fb_var_screeninfo_t var_info;
qua_fb_bitfield_t stR = {16,8,0};
qua_fb_bitfield_t stG = {8,8,0};
qua_fb_bitfield_t stB = {0,8,0};
qua_fb_bitfield_t stA = {24,8,0};
fb_device->show(fb_device, QUA_FALSE);
fb_device->compress(fb_device, QUA_FALSE);
qua_point_t position;
position.x = 0;
position.y = 0;
if (fb_device->put_origin(fb_device, &position) != QUA_SUCCESS) {
printf("put origin failed\n");
return -1;
}
qua_size_t screen_size;
screen_size.width = ALIGN_UP(img_width, 8);
screen_size.height = img_height;
if (fb_device->put_size(fb_device, &screen_size) != QUA_SUCCESS) {
printf("put size failed\n");
return -1;
}
if (fb_device->get_var_info(fb_device, &var_info) != QUA_SUCCESS) {
printf("get var info failed\n");
return -1;
}
var_info.xres_virtual = ALIGN_UP(img_width, 8);
var_info.yres_virtual = img_height;
var_info.xres = ALIGN_UP(img_width, 8);
var_info.yres = img_height;
var_info.activate = QUA_FB_ACTIVATE_NOW;
var_info.bits_per_pixel = 32;
var_info.xoffset = 0;
var_info.yoffset = 0;
var_info.red = stR;
var_info.green = stG;
var_info.blue = stB;
var_info.transp = stA;
if (fb_device->put_var_info(fb_device, &var_info) != QUA_SUCCESS) {
printf("put var info failed\n");
return -1;
}
if (fb_device->get_fix_info(fb_device, &fix_info) != QUA_SUCCESS) {
printf("get fix info failed\n");
return -1;
}
vaddr = fb_device->map(fb_device, fix_info.smem_len, 0);
if (vaddr == QUA_NULL) {
printf("map failed\n");
return -1;
}
memset(vaddr, 0x00, fix_info.smem_len);
if (fb_device->show(fb_device, QUA_TRUE) != QUA_SUCCESS) {
printf("show failed\n");
return -1;
}
fb_device->render(fb_device, &var_info);
usleep(100*1000);
fb_device->show(fb_device, QUA_FALSE);
fb_device->unmap(fb_device, vaddr, fix_info.smem_len);
fb_device->parent.close((struct qua_mm_device_t*)fb_device);
while (1) {
sleep(5);
}
printf("Never reach here...");
vo_device->disable(dev_num);
vo_device->parent.close((struct qua_mm_device_t*)vo_device);
return 0;
}