Initial commit: TXW82x FPV v2.7.0.7-42229 SDK + project sources
This commit is contained in:
834
sdk/driver/jpeg/hgjpg_v3.c
Normal file
834
sdk/driver/jpeg/hgjpg_v3.c
Normal file
@@ -0,0 +1,834 @@
|
||||
#include "sys_config.h"
|
||||
#include "tx_platform.h"
|
||||
#include "list.h"
|
||||
#include "dev.h"
|
||||
#include "typesdef.h"
|
||||
#include "lib/video/dvp/cmos_sensor/csi.h"
|
||||
#include "dev/csi/hgdvp.h"
|
||||
#include "devid.h"
|
||||
#include "osal/irq.h"
|
||||
#include "osal/string.h"
|
||||
#include "dev/jpg/hgjpg.h"
|
||||
#include "lib/video/dvp/jpeg/jpg.h"
|
||||
#include "hal/jpeg.h"
|
||||
#include "osal/task.h"
|
||||
#include "osal/sleep.h"
|
||||
|
||||
//调用外部接口
|
||||
void driver_timer_add(int32_t (*func)(void *arg,uint32_t kick_time), void *arg);
|
||||
|
||||
struct hgjpg_hw
|
||||
{
|
||||
__IO uint32 CSR0;
|
||||
__IO uint32 CSR1;
|
||||
__IO uint32 CSR2;
|
||||
__IO uint32 CSR3;
|
||||
__IO uint32 DMA_CON;
|
||||
__IO uint32 DMA_CON1;
|
||||
__IO uint32 DMA_STA;
|
||||
__IO uint32 DMA_TADR0;
|
||||
__IO uint32 DMA_TADR1;
|
||||
__IO uint32 DMA_DLEN;
|
||||
__IO uint32 DMA_DHT_ADR;
|
||||
__IO uint32 DMA_DADR;
|
||||
__IO uint32 DMA_DTO;
|
||||
__IO uint32 DMA_SF_YADR;
|
||||
__IO uint32 DMA_SF_UADR;
|
||||
__IO uint32 DMA_SF_VADR;
|
||||
};
|
||||
|
||||
|
||||
struct hgjpg_table_hw
|
||||
{
|
||||
__IO uint32 DQT[32];
|
||||
};
|
||||
|
||||
struct hgjpg_huff_hw
|
||||
{
|
||||
__IO uint32_t HUFF[192];
|
||||
};
|
||||
|
||||
struct jpg_device *p_jpg_global[JPG_NUM];
|
||||
volatile uint8_t jpg_ready[JPG_NUM];
|
||||
|
||||
|
||||
volatile uint8_t jpg_oe_enable[JPG_NUM];
|
||||
volatile uint8_t jpg_oe_used[JPG_NUM];
|
||||
volatile uint8_t jpg_oe_ok[JPG_NUM];
|
||||
|
||||
extern volatile uint8 isp_ov_err;
|
||||
|
||||
|
||||
jpg_irq_hdl jpgirq_vector_table[JPG_NUM][JPG_IRQ_NUM];
|
||||
void * jpgirq_dev_table[JPG_NUM][JPG_IRQ_NUM];
|
||||
|
||||
void irq_jpg_enable(struct hgjpg_hw *p_jpg,uint8 mode,uint8 irq){
|
||||
if(mode){
|
||||
p_jpg->DMA_CON |= BIT(irq+13);
|
||||
}else{
|
||||
p_jpg->DMA_CON &= ~BIT(irq+13);
|
||||
}
|
||||
}
|
||||
|
||||
extern volatile uint8_t vpp_oe;
|
||||
void JPG_IRQHandler_action(void *p_jpg)
|
||||
{
|
||||
uint32 jpgr = 0;
|
||||
uint32 sta = 0;
|
||||
uint8_t jpg_err = 0;
|
||||
uint8 dec_err = 0;
|
||||
uint32 arg = 0;
|
||||
uint32 arg2 = 0;
|
||||
int8_t loop;
|
||||
struct hgjpg *jpg_hw;// = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw;// = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
jpgr = *(volatile uint32_t*)0x40005200; //fix jpg reg error bug,imp
|
||||
uint8_t src_from;
|
||||
if(p_jpg_global[0]){
|
||||
jpg_hw = (struct hgjpg*)p_jpg_global[0];
|
||||
hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
sta = (hw->DMA_STA & ((hw->DMA_CON >> 13) &0x01f));
|
||||
src_from = (hw->DMA_CON& 0xE0)>>5;
|
||||
for(loop = JPG_IRQ_NUM-1;loop >= 0;loop--) {
|
||||
if(sta&BIT(loop)){
|
||||
if(jpg_hw->opened)
|
||||
{
|
||||
if(loop == DONE_IRQ){
|
||||
//_os_printf("--(%d)",SCHED->BW_STA_CNT);
|
||||
jpg_hw->addr_count = 0;
|
||||
arg = hw->DMA_DLEN;
|
||||
if(jpg_hw->deal_time != ((hw->DMA_STA>>16)&0xff)){
|
||||
arg2 = 1;
|
||||
}
|
||||
jpg_hw->deal_time = 0;
|
||||
}
|
||||
else if(loop == JPG_BUF_ERR){
|
||||
_os_printf(KERN_INFO"hw->DMA_STA0:%x\r\n",hw->DMA_STA);
|
||||
jpg_hw->addr_count = 0;
|
||||
arg = hw->DMA_DLEN;
|
||||
jpg_hw->deal_time = 0;
|
||||
}else if(loop == JPG_OUTBUF_FULL){
|
||||
jpg_hw->deal_time++;
|
||||
}
|
||||
|
||||
if(isp_ov_err && (jpg_hw->decode== 0 && (src_from == 0 || src_from == 1 || src_from == 3))){
|
||||
if(loop == DONE_IRQ){
|
||||
jpgirq_vector_table[0][JPG_BUF_ERR] (loop,(uint32)jpgirq_dev_table[0][JPG_BUF_ERR],arg,arg2);
|
||||
jpg_err = 1;
|
||||
}
|
||||
}
|
||||
|
||||
//如果有错,就不再继续执行其他的中断
|
||||
if(jpg_err==0 && jpgirq_vector_table[0][loop] != NULL)
|
||||
jpgirq_vector_table[0][loop] (loop,(uint32)jpgirq_dev_table[0][loop],arg,arg2);
|
||||
|
||||
if(loop == JPG_BUF_ERR)
|
||||
{
|
||||
jpg_err = 1;
|
||||
}
|
||||
}
|
||||
hw->DMA_STA = BIT(loop);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if(p_jpg_global[1]){
|
||||
jpg_hw = (struct hgjpg*)p_jpg_global[1];
|
||||
hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
sta = (hw->DMA_STA & ((hw->DMA_CON >> 13) &0x1f));
|
||||
src_from = (hw->DMA_CON& 0xE0)>>5;
|
||||
for(loop = JPG_IRQ_NUM-1;loop >= 0;loop--) {
|
||||
if(sta&BIT(loop)){
|
||||
if(jpg_hw->opened || jpg_hw->decode)
|
||||
{
|
||||
if(loop == DONE_IRQ){
|
||||
jpg_hw->addr_count = 0;
|
||||
arg = hw->DMA_DLEN;
|
||||
if(jpg_hw->deal_time != ((hw->DMA_STA>>16)&0xff)){
|
||||
arg2 = 1;
|
||||
}
|
||||
jpg_hw->deal_time = 0;
|
||||
jpg_hw->decode = 0;
|
||||
}
|
||||
else if(loop == JPG_BUF_ERR){
|
||||
_os_printf(KERN_INFO"hw->DMA_STA1:%x\r\n",hw->DMA_STA);
|
||||
jpg_hw->addr_count = 0;
|
||||
arg = hw->DMA_DLEN;
|
||||
jpg_hw->deal_time = 0;
|
||||
jpg_hw->decode = 0;
|
||||
if(hw->DMA_STA & BIT(8)){
|
||||
dec_err = 1;
|
||||
}
|
||||
}else if(loop == JPG_OUTBUF_FULL){
|
||||
jpg_hw->deal_time++;
|
||||
}
|
||||
if(isp_ov_err && (jpg_hw->decode== 0 && (src_from == 0 || src_from == 1 || src_from == 3))){
|
||||
if(loop == DONE_IRQ){
|
||||
jpgirq_vector_table[1][JPG_BUF_ERR] (loop,(uint32)jpgirq_dev_table[1][JPG_BUF_ERR],arg,arg2);
|
||||
jpg_err = 1;
|
||||
}
|
||||
}
|
||||
|
||||
if(jpgirq_vector_table[1][loop] != NULL)
|
||||
jpgirq_vector_table[1][loop] (loop,(uint32)jpgirq_dev_table[1][loop],arg,arg2);
|
||||
|
||||
|
||||
if(dec_err == 1){
|
||||
jpg_hw->decode = 0;
|
||||
hw->DMA_CON |= BIT(12); //复位
|
||||
__NOP();__NOP();__NOP();
|
||||
}
|
||||
}
|
||||
|
||||
hw->DMA_STA = BIT(loop);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/*
|
||||
int32 hgjpg_set_len(struct jpg_device *p_jpg,uint32 buflen,uint32 head_reserver){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
hw->DMA_CON |= ((buflen - head_reserver)<<16);
|
||||
return 0;
|
||||
}
|
||||
*/
|
||||
|
||||
|
||||
void jpg_table_init(struct hgjpg_hw *p_jpg,struct hgjpg_table_hw* p_jpg_dqt,struct hgjpg_huff_hw *p_jpg_huff,uint32 table_index){
|
||||
uint32 itk = 0;
|
||||
uint32 *ptable;
|
||||
ptable = (uint32*)quality_tab[table_index];
|
||||
for(itk = 0;itk <32;itk++){
|
||||
p_jpg_dqt->DQT[itk] = ptable[itk];
|
||||
}
|
||||
#if 0
|
||||
uint16 *huftbl;
|
||||
huftbl = (uint16_t*)htable;
|
||||
for(itk = 0;itk <384;itk=itk+2){
|
||||
p_jpg_huff->HUFF[itk/2] = (uint32)huftbl[itk]|(uint32)huftbl[itk+1]<<12;
|
||||
|
||||
}
|
||||
#endif
|
||||
p_jpg->DMA_DHT_ADR = (uint32)dhtable;
|
||||
}
|
||||
|
||||
static void jpg_huff_init(struct hgjpg* jpg)
|
||||
{
|
||||
struct hgjpg_huff_hw *p_jpg_huff = (struct hgjpg_huff_hw *)jpg->huf_hw;
|
||||
uint32 itk = 0;
|
||||
uint16 *huftbl;
|
||||
huftbl = (uint16_t*)htable;
|
||||
for(itk = 0;itk <384;itk=itk+2)
|
||||
{
|
||||
p_jpg_huff->HUFF[itk/2] = (uint32)huftbl[itk]|(uint32)huftbl[itk+1]<<12;
|
||||
}
|
||||
}
|
||||
|
||||
void jpg_csr_encode_config(struct hgjpg_hw *p_jpg,uint32 image_h,uint32 image_w){
|
||||
p_jpg->CSR1 = (image_h<<16)|BIT(2)|BIT(8);
|
||||
if((image_h%16) != 0)
|
||||
image_h = ((image_h/16)+1)*16;
|
||||
p_jpg->CSR2 = ((image_h * image_w) /256)-1;
|
||||
p_jpg->CSR3 = (image_w<<16)|(image_w/16 - 1);
|
||||
|
||||
}
|
||||
|
||||
int32 hgjpg_open(struct jpg_device *p_jpg){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
uint8 jpg_chose;
|
||||
|
||||
//fix psram read data lock bug
|
||||
//burst enable 0
|
||||
//1ms
|
||||
//burst enable 1
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
//hw->CSR1 = 0;
|
||||
uint32_t jpgr = *(volatile uint32_t*)0x40005200; //fix jpg reg error bug,imp
|
||||
(void)jpgr;
|
||||
}
|
||||
|
||||
//SCHED->BW_STA_CYCLE = 60000000;
|
||||
//SCHED->CTRL_CON |=BIT(1);
|
||||
//open之前先将pending清除(预防之前pengding有残留)
|
||||
hw->DMA_STA = hw->DMA_STA;
|
||||
jpg_hw->decode = 0;
|
||||
jpg_hw->opened = 1;
|
||||
jpg_ready[jpg_chose] = 1;
|
||||
hw->DMA_CON |= BIT(0); //enable jpg
|
||||
hw->DMA_CON1 |= BIT(5);
|
||||
//hw->CSR0 = 1;
|
||||
irq_enable(jpg_hw->irq_num);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
int32_t hgjpg_timer_close(void *arg,uint32_t kick_time)
|
||||
{
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)arg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
int32_t ret = 1;
|
||||
//代表jpg已经完成
|
||||
if(!(hw->DMA_STA&(0x7<<25)))
|
||||
{
|
||||
ret = 0;
|
||||
}
|
||||
|
||||
//超时也要退出
|
||||
if(os_jiffies() - kick_time > 1000)
|
||||
{
|
||||
ret = 0;
|
||||
}
|
||||
|
||||
//关闭jpg
|
||||
if(!ret)
|
||||
{
|
||||
uint8_t jpg_chose = 0;
|
||||
uint32_t flag;
|
||||
flag = disable_irq();
|
||||
hw->DMA_CON &= ~(7<<5);
|
||||
hw->DMA_CON |= (SOFT_DATA <<5);
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
}
|
||||
enable_irq(flag);
|
||||
|
||||
|
||||
flag = disable_irq();
|
||||
hw->DMA_CON &= ~BIT(0); //disable jpg
|
||||
hw->DMA_STA = hw->DMA_STA;
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
hw->CSR1 = 0;
|
||||
uint32_t jpgr = *(volatile uint32_t*)0x40005200; //fix jpg reg error bug,imp
|
||||
(void)jpgr;
|
||||
}
|
||||
jpg_ready[jpg_chose] = 0;
|
||||
enable_irq(flag);
|
||||
jpg_hw->opened = 0;
|
||||
jpg_hw->decode = 0;
|
||||
jpg_hw->addr_count = 0;
|
||||
jpg_hw->jpg_run = 0;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
int32 hgjpg_close(struct jpg_device *p_jpg){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
uint8_t jpg_chose = 0;
|
||||
uint32_t flag;
|
||||
uint32_t in_disable_irq(void);
|
||||
if(!(__in_interrupt() || in_disable_irq()))
|
||||
{
|
||||
//在线程,jpg的close启动timer去操作
|
||||
driver_timer_add(hgjpg_timer_close,(void*)jpg_hw);
|
||||
}
|
||||
//在中断,则直接去关闭
|
||||
else
|
||||
{
|
||||
hw->DMA_CON &= ~(7<<5);
|
||||
hw->DMA_CON |= (SOFT_DATA <<5);
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
}
|
||||
|
||||
flag = disable_irq();
|
||||
hw->DMA_CON &= ~BIT(0); //disable jpg
|
||||
hw->DMA_STA = hw->DMA_STA;
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
//hw->CSR1 = 0;
|
||||
uint32_t jpgr = *(volatile uint32_t*)0x40005200; //fix jpg reg error bug,imp
|
||||
(void)jpgr;
|
||||
}
|
||||
jpg_ready[jpg_chose] = 0;
|
||||
enable_irq(flag);
|
||||
jpg_hw->opened = 0;
|
||||
jpg_hw->decode = 0;
|
||||
jpg_hw->addr_count = 0;
|
||||
jpg_hw->jpg_run = 0;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int32 hgjpg_suspend(struct dev_obj *obj){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)obj;
|
||||
struct hgjpg_hw *hw;
|
||||
struct hgjpg_hw *hw_cfg;
|
||||
jpg_hw->cfg_backup = (uint32 *)os_malloc(sizeof(struct hgjpg_hw));
|
||||
//memcpy((uint8 *)p_jpg->cfg_backup,(uint8 *)jpg_hw->hw,sizeof(struct hgjpg_hw));
|
||||
hw_cfg = (struct hgjpg_hw*)jpg_hw->cfg_backup;
|
||||
hw = (struct hgjpg_hw*)jpg_hw->hw;
|
||||
hw_cfg->CSR0 = hw->CSR0;
|
||||
hw_cfg->CSR1 = hw->CSR1;
|
||||
hw_cfg->CSR2 = hw->CSR2;
|
||||
hw_cfg->CSR3 = hw->CSR3;
|
||||
hw_cfg->DMA_CON1= hw->DMA_CON1;
|
||||
hw_cfg->DMA_STA = hw->DMA_STA;
|
||||
hw_cfg->DMA_DHT_ADR = hw->DMA_DHT_ADR;
|
||||
hw_cfg->DMA_DADR= hw->DMA_DADR;
|
||||
hw_cfg->DMA_DTO = hw->DMA_DTO;
|
||||
hw_cfg->DMA_SF_YADR = hw->DMA_SF_YADR;
|
||||
hw_cfg->DMA_SF_UADR = hw->DMA_SF_UADR;
|
||||
hw_cfg->DMA_SF_VADR = hw->DMA_SF_VADR;
|
||||
hw_cfg->DMA_TADR0 = hw->DMA_TADR0;
|
||||
hw_cfg->DMA_TADR1 = hw->DMA_TADR1;
|
||||
hw_cfg->DMA_DLEN = hw->DMA_DLEN;
|
||||
hw_cfg->DMA_CON = hw->DMA_CON;
|
||||
irq_disable(jpg_hw->irq_num);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
int32 hgjpg_resume(struct dev_obj *obj){
|
||||
uint32 jpgr = 0;
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)obj;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
struct hgjpg_hw *hw_cfg;
|
||||
struct hgjpg_table_hw *thw = (struct hgjpg_table_hw *)jpg_hw->thw;
|
||||
struct hgjpg_huff_hw *hufhw = (struct hgjpg_huff_hw *)jpg_hw->huf_hw;
|
||||
//memcpy((uint8 *)jpg_hw->hw,(uint8 *)p_jpg->cfg_backup,sizeof(struct hgjpg_hw));
|
||||
|
||||
|
||||
// SCHED->BW_STA_CYCLE = SYS_CLK;
|
||||
SYSCTRL->CPU1_CON1 &= ~BIT(17);
|
||||
// SCHED->CTRL_CON |=BIT(1);
|
||||
SYSCTRL->SYS_CON8 |= BIT(8); //960M enable
|
||||
SYSCTRL->SYS_CON14 &= ~(7<<29);
|
||||
SYSCTRL->SYS_CON14 |= (6<<29); //mjpeg_pll2x_divnp5 div 3
|
||||
SYSCTRL->SYS_CON14 |= BIT(28); //mjpeg_pll2x_divnp5 en
|
||||
SYSCTRL->CLK_CON6 &= ~(3<<30);
|
||||
SYSCTRL->CLK_CON6 |= (1<<30); //select mjpeg_pll2x_divnp5
|
||||
SYSCTRL->CLK_CON6 &= (~(7<<0)); //mjpeg 1div
|
||||
SYSCTRL->CPU1_CON0 |= BIT(0);
|
||||
SYSCTRL->CLK_CON3 |= BIT(14); //mjpg0 clk en
|
||||
SYSCTRL->CLK_CON4 |= BIT(0); //mjpg1 clk en
|
||||
SYSCTRL->SYS_CON7 &= ~BIT(10);
|
||||
SYSCTRL->SYS_CON7 |= BIT(10); //JPG0
|
||||
SYSCTRL->SYS_CON7 &= ~BIT(20);
|
||||
SYSCTRL->SYS_CON7 |= BIT(20); //JPG1
|
||||
jpgr = *(volatile uint32_t*)0x40005200; //fix jpg reg error bug,imp
|
||||
|
||||
|
||||
hw_cfg = (struct hgjpg_hw*)jpg_hw->cfg_backup;
|
||||
jpg_table_init(hw,thw,hufhw,0x01);
|
||||
hw->CSR0 = hw_cfg->CSR0;
|
||||
hw->CSR1 = hw_cfg->CSR1;
|
||||
hw->CSR2 = hw_cfg->CSR2;
|
||||
hw->CSR3 = hw_cfg->CSR3;
|
||||
hw->DMA_CON1= hw_cfg->DMA_CON1;
|
||||
hw->DMA_STA = hw_cfg->DMA_STA;
|
||||
hw->DMA_DHT_ADR = hw_cfg->DMA_DHT_ADR;
|
||||
hw->DMA_DADR= hw_cfg->DMA_DADR;
|
||||
hw->DMA_DTO = hw_cfg->DMA_DTO;
|
||||
hw->DMA_SF_YADR = hw_cfg->DMA_SF_YADR;
|
||||
hw->DMA_SF_UADR = hw_cfg->DMA_SF_UADR;
|
||||
hw->DMA_SF_VADR = hw_cfg->DMA_SF_VADR;
|
||||
hw->DMA_TADR0 = hw_cfg->DMA_TADR0;
|
||||
hw->DMA_TADR1 = hw_cfg->DMA_TADR1;
|
||||
hw->DMA_DLEN = hw_cfg->DMA_DLEN;
|
||||
hw->DMA_CON = hw_cfg->DMA_CON;
|
||||
jpgr = *(volatile uint32_t*)0x40005200;
|
||||
irq_enable(jpg_hw->irq_num);
|
||||
os_free(jpg_hw->cfg_backup);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
int32 hgjpg_init(struct jpg_device *p_jpg,uint32 table_index,uint32 qt){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
struct hgjpg_table_hw *thw = (struct hgjpg_table_hw *)jpg_hw->thw;
|
||||
struct hgjpg_huff_hw *hufhw = (struct hgjpg_huff_hw *)jpg_hw->huf_hw;
|
||||
hw->DMA_CON |= BIT(12); //复位
|
||||
__NOP();__NOP();__NOP();
|
||||
SYSCTRL->CLK_CON3 |= BIT(14);
|
||||
SYSCTRL->SYS_CON0 |= BIT(2); //
|
||||
jpg_table_init(hw,thw,hufhw,table_index);
|
||||
hw->DMA_CON = (qt<<1);
|
||||
jpg_hw->addr_count = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
int32 hgjpg_set_addr(struct jpg_device *p_jpg,uint32 param,uint32 buflen){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
uint8 jpg_chose;
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
}
|
||||
|
||||
if(jpg_hw->jpg_run == 0){
|
||||
//printf("#################hw:%X\n",hw);
|
||||
//os_printf("jpg_hw->addr_count:%d\n",jpg_hw->addr_count);
|
||||
//os_printf("jpg_ready[jpg_chose]:%d\t%d\n",jpg_ready[jpg_chose],jpg_chose);
|
||||
//os_printf("jpg_chose:%d\n",jpg_chose);
|
||||
jpg_hw->jpg_run = 1;
|
||||
jpg_hw->set_buf_len = 1;
|
||||
|
||||
}
|
||||
if(jpg_hw->addr_count%2){
|
||||
hw->DMA_TADR1 = param;
|
||||
}else{
|
||||
if(jpg_ready[jpg_chose]){
|
||||
|
||||
hw->DMA_TADR0 = param;
|
||||
//hw->DMA_CON1 &= ~BIT(5);
|
||||
hw->DMA_CON1 |= BIT(5);
|
||||
jpg_ready[jpg_chose] = 0;
|
||||
}else{
|
||||
hw->DMA_TADR0 = param;
|
||||
}
|
||||
}
|
||||
if(jpg_hw->set_buf_len){
|
||||
hw->DMA_CON |= ((buflen/4-1)<<20);
|
||||
jpg_hw->set_buf_len = 0;
|
||||
}
|
||||
jpg_hw->addr_count++;
|
||||
return 0;
|
||||
}
|
||||
|
||||
//decode to scaler
|
||||
int32 hgjpg_decode(struct jpg_device *p_jpg,uint32 photo,uint32_t len){
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
if(hw->DMA_CON & BIT(0)){
|
||||
hw->DMA_CON &= ~BIT(0);
|
||||
}
|
||||
hw->DMA_CON &= ~(7<<5);
|
||||
hw->DMA_CON |= BIT(12); //复位
|
||||
__NOP();__NOP();__NOP();
|
||||
//hw->DMA_CON &= ~BIT(12);
|
||||
hw->CSR1 = BIT(3)|BIT(8);
|
||||
hw->DMA_DADR = photo;
|
||||
jpg_hw->decode = 1;
|
||||
|
||||
if (len % 4) {
|
||||
len = len + 4;
|
||||
}
|
||||
|
||||
//寄存器检查仅仅支持1M以下
|
||||
if(len != 0 && len < 0x100000){
|
||||
hw->DMA_DLEN = len; //需要word对齐
|
||||
hw->DMA_CON1 |= BIT(1);
|
||||
}
|
||||
else
|
||||
{
|
||||
hw->DMA_CON1 &= ~BIT(1);
|
||||
}
|
||||
hw->DMA_CON &= ~(0xf<<1);
|
||||
hw->DMA_CON |= BIT(4);
|
||||
hw->DMA_CON |= BIT(0);
|
||||
irq_enable(jpg_hw->irq_num);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int32 hgjpg_ioctl(struct jpg_device *p_jpg,uint32 cmd,uint32 param1,uint32 param2){
|
||||
int32 ret_val = RET_OK;
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
struct hgjpg_table_hw *thw = (struct hgjpg_table_hw *)jpg_hw->thw;
|
||||
uint8 jpg_chose;
|
||||
uint32* dqt;
|
||||
uint32 itk;
|
||||
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
}
|
||||
|
||||
|
||||
switch(cmd){
|
||||
case JPG_IOCTL_CMD_IS_ONLINE:
|
||||
return jpg_hw->opened;
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_ADR:
|
||||
hgjpg_set_addr(p_jpg,param1,param2);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_QT:
|
||||
hw->DMA_CON &= ~(0xf<<1);
|
||||
hw->DMA_CON |= (param1<<1);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_SIZE:
|
||||
jpg_csr_encode_config(hw,param1,param2);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_UPDATE_QT:
|
||||
dqt = (uint32*)param1;
|
||||
for(itk = 0;itk <32;itk++){
|
||||
thw->DQT[itk] = dqt[itk];
|
||||
}
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_DECODE_TAG:
|
||||
if(param1){
|
||||
hw->DMA_CON |= BIT(8);
|
||||
}else{
|
||||
hw->DMA_CON &= ~BIT(8);
|
||||
}
|
||||
break;
|
||||
/*
|
||||
case JPG_IOCTL_CMD_OPEN_DBG:
|
||||
if(param1){
|
||||
hw->DMA_CON |= BIT(10);
|
||||
}else{
|
||||
hw->DMA_CON &= ~BIT(10);
|
||||
}
|
||||
break;
|
||||
*/
|
||||
case JPG_IOCTL_CMD_SOFT_FRAME_START:
|
||||
hw->DMA_CON |= BIT(10);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SOFT_KICK:
|
||||
hw->DMA_CON |= BIT(9);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_SRC_FROM:
|
||||
hw->DMA_CON &= ~(7<<5);
|
||||
hw->DMA_CON |= (param1 <<5);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_HW_CHK:
|
||||
if(param1){
|
||||
hw->DMA_CON |= BIT(11);
|
||||
}else{
|
||||
hw->DMA_CON &= ~BIT(11);
|
||||
}
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_IS_IDLE:
|
||||
if(hw->DMA_STA&(0x7<<25)){
|
||||
ret_val = 0;
|
||||
}else{
|
||||
ret_val = 1;
|
||||
}
|
||||
break;
|
||||
case JPG_IOCTL_CMD_BUFF_INIT:
|
||||
if(param1 == 1){
|
||||
hw->DMA_CON1 |= BIT(5);
|
||||
}else{
|
||||
hw->DMA_CON1 &= ~BIT(5);
|
||||
}
|
||||
break;
|
||||
case JPG_IOCTL_CMD_VSYNC_DLY:
|
||||
if(param1 == 1){
|
||||
hw->DMA_CON1 |= BIT(4);
|
||||
}else{
|
||||
hw->DMA_CON1 &= ~BIT(4);
|
||||
}
|
||||
break;
|
||||
case JPG_IOCTL_CMD_SET_SOFT_Y:
|
||||
hw->DMA_SF_YADR = param1;
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_SOFT_UV:
|
||||
hw->DMA_SF_UADR = param1;
|
||||
hw->DMA_SF_VADR = param2;
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_TIMEOUT_CNT:
|
||||
hw->DMA_DTO = param1;
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_TIMEOUT_EN:
|
||||
hw->DMA_CON1 |= BIT(3);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_DECAUTO_RUN_EN:
|
||||
hw->DMA_CON1 |= BIT(2);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_DEC_LEN_CFG_EN:
|
||||
//SET this bit ,may set the dlen len reg, otherwise while auto dec until finish or timeout err happen
|
||||
if(param1){
|
||||
hw->DMA_CON1 |= BIT(1);
|
||||
}else{
|
||||
hw->DMA_CON1 &= ~BIT(1);
|
||||
}
|
||||
break;
|
||||
case JPG_IOCTL_CMD_DEC_FLUSH_EN:
|
||||
//set this bit,dec while run ,but not set data to memory,just check dec right or false
|
||||
if(param1){
|
||||
hw->DMA_CON1 |= BIT(0);
|
||||
}else{
|
||||
hw->DMA_CON1 &= ~BIT(0);
|
||||
}
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_CODEC_RESET:
|
||||
hw->DMA_CON |= BIT(12);
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_DLEN:
|
||||
hw->DMA_DLEN = param1;
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_READY:
|
||||
jpg_ready[jpg_chose] = 1;
|
||||
break;
|
||||
|
||||
case JPG_IOCTL_CMD_SET_OE_SELECT:
|
||||
if(param1 == 1){
|
||||
jpg_oe_enable[jpg_chose] = 1;
|
||||
jpg_oe_used[jpg_chose] = param2;
|
||||
}else{
|
||||
jpg_oe_enable[jpg_chose] = 0;
|
||||
}
|
||||
break;
|
||||
case JPG_IOCTL_CMD_SET_OE:
|
||||
jpg_oe_ok[jpg_chose] = param1;
|
||||
break;
|
||||
case JPG_IOCTL_CMD_GET_OE:
|
||||
if(jpg_oe_enable[jpg_chose] == 1){
|
||||
if(jpg_oe_ok[jpg_chose] == jpg_oe_used[jpg_chose]){
|
||||
ret_val = 1;
|
||||
}else{
|
||||
ret_val = 0;
|
||||
}
|
||||
}else{
|
||||
ret_val = 1;
|
||||
}
|
||||
|
||||
break;
|
||||
default:
|
||||
ret_val = -ENOTSUPP;
|
||||
break;
|
||||
}
|
||||
return ret_val;
|
||||
}
|
||||
|
||||
|
||||
int32 jpgirq_register(struct jpg_device *p_jpg, jpg_irq_hdl isr,uint32 irq_flag, uint32 irq_data)
|
||||
{
|
||||
uint8 jpg_chose;
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
uint32 irq_num = 0;
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
}
|
||||
p_jpg_global[jpg_chose] = p_jpg;
|
||||
request_irq(MJPEG01_IRQn, JPG_IRQHandler_action, NULL);
|
||||
if(irq_flag == JPG_IRQ_FLAG_JPG_DONE ){
|
||||
irq_num = DONE_IRQ;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_JPG_BUF_FULL ){
|
||||
irq_num = JPG_OUTBUF_FULL;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_ERROR ){
|
||||
irq_num = JPG_BUF_ERR;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_PIXEL_DONE ){
|
||||
irq_num = JPG_PIXEL_DONE;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_TIME_OUT){
|
||||
irq_num = JPG_TIME_OUT;
|
||||
}
|
||||
irq_jpg_enable(hw, 1, irq_num);
|
||||
|
||||
jpgirq_vector_table[jpg_chose][irq_num] = isr;
|
||||
jpgirq_dev_table[jpg_chose][irq_num] = (void *)irq_data;
|
||||
hw->DMA_STA |= BIT(irq_num);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int32 jpgirq_unregister(struct jpg_device *p_jpg,uint32 irq_flag){
|
||||
uint8 jpg_chose;
|
||||
struct hgjpg *jpg_hw = (struct hgjpg*)p_jpg;
|
||||
struct hgjpg_hw *hw = (struct hgjpg_hw *)jpg_hw->hw;
|
||||
uint32 irq_num = 0;
|
||||
if(hw == (void *)MJPEG0_BASE){
|
||||
jpg_chose = 0;
|
||||
}
|
||||
|
||||
if(hw == (void *)MJPEG1_BASE){
|
||||
jpg_chose = 1;
|
||||
}
|
||||
|
||||
if(irq_flag == JPG_IRQ_FLAG_JPG_DONE ){
|
||||
irq_num = DONE_IRQ;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_JPG_BUF_FULL ){
|
||||
irq_num = JPG_OUTBUF_FULL;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_ERROR ){
|
||||
irq_num = JPG_BUF_ERR;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_PIXEL_DONE ){
|
||||
irq_num = JPG_PIXEL_DONE;
|
||||
}else if(irq_flag == JPG_IRQ_FLAG_TIME_OUT){
|
||||
irq_num = JPG_TIME_OUT;
|
||||
}
|
||||
|
||||
irq_jpg_enable(hw, 0, irq_num);
|
||||
jpgirq_vector_table[jpg_chose][irq_num] = NULL;
|
||||
jpgirq_dev_table[jpg_chose][irq_num] = NULL;
|
||||
hw->DMA_STA |= BIT(irq_num);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct jpeg_hal_ops jpeg_ops = {
|
||||
.open = hgjpg_open,
|
||||
.close = hgjpg_close,
|
||||
.init = hgjpg_init,
|
||||
.decode = hgjpg_decode,
|
||||
.ioctl = hgjpg_ioctl,
|
||||
.request_irq = jpgirq_register,
|
||||
.release_irq = jpgirq_unregister,
|
||||
#ifdef CONFIG_SLEEP
|
||||
.ops.suspend = hgjpg_suspend,
|
||||
.ops.resume = hgjpg_resume,
|
||||
#endif
|
||||
};
|
||||
|
||||
|
||||
|
||||
void hgjpg_attach(uint32 dev_id, struct hgjpg *jpg)
|
||||
{
|
||||
jpg->dev.dev.ops = (const struct devobj_ops *)&jpeg_ops;
|
||||
irq_disable(jpg->irq_num);
|
||||
dev_register(dev_id, (struct dev_obj *)jpg);
|
||||
jpg_huff_init(jpg);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user