zouhaitao/TAIXIN
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Initial commit: TXW82x FPV v2.7.0.7-42229 SDK + project sources

Browse Source
This commit is contained in:
zouhaitao
2026-07-06 11:30:13 +08:00
commit e76462eeb7
3451 changed files with 1415300 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

518
sdk/app/scale_msi/scale3_normal_msi.c Normal file
View File

@@ -0,0 +1,518 @@
#include "scale_msi.h"
#include "dev/vpp/hgvpp.h"
#include "lib/video/vpp/vpp_dev.h"
#include "dev/scale/hgscale.h"
#include "lib/heap/av_heap.h"
#include "lib/heap/av_psram_heap.h"
#include "user_work/user_work.h"
#include "scale3_normal_msi.h"
extern int32_t takephoto_name_no_dir_time(char *filename, int filename_size,struct timeval *t);
#define EXTERN_RB_COUNT 50
uint32_t yuv_buf_line(uint8_t which);
#define MAX_COUNT 3
/*********************************************************************
* 这个模块是分别输出两种图片的yuv,一种是原图,一种是缩略图
********************************************************************/
// data申请空间函数
#define STREAM_MALLOC av_psram_malloc
#define STREAM_FREE av_psram_free
#define STREAM_ZALLOC av_psram_zalloc
// 结构体申请空间函数
#define STREAM_LIBC_MALLOC av_malloc
#define STREAM_LIBC_FREE av_free
#define STREAM_LIBC_ZALLOC av_zalloc
struct scale3_normal_msi
{
struct os_work work;
struct msi *msi;
struct scale_device *scale_dev;
struct fbpool pool;
struct os_msgqueue msgq;
uint8_t *buf;
uint16_t iw, ih;
uint16_t ow, oh;
struct framebuff *fb;
struct framebuff *extern_fb;
struct scale3_normal_cmd_s *normal_cmd;
uint32_t last_time;
uint8_t force_stype;
uint8_t ready : 1, extern_fb_ready : 1, start : 1,exit:1;
RBUFFER_DEF(extern_rb, struct scale3_normal_cmd_s *, EXTERN_RB_COUNT);
};
void *get_vpp_buf(uint8_t which);
uint8_t get_vpp_w_h(uint16_t *w, uint16_t *h);
static int32_t const_scale3_msi_action(struct msi *msi, uint32_t cmd_id, uint32_t param1, uint32_t param2)
{
int32_t ret = RET_OK;
struct scale3_normal_msi *scale3 = (struct scale3_normal_msi *) msi->priv;
switch (cmd_id)
{
// 这里msi已经被删除,那么就要考虑tx_pool的资源释放了
// 能进来这里,就是代表所有fb都已经用完了
case MSI_CMD_POST_DESTROY:
{
struct framebuff *fb;
// 释放资源fb资源文件
while (1)
{
fb = fbpool_get(&scale3->pool, 0, NULL);
if (!fb)
{
break;
}
// 预分配空间释放
if (fb->priv)
{
STREAM_LIBC_FREE(fb->priv);
}
if (fb->data)
{
STREAM_FREE(fb->data);
}
}
os_msgq_del(&scale3->msgq);
struct scale3_normal_cmd_s *normal_cmd;
if(scale3->normal_cmd)
{
STREAM_FREE(scale3->normal_cmd);
scale3->normal_cmd = NULL;
}
while(RB_GET(&scale3->extern_rb, normal_cmd))
{
STREAM_FREE(normal_cmd);
}
STREAM_FREE(scale3);
}
break;
// 停止硬件,移除没有必要的资源(但是fb的资源不能现在删除,这个时候fb可能外部还在调用)
case MSI_CMD_PRE_DESTROY:
{
scale_close(scale3->scale_dev);
// 关闭work
os_work_cancle2(&scale3->work, 1);
scale3->start = 0;
scale3->exit = 1;
if (scale3->extern_fb)
{
msi_delete_fb(scale3->msi, scale3->fb);
scale3->fb = NULL;
}
if (scale3->fb)
{
msi_delete_fb(scale3->msi, scale3->fb);
scale3->fb = NULL;
}
struct framebuff *fb = NULL;
while (1)
{
fb = (struct framebuff *) os_msgq_get2(&scale3->msgq, 0, NULL);
if (fb)
{
msi_delete_fb(NULL, fb);
fb = NULL;
}
else
{
break;
}
}
}
break;
case MSI_CMD_FREE_FB:
{
struct framebuff *fb = (struct framebuff *) param1;
// sys_dcache_invalid_range(fb->data, scale3->ow * scale3->oh * 3 / 2);
if (fb->datatag != 0xff)
{
fbpool_put(&scale3->pool, fb);
ret = RET_OK + 1;
}
else
{
STREAM_FREE(fb->data);
STREAM_LIBC_FREE(fb->priv);
scale3->extern_fb_ready = 1;
}
if(!scale3->exit)
{
os_run_work(&scale3->work);
}
}
break;
// 私有命令,特定结构体{w,h,time,stype}
case MSI_CMD_SCALE3_NORMAL:
{
uint32_t cmd_self = (uint32_t) param1;
// uint32_t arg = param2;
switch (cmd_self)
{
case MSI_SCALE3_START:
{
scale3->start = param2 & 0x01;
os_run_work(&scale3->work);
break;
}
break;
case MSI_SCLAE3_NORMAL_ADD_DPI:
{
// 申请一个arg结构体给到ringbuf,等待workqueue去生成对应的fb
struct scale3_normal_cmd_s *cmd = STREAM_MALLOC(sizeof(struct scale3_normal_cmd_s));
if (cmd)
{
memcpy(cmd, (void *) param2, sizeof(struct scale3_normal_cmd_s));
RB_SET(&scale3->extern_rb, cmd);
os_run_work(&scale3->work);
}
break;
}
default:
{
break;
}
}
}
break;
default:
break;
}
return ret;
}
static int32_t scale3_stream_done(uint32 irq_flag, uint32 irq_data, uint32 param1)
{
struct scale3_normal_msi *scale3 = (struct scale3_normal_msi *) irq_data;
struct framebuff *fb;
struct takephoto_yuv_arg_s *arg;
uint8_t *p_buf;
uint32_t ow = 0, oh = 0;
// 如果是需要额外抽一帧生成特定size的yuv
if (scale3->extern_fb)
{
arg = scale3->extern_fb->priv;
ow = arg->yuv_arg.out_w;
oh = arg->yuv_arg.out_h;
p_buf = (uint8_t *) scale3->extern_fb->data;
fb = scale3->extern_fb;
scale3->extern_fb = NULL;
}
else
{
if (scale3->start)
{
ow = scale3->ow;
oh = scale3->oh;
fb = fbpool_get(&scale3->pool, 0, scale3->msi);
}
else
{
fb = NULL;
}
// 空间不够,则使用原来的空间
if (!fb)
{
scale_close(scale3->scale_dev);
goto scale3_stream_done_end;
}
// 配置新的空间地址
p_buf = (uint8_t *) fb->data;
}
scale_set_in_out_size(scale3->scale_dev, scale3->iw, scale3->ih, ow, oh);
scale_set_step(scale3->scale_dev, scale3->iw, scale3->ih, ow, oh);
scale_set_out_yaddr(scale3->scale_dev, (uint32) p_buf);
scale_set_out_uaddr(scale3->scale_dev, (uint32) p_buf + ow * oh);
scale_set_out_vaddr(scale3->scale_dev, (uint32) p_buf + ow * oh + ow * oh / 4);
scale3_stream_done_end:
// 发送now_data,发送失败也要返回
if (os_msgq_put(&scale3->msgq, (uint32_t) scale3->fb, 0))
{
// 正常不能中断del,但是这个模块是内部,只要del没有一些等待信号量操作,问题不大
msi_delete_fb(NULL, scale3->fb);
scale3->fb = NULL;
// return 0;
}
if (!fb)
{
scale3->ready = 1;
}
scale3->fb = fb;
os_run_work(&scale3->work);
return 0;
}
static int32_t scale3_stream_ov(uint32 irq_flag, uint32 irq_data, uint32 param1)
{
os_printf("%s:%d\n", __FUNCTION__, __LINE__);
return 0;
}
// 如果空间申请不到,就延时去输出
static int32 scale3_normal_msi_work(struct os_work *work)
{
struct scale3_normal_msi *scale3 = (struct scale3_normal_msi *) work;
struct scale_device *scale_dev = scale3->scale_dev;
uint8_t delay_time = 0;
struct framebuff *fb = NULL;
struct framebuff *e_fb = NULL;
struct takephoto_yuv_arg_s *arg = NULL;
uint16_t ow = 0;
uint16_t oh = 0;
uint32_t magic = 0;
int32_t err = -1;
// 先去检查是否有需要生成额外的yuv数据没
// 检查如果没有extern_fb,并且有额外命令,则生成一个fb
if (scale3->extern_fb_ready && !scale3->extern_fb)
{
if (!scale3->normal_cmd)
{
RB_GET(&scale3->extern_rb, scale3->normal_cmd);
}
if (scale3->normal_cmd)
{
if (scale3->normal_cmd->w && scale3->normal_cmd->h)
{
ow = scale3->normal_cmd->w;
oh = scale3->normal_cmd->h;
}
else
{
ow = scale3->iw;
oh = scale3->ih;
}
uint8_t *data = STREAM_MALLOC(ow * oh * 3 / 2);
if (data)
{
arg = (struct takephoto_yuv_arg_s *) STREAM_LIBC_ZALLOC(sizeof(struct takephoto_yuv_arg_s));
e_fb = fb_alloc(data, ow * oh * 3 / 2, F_YUV << 8 | FSTYPE_NONE, scale3->msi);
// 如果w和h其中一个为0,则使用iw和ih
e_fb->datatag = ~0; // 设置特殊标志,用于识别是否是额外生成的fb
e_fb->priv = arg;
arg->yuv_arg.y_size = ow * oh;
arg->yuv_arg.y_off = 0;
arg->yuv_arg.uv_off = 0;
arg->yuv_arg.out_w = ow;
arg->yuv_arg.out_h = oh;
arg->yuv_arg.magic = scale3->normal_cmd->magic;
arg->yuv_arg.type = scale3->normal_cmd->force_type;
takephoto_name_no_dir_time(arg->name, sizeof(arg->name), &scale3->normal_cmd->t);
scale3->extern_fb_ready = 0;
scale3->extern_fb = e_fb;
sys_dcache_invalid_range((uint32_t *) data, ow * oh * 3 / 2);
STREAM_FREE(scale3->normal_cmd);
scale3->normal_cmd = NULL;
}
}
}
fb = (struct framebuff *) os_msgq_get2(&scale3->msgq, 0, &err);
if (fb)
{
if (fb->datatag != (uint8_t) ~0)
{
_os_printf(KERN_INFO "S");
fb->mtype = F_YUV;
fb->stype = scale3->force_stype;
arg = fb->priv;
ow = scale3->ow;
oh = scale3->oh;
arg->yuv_arg.y_size = ow * oh;
arg->yuv_arg.y_off = 0;
arg->yuv_arg.uv_off = 0;
arg->yuv_arg.out_w = ow;
arg->yuv_arg.out_h = oh;
arg->yuv_arg.magic = magic;
arg->yuv_arg.type = YUV_ARG_NONE;
msi_output_fb(scale3->msi, fb);
}
else
{
msi_output_fb(scale3->msi, fb);
}
fb = NULL;
}
// scale3可能空间不够关闭了中断,也可能是第一次启动
if (scale3->ready)
{
if (scale3->extern_fb)
{
arg = scale3->extern_fb->priv;
ow = arg->yuv_arg.out_w;
oh = arg->yuv_arg.out_h;
scale3->fb = scale3->extern_fb;
scale3->extern_fb = NULL;
fb = NULL;
}
else
{
if (scale3->start)
{
fb = fbpool_get(&scale3->pool, F_YUV << 8 | FSTYPE_YUV_P0, scale3->msi);
if (fb)
{
ow = scale3->ow;
oh = scale3->oh;
scale3->fb = fb;
fb = NULL;
}
}
}
if (!scale3->fb)
{
_os_printf(KERN_INFO "D");
delay_time = 0;
goto scale3_normal_msi_work_end;
}
// 暂时用同样的iw ih ow oh
scale_set_in_out_size(scale_dev, scale3->iw, scale3->ih, ow, oh);
scale_set_step(scale_dev, scale3->iw, scale3->ih, ow, oh);
scale_set_start_addr(scale_dev, 0, 0);
// 暂时固定,如果遇到需要动态修改的,可以通过参数之类来切换
scale_set_dma_to_memory(scale_dev, 1);
scale_set_data_from_vpp(scale_dev, 1);
scale_set_line_buf_num(scale_dev, yuv_buf_line(0));
scale_set_in_yaddr(scale_dev, (uint32) get_vpp_buf(0));
scale_set_in_uaddr(scale_dev, (uint32) get_vpp_buf(0) + scale3->iw * yuv_buf_line(0));
scale_set_in_vaddr(scale_dev, (uint32) get_vpp_buf(0) + scale3->iw * yuv_buf_line(0) + scale3->iw * yuv_buf_line(0) / 4);
scale_set_out_yaddr(scale_dev, (uint32) scale3->fb->data);
scale_set_out_uaddr(scale_dev, (uint32) scale3->fb->data + ow * oh);
scale_set_out_vaddr(scale_dev, (uint32) scale3->fb->data + ow * oh + ow * oh / 4);
scale_request_irq(scale_dev, FRAME_END, scale3_stream_done, (uint32) scale3);
scale_request_irq(scale_dev, INBUF_OV, scale3_stream_ov, (uint32) scale3);
scale3->ready = 0;
scale_open(scale_dev);
}
scale3_normal_msi_work_end:
if (delay_time)
{
os_run_work_delay(work, delay_time);
}
if (fb)
{
msi_delete_fb(NULL, fb);
fb = NULL;
}
return 0;
}
struct msi *scale3_normal_msi(const char *name, uint16_t ow, uint16_t oh)
{
uint8_t isnew;
struct msi *msi = msi_new(name, 0, &isnew);
if (isnew)
{
struct scale_device *scale_dev = (struct scale_device *) dev_get(HG_SCALE3_DEVID);
struct scale3_normal_msi *scale3 = (struct scale3_normal_msi *) STREAM_LIBC_ZALLOC(sizeof(struct scale3_normal_msi));
scale3->scale_dev = scale_dev;
scale3->ready = 1;
scale3->ow = ow;
scale3->oh = oh;
scale3->msi = msi;
scale3->force_stype = FSTYPE_NONE;
scale3->extern_fb_ready = 1;
scale3->start = 1;
msi->priv = (void *) scale3;
msi->action = const_scale3_msi_action;
msi->enable = 1;
os_msgq_init(&scale3->msgq, MAX_COUNT);
fbpool_init(&scale3->pool, MAX_COUNT);
uint16_t init_count = 0;
uint8_t *m_buff;
struct takephoto_yuv_arg_s *arg;
// 初始化framebuffer节点数量空间?最后由workqueue去从ringbuf去获取一个节点
while (init_count < MAX_COUNT)
{
m_buff = STREAM_MALLOC(ow * oh * 3 / 2);
arg = (struct takephoto_yuv_arg_s *) STREAM_LIBC_ZALLOC(sizeof(struct takephoto_yuv_arg_s));
ASSERT(m_buff);
ASSERT(arg);
sys_dcache_invalid_range((uint32_t *) m_buff, ow * oh * 3 / 2);
FBPOOL_SET_INFO(&scale3->pool, init_count, m_buff, ow * oh * 3 / 2, arg);
init_count++;
}
get_vpp_w_h(&scale3->iw, &scale3->ih);
OS_WORK_INIT(&scale3->work, scale3_normal_msi_work, 0);
os_run_work(&scale3->work);
}
return msi;
}
struct msi *scale3_normal_msi2(const char *name, uint8_t force_stype, uint16_t ow, uint16_t oh)
{
uint8_t isnew;
struct msi *msi = msi_new(name, 0, &isnew);
if (isnew)
{
struct scale_device *scale_dev = (struct scale_device *) dev_get(HG_SCALE3_DEVID);
struct scale3_normal_msi *scale3 = (struct scale3_normal_msi *) STREAM_ZALLOC(sizeof(struct scale3_normal_msi));
scale3->scale_dev = scale_dev;
scale3->ready = 1;
scale3->ow = ow;
scale3->oh = oh;
scale3->msi = msi;
scale3->force_stype = force_stype;
scale3->extern_fb_ready = 1;
scale3->start = 0;
msi->priv = (void *) scale3;
msi->action = const_scale3_msi_action;
msi->enable = 1;
os_msgq_init(&scale3->msgq, MAX_COUNT);
fbpool_init(&scale3->pool, MAX_COUNT);
RB_INIT(&scale3->extern_rb, EXTERN_RB_COUNT);
uint16_t init_count = 0;
uint8_t *m_buff;
struct takephoto_yuv_arg_s *arg;
// 初始化framebuffer节点数量空间?最后由workqueue去从ringbuf去获取一个节点
while (init_count < MAX_COUNT)
{
m_buff = STREAM_MALLOC(ow * oh * 3 / 2);
arg = (struct takephoto_yuv_arg_s *) STREAM_LIBC_ZALLOC(sizeof(struct takephoto_yuv_arg_s));
ASSERT(m_buff);
ASSERT(arg);
sys_dcache_invalid_range((uint32_t *) m_buff, ow * oh * 3 / 2);
FBPOOL_SET_INFO(&scale3->pool, init_count, m_buff, ow * oh * 3 / 2, arg);
init_count++;
}
get_vpp_w_h(&scale3->iw, &scale3->ih);
OS_WORK_INIT(&scale3->work, scale3_normal_msi_work, 0);
os_run_work(&scale3->work);
}
return msi;
}