luckfox-pico-sdk/project/make_meta/make_meta/sample_read_write_meta.c
luckfox-eng29 8f34c2760d project:build.sh: Added fastboot support; custom modifications to U-Boot and kernel implemented using patches.
project:cfg:BoardConfig_IPC: Added fastboot BoardConfig file and firmware post-scripts, distinguishing between
the BoardConfigs for Luckfox Pico Pro and Luckfox Pico Max. project:app: Added fastboot_client and rk_smart_door
for quick boot applications; updated rkipc app to adapt to the latest media library. media:samples: Added more
usage examples. media:rockit: Fixed bugs; removed support for retrieving data frames from VPSS. media:isp:
Updated rkaiq library and related tools to support connection to RKISP_Tuner. sysdrv:Makefile: Added support for
compiling drv_ko on Luckfox Pico Ultra W using Ubuntu; added support for custom root filesystem.
sysdrv:tools:board: Updated Buildroot optional mirror sources, updated some software versions, and stored device
tree files and configuration files that undergo multiple modifications for U-Boot and kernel separately.
sysdrv:source:mcu: Used RISC-V MCU SDK with RT-Thread system, mainly for initializing camera AE during quick
boot. sysdrv:source:uboot: Added support for fastboot; added high baud rate DDR bin for serial firmware upgrades.
sysdrv:source:kernel: Upgraded to version 5.10.160; increased NPU frequency for RV1106G3; added support for
fastboot.

Signed-off-by: luckfox-eng29 <eng29@luckfox.com>
2024-10-14 09:47:04 +08:00

350 lines
12 KiB
C

