346 lines
9.7 KiB
C
346 lines
9.7 KiB
C
/*
|
|
* Copyright (c) 2021 Rockchip, Inc. All Rights Reserved.
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include "rkadk_common.h"
|
|
#include "rkadk_media_comm.h"
|
|
#include "rkadk_log.h"
|
|
#include "rkadk_param.h"
|
|
#include "rkadk_rtsp.h"
|
|
#include "isp/sample_isp.h"
|
|
#include "isp/sample_iio_aiq.h"
|
|
#include "rkadk_osd.h"
|
|
#include <getopt.h>
|
|
#include <signal.h>
|
|
#include <stdbool.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
|
|
extern int optind;
|
|
extern char *optarg;
|
|
|
|
#define IQ_FILE_PATH "/etc/iqfiles"
|
|
|
|
static bool is_quit = false;
|
|
static RKADK_CHAR optstr[] = "a:I:p:Aoeh";
|
|
|
|
static void print_usage(const RKADK_CHAR *name) {
|
|
printf("usage example:\n");
|
|
printf("\t%s [-a /etc/iqfiles] [-I 0]\n", name);
|
|
printf("\t-a: enable aiq with dirpath provided, eg:-a "
|
|
"/oem/etc/iqfiles/, Default /etc/iqfiles,"
|
|
"without this option aiq should run in other application\n");
|
|
printf("\t-I: Camera id, Default:0\n");
|
|
printf("\t-p: param ini directory path, Default:/data/rkadk\n");
|
|
printf("\t-o: osd file , Default:/userdata/rkadk_ARGB8888\n");
|
|
printf("\t-A: enable aiisp, Default:disable\n");
|
|
#ifdef ENABLE_EIS
|
|
printf("\t-e: enable eis, Default: disable\n");
|
|
#endif
|
|
}
|
|
|
|
static void sigterm_handler(int sig) {
|
|
fprintf(stderr, "signal %d\n", sig);
|
|
is_quit = true;
|
|
}
|
|
|
|
static int PostIspCallback(RK_VOID *pParam, RK_VOID *pPrivateData) {
|
|
int ret = 0;
|
|
|
|
#ifdef RKAIQ
|
|
RKADK_U32 u32CamId = (RKADK_U32)pPrivateData;
|
|
rk_ainr_param *pAinrParam = (rk_ainr_param *)pParam;
|
|
|
|
if (pAinrParam == RK_NULL) {
|
|
RKADK_LOGE("pAinrParam is nullptr!");
|
|
return -1;
|
|
}
|
|
|
|
memset(pAinrParam, 0, sizeof(rk_ainr_param));
|
|
ret = SAMPLE_ISP_GetAINrParams(u32CamId, pAinrParam);
|
|
if (ret) {
|
|
RKADK_LOGE("u32CamId[%d] can't get ainr param!", u32CamId);
|
|
return ret;
|
|
}
|
|
|
|
RKADK_LOGP("aiisp cam %d enable %d", u32CamId, ((rk_ainr_param *)pAinrParam)->enable);
|
|
#else
|
|
RKADK_LOGW("Don't enable aiq");
|
|
#endif
|
|
|
|
return ret;
|
|
}
|
|
|
|
int main(int argc, char *argv[]) {
|
|
int c, ret;
|
|
RKADK_OSD_ATTR_S OsdAttr;
|
|
RKADK_OSD_STREAM_ATTR_S OsdStreamAttr;
|
|
RKADK_U32 u32CamId = 0;
|
|
RKADK_U32 u32OsdId = 0;
|
|
RKADK_MW_PTR pHandle = NULL;
|
|
const char *iniPath = NULL;
|
|
char path[RKADK_PATH_LEN];
|
|
char sensorPath[RKADK_MAX_SENSOR_CNT][RKADK_PATH_LEN];
|
|
char *osdfile = "/userdata/rkadk_ARGB8888";
|
|
|
|
//aiisp
|
|
bool bAiispEnable = false;
|
|
RKADK_POST_ISP_ATTR_S stPostIspAttr;
|
|
RKADK_PARAM_RES_CFG_S stResCfg;
|
|
|
|
#ifdef ENABLE_EIS
|
|
bool bEnableEis = false;
|
|
rk_aiq_mems_sensor_intf_t eis_api;
|
|
#endif
|
|
|
|
#ifdef RKAIQ
|
|
const char *tmp_optarg = optarg;
|
|
SAMPLE_ISP_PARAM stIspParam;
|
|
|
|
memset(&stIspParam, 0, sizeof(SAMPLE_ISP_PARAM));
|
|
stIspParam.iqFileDir = IQ_FILE_PATH;
|
|
#endif
|
|
|
|
while ((c = getopt(argc, argv, optstr)) != -1) {
|
|
switch (c) {
|
|
#ifdef RKAIQ
|
|
case 'a':
|
|
if (!optarg && NULL != argv[optind] && '-' != argv[optind][0]) {
|
|
tmp_optarg = argv[optind++];
|
|
}
|
|
|
|
if (tmp_optarg)
|
|
stIspParam.iqFileDir = (char *)tmp_optarg;
|
|
break;
|
|
#endif
|
|
case 'I':
|
|
u32CamId = atoi(optarg);
|
|
break;
|
|
case 'p':
|
|
iniPath = optarg;
|
|
RKADK_LOGP("iniPath: %s", iniPath);
|
|
break;
|
|
case 'o':
|
|
osdfile = optarg;
|
|
RKADK_LOGP("osdfile: %s", osdfile);
|
|
break;
|
|
case 'A':
|
|
bAiispEnable = true;
|
|
break;
|
|
#ifdef ENABLE_EIS
|
|
case 'e':
|
|
bEnableEis = true;
|
|
break;
|
|
#endif
|
|
case 'h':
|
|
default:
|
|
print_usage(argv[0]);
|
|
optind = 0;
|
|
return 0;
|
|
}
|
|
}
|
|
optind = 0;
|
|
|
|
RKADK_LOGP("#camera id: %d", u32CamId);
|
|
|
|
RKADK_MPI_SYS_Init();
|
|
|
|
if (iniPath) {
|
|
memset(path, 0, RKADK_PATH_LEN);
|
|
memset(sensorPath, 0, RKADK_MAX_SENSOR_CNT * RKADK_PATH_LEN);
|
|
sprintf(path, "%s/rkadk_setting.ini", iniPath);
|
|
for (int i = 0; i < RKADK_MAX_SENSOR_CNT; i++)
|
|
sprintf(sensorPath[i], "%s/rkadk_setting_sensor_%d.ini", iniPath, i);
|
|
|
|
/*
|
|
lg:
|
|
char *sPath[] = {"/data/rkadk/rkadk_setting_sensor_0.ini",
|
|
"/data/rkadk/rkadk_setting_sensor_1.ini", NULL};
|
|
*/
|
|
char *sPath[] = {sensorPath[0], sensorPath[1], NULL};
|
|
|
|
RKADK_PARAM_Init(path, sPath);
|
|
} else {
|
|
RKADK_PARAM_Init(NULL, NULL);
|
|
}
|
|
|
|
#ifdef RKAIQ
|
|
RKADK_PARAM_FPS_S stFps;
|
|
|
|
#ifdef ENABLE_EIS
|
|
memset(&eis_api, 0, sizeof(rk_aiq_mems_sensor_intf_t));
|
|
eis_api.createContext = rkiio_aiq_sensor_ctx_create;
|
|
eis_api.destroyContext = rkiio_aiq_sensor_ctx_destroy;
|
|
eis_api.getSensorList = rkiio_aiq_sensors_list_get;
|
|
eis_api.releaseSensorList = rkiio_aiq_sensors_list_release;
|
|
eis_api.getSensorCapabilities = rkiio_aiq_sensor_cap_get;
|
|
eis_api.releaseSensorCapabilities = rkiio_aiq_sensor_cap_release;
|
|
eis_api.getConfig = rkiio_aiq_sensor_config_get;
|
|
eis_api.setConfig = rkiio_aiq_sensor_config_set;
|
|
eis_api.createHandle = rkiio_aiq_sensor_handle_create;
|
|
eis_api.destroyHandle = rkiio_aiq_sensor_handle_destroy;
|
|
eis_api.getData = rkiio_aiq_getData;
|
|
eis_api.getLastNSamples = rkiio_aiq_getLastNSamples;
|
|
eis_api.releaseSamplesData = rkiio_aiq_sensor_data_release;
|
|
#endif
|
|
|
|
rtsp:
|
|
stFps.enStreamType = RKADK_STREAM_TYPE_SENSOR;
|
|
ret = RKADK_PARAM_GetCamParam(u32CamId, RKADK_PARAM_TYPE_FPS, &stFps);
|
|
if (ret) {
|
|
RKADK_LOGE("RKADK_PARAM_GetCamParam fps failed");
|
|
return -1;
|
|
}
|
|
|
|
stIspParam.WDRMode = RK_AIQ_WORKING_MODE_NORMAL;
|
|
stIspParam.bMultiCam = false;
|
|
stIspParam.fps = stFps.u32Framerate;
|
|
#ifdef ENABLE_EIS
|
|
if (bEnableEis)
|
|
stIspParam.pEisApi = &eis_api;
|
|
#endif
|
|
SAMPLE_ISP_Start(u32CamId, stIspParam);
|
|
RKADK_BUFINFO("isp[%d] init", u32CamId);
|
|
#endif
|
|
|
|
ret = RKADK_RTSP_Init(u32CamId, 554, "/live/main_stream", &pHandle);
|
|
if (ret) {
|
|
RKADK_LOGE("RKADK_RTSP_Init failed(%d)", ret);
|
|
#ifdef RKAIQ
|
|
SAMPLE_ISP_Stop(u32CamId);
|
|
#endif
|
|
return -1;
|
|
}
|
|
|
|
//aiisp param init
|
|
memset(&stPostIspAttr, 0, sizeof(RKADK_POST_ISP_ATTR_S));
|
|
stPostIspAttr.pModelFilePath = "/oem/usr/lib/";
|
|
stPostIspAttr.stAiIspCallback.pPrivateData = (void *)u32CamId;
|
|
stPostIspAttr.stAiIspCallback.pfUpdateCallback = PostIspCallback;
|
|
stPostIspAttr.u32FrameBufCnt = 2;
|
|
if (bAiispEnable) {
|
|
ret = RKADK_MEDIA_EnablePostIsp(u32CamId, RKADK_STREAM_TYPE_LIVE, &stPostIspAttr);
|
|
if (!ret)
|
|
RKADK_LOGP("Display enable aiisp success!");
|
|
}
|
|
|
|
RKADK_RTSP_Start(pHandle);
|
|
|
|
memset(&OsdAttr, 0, sizeof(RKADK_OSD_ATTR_S));
|
|
memset(&OsdStreamAttr, 0, sizeof(RKADK_OSD_STREAM_ATTR_S));
|
|
OsdAttr.Format = RKADK_FMT_ARGB8888;
|
|
OsdAttr.Width = 320;
|
|
OsdAttr.Height = 128;
|
|
OsdAttr.pData = malloc(OsdAttr.Height * OsdAttr.Width * 4);
|
|
OsdAttr.enOsdType = RKADK_OSD_TYPE_NORMAL;
|
|
|
|
OsdStreamAttr.Origin_X = 0;
|
|
OsdStreamAttr.Origin_Y = 0;
|
|
OsdStreamAttr.bEnableShow = RKADK_TRUE;
|
|
OsdStreamAttr.enOsdType = RKADK_OSD_TYPE_NORMAL;
|
|
|
|
RKADK_OSD_Init(u32OsdId, &OsdAttr);
|
|
RKADK_OSD_AttachToStream(u32OsdId, u32CamId,
|
|
RKADK_STREAM_TYPE_LIVE, &OsdStreamAttr);
|
|
|
|
FILE *fp = fopen(osdfile, "rw");
|
|
if (!fp) {
|
|
RKADK_LOGP("open osd file fail");
|
|
} else {
|
|
RKADK_LOGP("open osd file success");
|
|
fread((RKADK_U8 *)OsdAttr.pData, OsdAttr.Width * OsdAttr.Height * 4, 1, fp);
|
|
fclose(fp);
|
|
RKADK_OSD_UpdateBitMap(u32OsdId, &OsdAttr);
|
|
}
|
|
|
|
signal(SIGINT, sigterm_handler);
|
|
|
|
char cmd[64];
|
|
printf("\n#Usage: input 'quit' to exit programe!\n"
|
|
"peress any other key to capture one picture to file\n");
|
|
while (!is_quit) {
|
|
fgets(cmd, sizeof(cmd), stdin);
|
|
if (strstr(cmd, "quit") || is_quit) {
|
|
RKADK_LOGP("#Get 'quit' cmd!");
|
|
break;
|
|
} else if (strstr(cmd, "start")) {
|
|
RKADK_RTSP_Start(pHandle);
|
|
} else if (strstr(cmd, "stop")) {
|
|
RKADK_RTSP_Stop(pHandle);
|
|
} else if (strstr(cmd, "aiisp")) {
|
|
if (bAiispEnable)
|
|
bAiispEnable = false;
|
|
else
|
|
bAiispEnable = true;
|
|
|
|
ret = RKADK_MEDIA_SetPostIspAttr(u32CamId, RKADK_STREAM_TYPE_LIVE, bAiispEnable, &stPostIspAttr);
|
|
if (ret)
|
|
RKADK_LOGE("RKADK_MEDIA_SetPostIspAttr failed");
|
|
} else if (strstr(cmd, "720")) {
|
|
stResCfg.enResType = RKADK_RES_720P;
|
|
stResCfg.enStreamType = RKADK_STREAM_TYPE_LIVE;
|
|
RKADK_PARAM_SetCamParam(u32CamId, RKADK_PARAM_TYPE_STREAM_RES, &stResCfg);
|
|
ret = RKADK_RTSP_VideoReset(pHandle);
|
|
if (ret < 0) {
|
|
#if !defined(RV1106_1103) && !defined(RV1103B)
|
|
RKADK_RTSP_Stop(pHandle);
|
|
RKADK_RTSP_DeInit(pHandle);
|
|
pHandle = NULL;
|
|
#ifdef RKAIQ
|
|
SAMPLE_ISP_Stop(u32CamId);
|
|
#endif
|
|
goto rtsp;
|
|
#endif
|
|
}
|
|
RKADK_RTSP_Start(pHandle);
|
|
} else if (strstr(cmd, "480")) {
|
|
stResCfg.enResType = RKADK_RES_480P;
|
|
stResCfg.enStreamType = RKADK_STREAM_TYPE_LIVE;
|
|
RKADK_PARAM_SetCamParam(u32CamId, RKADK_PARAM_TYPE_STREAM_RES, &stResCfg);
|
|
ret = RKADK_RTSP_VideoReset(pHandle);
|
|
if (ret < 0) {
|
|
#if !defined(RV1106_1103) && !defined(RV1103B)
|
|
RKADK_RTSP_Stop(pHandle);
|
|
RKADK_RTSP_DeInit(pHandle);
|
|
pHandle = NULL;
|
|
#ifdef RKAIQ
|
|
SAMPLE_ISP_Stop(u32CamId);
|
|
#endif
|
|
goto rtsp;
|
|
#endif
|
|
}
|
|
RKADK_RTSP_Start(pHandle);
|
|
}
|
|
|
|
usleep(500000);
|
|
}
|
|
|
|
RKADK_OSD_DettachFromStream(u32OsdId, u32CamId,
|
|
RKADK_STREAM_TYPE_LIVE);
|
|
RKADK_OSD_Deinit(u32OsdId);
|
|
free(OsdAttr.pData);
|
|
RKADK_RTSP_Stop(pHandle);
|
|
RKADK_RTSP_DeInit(pHandle);
|
|
pHandle = NULL;
|
|
|
|
#ifdef RKAIQ
|
|
SAMPLE_ISP_Stop(u32CamId);
|
|
#endif
|
|
RKADK_MPI_SYS_Exit();
|
|
return 0;
|
|
}
|