#include <fcntl.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <unistd.h>
#include <errno.h>
#include "sensor_define.h"
#include "sensor_2a_common.h"
#include "sensor_init_info.h"
#include "sensor_iq_info.h"
#include "rk_meta.h"
#include "rk_meta_app_param.h"
/* META layout */
/***************************/ /* ----- ITEM start -----*/
/** META_HEAD **/
/***************************/
/** ITEM 1 **/
/***************************/
/** ITEM 2 **/
/***************************/
/** ITEM 3 **/
/***************************/
/** .... **/
/***************************/ /* --- ITEM backup start ---*/
/** ITEM 1 BACKUP **/
/***************************/
/** ITEM 2 BACKUP **/
/***************************/
/** ITEM 3 BACKUP **/
/***************************/
/** .... **/
/***************************/
/** META_END **/
/***************************/ /* ----- ITEM backup end -----*/
/** IQ FILE BIN **/ /* 320K sensor iq file bin */
/***************************/
#define META_TRUE (1)
#define META_FALSE (0)
#define ALIGN16(len) (((len) + 15) & ~15)
#define uswap_32(x) \
((((x) & 0xff000000) >> 24) | \
(((x) & 0x00ff0000) >> 8) | \
(((x) & 0x0000ff00) << 8) | \
(((x) & 0x000000ff) << 24))
#if __BYTE_ORDER == __LITTLE_ENDIAN
# define cpu_to_le32(x) (x)
# define le32_to_cpu(x) (x)
#else
# define cpu_to_le32(x) uswap_32(x)
# define le32_to_cpu(x) uswap_32(x)
#endif
#define tole(x) cpu_to_le32(x)
static const uint32_t crc_table[256] = {
tole(0x00000000L), tole(0x77073096L), tole(0xee0e612cL), tole(0x990951baL),
tole(0x076dc419L), tole(0x706af48fL), tole(0xe963a535L), tole(0x9e6495a3L),
tole(0x0edb8832L), tole(0x79dcb8a4L), tole(0xe0d5e91eL), tole(0x97d2d988L),
tole(0x09b64c2bL), tole(0x7eb17cbdL), tole(0xe7b82d07L), tole(0x90bf1d91L),
tole(0x1db71064L), tole(0x6ab020f2L), tole(0xf3b97148L), tole(0x84be41deL),
tole(0x1adad47dL), tole(0x6ddde4ebL), tole(0xf4d4b551L), tole(0x83d385c7L),
tole(0x136c9856L), tole(0x646ba8c0L), tole(0xfd62f97aL), tole(0x8a65c9ecL),
tole(0x14015c4fL), tole(0x63066cd9L), tole(0xfa0f3d63L), tole(0x8d080df5L),
tole(0x3b6e20c8L), tole(0x4c69105eL), tole(0xd56041e4L), tole(0xa2677172L),
tole(0x3c03e4d1L), tole(0x4b04d447L), tole(0xd20d85fdL), tole(0xa50ab56bL),
tole(0x35b5a8faL), tole(0x42b2986cL), tole(0xdbbbc9d6L), tole(0xacbcf940L),
tole(0x32d86ce3L), tole(0x45df5c75L), tole(0xdcd60dcfL), tole(0xabd13d59L),
tole(0x26d930acL), tole(0x51de003aL), tole(0xc8d75180L), tole(0xbfd06116L),
tole(0x21b4f4b5L), tole(0x56b3c423L), tole(0xcfba9599L), tole(0xb8bda50fL),
tole(0x2802b89eL), tole(0x5f058808L), tole(0xc60cd9b2L), tole(0xb10be924L),
tole(0x2f6f7c87L), tole(0x58684c11L), tole(0xc1611dabL), tole(0xb6662d3dL),
tole(0x76dc4190L), tole(0x01db7106L), tole(0x98d220bcL), tole(0xefd5102aL),
tole(0x71b18589L), tole(0x06b6b51fL), tole(0x9fbfe4a5L), tole(0xe8b8d433L),
tole(0x7807c9a2L), tole(0x0f00f934L), tole(0x9609a88eL), tole(0xe10e9818L),
tole(0x7f6a0dbbL), tole(0x086d3d2dL), tole(0x91646c97L), tole(0xe6635c01L),
tole(0x6b6b51f4L), tole(0x1c6c6162L), tole(0x856530d8L), tole(0xf262004eL),
tole(0x6c0695edL), tole(0x1b01a57bL), tole(0x8208f4c1L), tole(0xf50fc457L),
tole(0x65b0d9c6L), tole(0x12b7e950L), tole(0x8bbeb8eaL), tole(0xfcb9887cL),
tole(0x62dd1ddfL), tole(0x15da2d49L), tole(0x8cd37cf3L), tole(0xfbd44c65L),
tole(0x4db26158L), tole(0x3ab551ceL), tole(0xa3bc0074L), tole(0xd4bb30e2L),
tole(0x4adfa541L), tole(0x3dd895d7L), tole(0xa4d1c46dL), tole(0xd3d6f4fbL),
tole(0x4369e96aL), tole(0x346ed9fcL), tole(0xad678846L), tole(0xda60b8d0L),
tole(0x44042d73L), tole(0x33031de5L), tole(0xaa0a4c5fL), tole(0xdd0d7cc9L),
tole(0x5005713cL), tole(0x270241aaL), tole(0xbe0b1010L), tole(0xc90c2086L),
tole(0x5768b525L), tole(0x206f85b3L), tole(0xb966d409L), tole(0xce61e49fL),
tole(0x5edef90eL), tole(0x29d9c998L), tole(0xb0d09822L), tole(0xc7d7a8b4L),
tole(0x59b33d17L), tole(0x2eb40d81L), tole(0xb7bd5c3bL), tole(0xc0ba6cadL),
tole(0xedb88320L), tole(0x9abfb3b6L), tole(0x03b6e20cL), tole(0x74b1d29aL),
tole(0xead54739L), tole(0x9dd277afL), tole(0x04db2615L), tole(0x73dc1683L),
tole(0xe3630b12L), tole(0x94643b84L), tole(0x0d6d6a3eL), tole(0x7a6a5aa8L),
tole(0xe40ecf0bL), tole(0x9309ff9dL), tole(0x0a00ae27L), tole(0x7d079eb1L),
tole(0xf00f9344L), tole(0x8708a3d2L), tole(0x1e01f268L), tole(0x6906c2feL),
tole(0xf762575dL), tole(0x806567cbL), tole(0x196c3671L), tole(0x6e6b06e7L),
tole(0xfed41b76L), tole(0x89d32be0L), tole(0x10da7a5aL), tole(0x67dd4accL),
tole(0xf9b9df6fL), tole(0x8ebeeff9L), tole(0x17b7be43L), tole(0x60b08ed5L),
tole(0xd6d6a3e8L), tole(0xa1d1937eL), tole(0x38d8c2c4L), tole(0x4fdff252L),
tole(0xd1bb67f1L), tole(0xa6bc5767L), tole(0x3fb506ddL), tole(0x48b2364bL),
tole(0xd80d2bdaL), tole(0xaf0a1b4cL), tole(0x36034af6L), tole(0x41047a60L),
tole(0xdf60efc3L), tole(0xa867df55L), tole(0x316e8eefL), tole(0x4669be79L),
tole(0xcb61b38cL), tole(0xbc66831aL), tole(0x256fd2a0L), tole(0x5268e236L),
tole(0xcc0c7795L), tole(0xbb0b4703L), tole(0x220216b9L), tole(0x5505262fL),
tole(0xc5ba3bbeL), tole(0xb2bd0b28L), tole(0x2bb45a92L), tole(0x5cb36a04L),
tole(0xc2d7ffa7L), tole(0xb5d0cf31L), tole(0x2cd99e8bL), tole(0x5bdeae1dL),
tole(0x9b64c2b0L), tole(0xec63f226L), tole(0x756aa39cL), tole(0x026d930aL),
tole(0x9c0906a9L), tole(0xeb0e363fL), tole(0x72076785L), tole(0x05005713L),
tole(0x95bf4a82L), tole(0xe2b87a14L), tole(0x7bb12baeL), tole(0x0cb61b38L),
tole(0x92d28e9bL), tole(0xe5d5be0dL), tole(0x7cdcefb7L), tole(0x0bdbdf21L),
tole(0x86d3d2d4L), tole(0xf1d4e242L), tole(0x68ddb3f8L), tole(0x1fda836eL),
tole(0x81be16cdL), tole(0xf6b9265bL), tole(0x6fb077e1L), tole(0x18b74777L),
tole(0x88085ae6L), tole(0xff0f6a70L), tole(0x66063bcaL), tole(0x11010b5cL),
tole(0x8f659effL), tole(0xf862ae69L), tole(0x616bffd3L), tole(0x166ccf45L),
tole(0xa00ae278L), tole(0xd70dd2eeL), tole(0x4e048354L), tole(0x3903b3c2L),
tole(0xa7672661L), tole(0xd06016f7L), tole(0x4969474dL), tole(0x3e6e77dbL),
tole(0xaed16a4aL), tole(0xd9d65adcL), tole(0x40df0b66L), tole(0x37d83bf0L),
tole(0xa9bcae53L), tole(0xdebb9ec5L), tole(0x47b2cf7fL), tole(0x30b5ffe9L),
tole(0xbdbdf21cL), tole(0xcabac28aL), tole(0x53b39330L), tole(0x24b4a3a6L),
tole(0xbad03605L), tole(0xcdd70693L), tole(0x54de5729L), tole(0x23d967bfL),
tole(0xb3667a2eL), tole(0xc4614ab8L), tole(0x5d681b02L), tole(0x2a6f2b94L),
tole(0xb40bbe37L), tole(0xc30c8ea1L), tole(0x5a05df1bL), tole(0x2d02ef8dL)
};
/* ========================================================================= */
# if __BYTE_ORDER == __LITTLE_ENDIAN
# define DO_CRC(x) crc = tab[(crc ^ (x)) & 255] ^ (crc >> 8)
# else
# define DO_CRC(x) crc = tab[((crc >> 24) ^ (x)) & 255] ^ (crc << 8)
# endif
static uint32_t crc32_no_comp(uint32_t crc, const uint8_t *buf, int len)
{
const uint32_t *tab = crc_table;
const uint32_t *b =(const uint32_t *)buf;
size_t rem_len;
crc = cpu_to_le32(crc);
/* Align it */
if (((long)b) & 3 && len) {
uint8_t *p = (uint8_t *)b;
do {
DO_CRC(*p++);
} while ((--len) && ((long)p)&3);
b = (uint32_t *)p;
}
rem_len = len & 3;
len = len >> 2;
for (--b; len; --len) {
/* load data 32 bits wide, xor data 32 bits wide. */
crc ^= *++b; /* use pre increment for speed */
DO_CRC(0);
DO_CRC(0);
DO_CRC(0);
DO_CRC(0);
}
len = rem_len;
/* And the last few bytes */
if (len) {
uint8_t *p = (uint8_t *)(b + 1) - 1;
do {
DO_CRC(*++p); /* use pre increment for speed */
} while (--len);
}
return le32_to_cpu(crc);
}
static uint32_t crc32 (uint32_t crc, const uint8_t *p, int len)
{
return crc32_no_comp(crc ^ 0xffffffffL, p, len) ^ 0xffffffffL;
}
static int write_item_to_file(int fd, uint32_t offset, uint8_t *from, int len)
{
int ret;
lseek(fd, offset, SEEK_SET);
ret = write(fd, from, len);
if (ret != len) {
printf("write meta failed\n");
return -1;
}
return 0;
}
int update_cmdline_data(char *pcmd, const char *target, uint32_t val)
{
uint8_t data[32];
char tmp_cmd[strlen(pcmd)];
int space_cnt = 0;
const char *space = " ";
char *pstr = target;
int target_name_len = 0;
memset(tmp_cmd, '\0', sizeof(tmp_cmd)/sizeof(tmp_cmd[0]));
memset(data, '\0', sizeof(data)/sizeof(data[0]));
while (pstr && (*pstr != '=') && (*pstr != '\0')) {
pstr++;
target_name_len++;
}
memcpy(data, target, target_name_len);
pstr = strstr((const char *)pcmd, (const char *)data);
while (pstr && (*pstr != ' ') && (*pstr != '\0')) {
*pstr = ' ';
pstr++;
space_cnt++;
}
memmove(pstr-space_cnt, pstr, strlen(pstr));
pstr = pcmd + strlen(pcmd) - 1;
while ( space_cnt != 0 ) {
*pstr = '\0';
pstr--;
space_cnt--;
}
strcat(pcmd, space);
strncat(pcmd, target, strlen(target));
sprintf(tmp_cmd, pcmd, val);
memcpy(pcmd, tmp_cmd, strlen(tmp_cmd));
pcmd[strlen(tmp_cmd)] = '\0';
return 0;
}
int read_write_meta(const char *path)
{
const char g_sensor_init_head[4] = {'S', 'N', 'I', 'F'};
const char g_cmdline_head[4] = {'C', 'M', 'D', 'L'};
const char g_ae_awb_table_head[4] = {'A', 'E', 'A', 'W'};
const char g_sensor_iq_head[4] = {'S', 'N', 'I', 'Q'};
const char g_app_param_head[4] = {'A', 'P', 'R', 'A'};
int ret = 0;
uint8_t *buf = (uint8_t *)malloc((MAX_META_SEGMENT_SIZE + SENSOR_IQ_BIN_MAX_SIZE));
if (buf == NULL) {
printf("malloc buf failed:%s\n", strerror(errno));
return -1;
}
int fd = open(path, O_RDWR, 0644);
if (fd < 0) {
free(buf);
return -1;
}
printf("read meta:\n");
int len = read(fd, buf, (MAX_META_SEGMENT_SIZE + SENSOR_IQ_BIN_MAX_SIZE));
if (len == 0) {
printf("empty file\n");
free(buf);
close(fd);
return -1;
}
if (*(uint32_t *)buf != RK_META) {
printf("Invalid meta head\n");
free(buf);
return -1;
}
if (*(uint32_t *)(buf + MAX_META_SEGMENT_SIZE - 4) != RK_META_END) {
printf("Invalid meta end\n");
free(buf);
return -1;
}
struct cmdline_info *cmdline_p = (struct cmdline_info *)(buf + CMDLINE_OFFSET);
uint32_t *cmdline_head_p = (uint32_t *)&g_cmdline_head;
if (cmdline_p->tag != *cmdline_head_p) {
printf("Invalid cmdline\n");
} else {
printf("cmdline : %s\n", cmdline_p->data);
printf("cmdline crc32: 0x%08x\n", cmdline_p->crc32);
}
update_cmdline_data(cmdline_p->data, "rk_cam_w=%d", 1234);
printf ( "cmdline: [%s]\n", cmdline_p->data );
cmdline_p->crc32 = crc32(0, (uint8_t *)cmdline_p, sizeof(struct cmdline_info)-4);
ret = write_item_to_file(fd, CMDLINE_OFFSET, (uint8_t *)cmdline_p, CMDLINE_MAX_SIZE);
if (ret < 0) {
printf("failed to write app param to meta file\n");
goto close_file;
}
printf ( "\n" );
struct app_param_info *app = (struct app_param_info *)(buf + APP_PARAM_OFFSET);
uint32_t *app_head_p = (uint32_t *)g_app_param_head;
if (app->head != *app_head_p) {
printf("Invalid app param config\n");
} else {
printf("App parameter config : \n");
printf(" offset : 0x%08x\n", APP_PARAM_OFFSET);
printf(" length : 0x%08x\n", app->len);
printf(" crc : 0x%08x\n", app->crc32);
printf(" %s : 0x%08x\n",RK_CAM_MIRROR_FLIP , app->cam_mirror_flip);
printf(" %s : 0x%08x\n",RK_CAM_FPS, app->cam_fps);
printf(" %s : %d\n",RK_CAM_HDR, app->cam_hdr);
printf(" %s : 0x%08x\n",RK_LED_VALUE , app->led_value);
printf(" %s : 0x%08x\n",RK_NIGHT_MODE , app->night_mode);
printf(" %s : %d\n",RK_VENC_W , app->venc_w);
printf(" %s : %d\n",RK_VENC_H , app->venc_h);
printf(" %s : %d\n",RK_VENC_TYPE , app->venc_type);
printf(" %s : %d\n",RK_VENC_BITRATE , app->venc_bitrate);
}
printf ( "\n" );
printf("write meta:\n");
app->venc_type = 2;
app->crc32 = crc32(0, (uint8_t *)app, app->len);
ret = write_item_to_file(fd, APP_PARAM_OFFSET, (uint8_t *)app, APP_PARAM_MAX_SIZE);
if (ret < 0) {
printf("failed to write app param to meta file\n");
goto close_file;
}
close_file:
close(fd);
free(buf);
return 0;
}
int main(int argc, char *argv[])
{
if ( argc != 2 ) {
printf("format: %s <meta path>\n", argv[0]);
return -1;
}
if (access(argv[1], R_OK) != 0) {
printf("%s:%d %s can't be read\n", argv[0], __LINE__, argv[1]);
return -1;
}
return read_write_meta(argv[1]);
}