zouhaitao/TAIXIN
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
Files
main
TAIXIN/sdk/driver/osd_enc/hgosd_enc.c

228 lines
6.2 KiB
C
Raw Permalink Blame History

#include "typesdef.h"
#include "errno.h"
#include "osal/irq.h"
#include "devid.h"
#include "dev/osd_enc/hgosd_enc.h"
#include "osal/string.h"
struct hgosdenc_hw
{
__IO uint32 OSD_ENC_CON;
__IO uint32 OSD_ENC_STA;
__IO uint32 OSD_ENC_SADR;
__IO uint32 OSD_ENC_TADR;
__IO uint32 OSD_ENC_RLEN;
__IO uint32 OSD_ENC_DLEN;
__IO uint32 OSD_ENC_IDENT0;
__IO uint32 OSD_ENC_IDENT1;
__IO uint32 OSD_ENC_TRANS0;
__IO uint32 OSD_ENC_TRANS1;
};
static int32 hgosd_ioctl(struct osdenc_device *p_osd, enum osdenc_ioctl_cmd ioctl_cmd, uint32 param1, uint32 param2)
{
int32 ret_val = RET_OK;
struct hgosd *osd_hw = (struct hgosd*)p_osd;
struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
uint32_t *p32;
switch(ioctl_cmd){
case OSD_IOCTL_TRAN_IDENT_TRANS:
p32 = (uint32_t *)param1;
hw->OSD_ENC_IDENT0 = p32[0];
hw->OSD_ENC_IDENT1 = p32[1];
hw->OSD_ENC_TRANS0 = p32[2];
hw->OSD_ENC_TRANS1 = p32[3];
break;
case OSD_IOCTL_ENC_ADR:
hw->OSD_ENC_SADR = param1;
hw->OSD_ENC_TADR = param2;
break;
case OSD_IOCTL_SET_ENC_RLEN:
hw->OSD_ENC_RLEN = ((param1/4 + 1)/2)*2 - 1; //word 偶对齐 -1
break;
case OSD_IOCTL_SET_ENC_FORMAT:
if(param1 == 1){
hw->OSD_ENC_CON &= ~BIT(1); //565
}else{
hw->OSD_ENC_CON |= BIT(1); //888
}
break;
case OSD_IOCTL_GET_ENC_DLEN:
return hw->OSD_ENC_DLEN*4;
break;
case OSD_IOCTL_SET_ENC_RUN:
hw->OSD_ENC_CON |= BIT(0);
break;
default:
os_printf("NO OSD IOCTL:%d\r\n",ioctl_cmd);
ret_val = -ENOTSUPP;
break;
}
return ret_val;
}
osdenc_irq_hdl encirq_vector_table[ENC_IRQ_NUM];
void * encirq_dev_table[ENC_IRQ_NUM];
void irq_osdenc_enable(struct osdenc_device *p_osd,uint8 mode,uint8 irq){
struct hgosd *osd_hw = (struct hgosd*)p_osd;
struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
if(mode){
hw->OSD_ENC_CON |= BIT(irq+2);
}else{
hw->OSD_ENC_CON &= ~BIT(irq+2);
}
}
void OSD_ENC_IRQHandler_action(void *p_osd){
uint32 sta = 0;
uint8 loop;
struct hgosd *osd_hw = (struct hgosd*)p_osd;
struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
sta = hw->OSD_ENC_STA;
for(loop = 0;loop < ENC_IRQ_NUM;loop++){
if(sta&BIT(loop)){
hw->OSD_ENC_STA = BIT(loop);
if(encirq_vector_table[loop] != NULL)
encirq_vector_table[loop] (loop,(uint32)encirq_dev_table[loop],0);
}
}
}
int32 osd_enc_irq_register(struct osdenc_device *p_osd,uint32 irq, osdenc_irq_hdl isr, uint32 dev_id){
struct hgosd *osd_hw = (struct hgosd*)p_osd;
struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
request_irq(osd_hw->irq_num, OSD_ENC_IRQHandler_action, p_osd);
irq_osdenc_enable(p_osd, 1, irq);
encirq_vector_table[irq] = isr;
encirq_dev_table[irq] = (void*)dev_id;
hw->OSD_ENC_STA |= BIT(irq);
os_printf("osdencirq_register:%d %x %x\r\n",irq,(uint32)encirq_vector_table[irq],(uint32)isr);
return 0;
}
int32 osd_enc_irq_unregister(struct osdenc_device *p_osd,uint32 irq){
struct hgosd *osd_hw = (struct hgosd*)p_osd;
struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
irq_osdenc_enable(p_osd, 0, irq);
encirq_vector_table[irq] = NULL;
encirq_dev_table[irq] = 0;
hw->OSD_ENC_STA |= BIT(irq);
return 0;
}
static int32 hgosdenc_open(struct osdenc_device *p_osd){
struct hgosd *osd_hw = (struct hgosd*)p_osd;
//struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
#ifdef FPGA_SUPPORT
SYSCTRL->SYS_CON0 |= BIT(12);
#else
sysctrl_osd_enc_clk_open();
SYSCTRL->SYS_CON7 |= BIT(15);
#endif
irq_enable(osd_hw->irq_num);
return 0;
}
static int32 hgosdenc_close(struct osdenc_device *p_osd){
struct hgosd *osd_hw = (struct hgosd*)p_osd;
//struct hgosdenc_hw *hw = (struct hgosdenc_hw *)osd_hw->hw;
sysctrl_osd_enc_clk_close();
irq_disable(osd_hw->irq_num);
return 0;
}
int32 hgosdenc_suspend(struct dev_obj *obj){
struct hgosd *osd_hw = (struct hgosd*)obj;
struct hgosdenc_hw *hw;
struct hgosdenc_hw *hw_cfg;
//确保已经被打开并且休眠过,直接返回
if(!osd_hw->opened || osd_hw->dsleep)
{
return RET_OK;
}
osd_hw->dsleep = 1;
osd_hw->cfg_backup = (uint32 *)os_malloc(sizeof(struct hgosdenc_hw));
hw_cfg = (struct hgosdenc_hw*)osd_hw->cfg_backup;
hw = (struct hgosdenc_hw*)osd_hw->hw;
hw_cfg->OSD_ENC_CON=hw->OSD_ENC_CON;
hw_cfg->OSD_ENC_STA=hw->OSD_ENC_STA;
hw_cfg->OSD_ENC_SADR=hw->OSD_ENC_SADR;
hw_cfg->OSD_ENC_TADR=hw->OSD_ENC_TADR;
hw_cfg->OSD_ENC_RLEN=hw->OSD_ENC_RLEN;
hw_cfg->OSD_ENC_DLEN=hw->OSD_ENC_DLEN;
hw_cfg->OSD_ENC_IDENT0=hw->OSD_ENC_IDENT0;
hw_cfg->OSD_ENC_IDENT1=hw->OSD_ENC_IDENT1;
hw_cfg->OSD_ENC_TRANS0=hw->OSD_ENC_TRANS0;
hw_cfg->OSD_ENC_TRANS1=hw->OSD_ENC_TRANS1;
irq_disable(osd_hw->irq_num);
return 0;
}
int32 hgosdenc_resume(struct dev_obj *obj){
struct hgosd *osd_hw = (struct hgosd*)obj;
struct hgosdenc_hw *hw;
struct hgosdenc_hw *hw_cfg;
//如果已经被打开并且没有休眠过,直接返回
if(!osd_hw->opened || !osd_hw->dsleep)
{
return RET_OK;
}
osd_hw->dsleep = 0;
hw_cfg = (struct hgosdenc_hw*)osd_hw->cfg_backup;
hw = (struct hgosdenc_hw*)osd_hw->hw;
hw->OSD_ENC_CON=hw_cfg->OSD_ENC_CON;
hw->OSD_ENC_STA=hw_cfg->OSD_ENC_STA;
hw->OSD_ENC_SADR=hw_cfg->OSD_ENC_SADR;
hw->OSD_ENC_TADR=hw_cfg->OSD_ENC_TADR;
hw->OSD_ENC_RLEN=hw_cfg->OSD_ENC_RLEN;
hw->OSD_ENC_DLEN=hw_cfg->OSD_ENC_DLEN;
hw->OSD_ENC_IDENT0=hw_cfg->OSD_ENC_IDENT0;
hw->OSD_ENC_IDENT1=hw_cfg->OSD_ENC_IDENT1;
hw->OSD_ENC_TRANS0=hw_cfg->OSD_ENC_TRANS0;
hw->OSD_ENC_TRANS1=hw_cfg->OSD_ENC_TRANS1;
irq_enable(osd_hw->irq_num);
os_free(osd_hw->cfg_backup);
return 0;
}
static const struct osdenc_hal_ops dev_ops = {
.open = hgosdenc_open,
.close = hgosdenc_close,
.ioctl = hgosd_ioctl,
.request_irq = osd_enc_irq_register,
.release_irq = osd_enc_irq_unregister,
#ifdef CONFIG_SLEEP
.ops.suspend = hgosdenc_suspend,
.ops.resume = hgosdenc_resume,
#endif
};
int32 hgosdenc_attach(uint32 dev_id, struct hgosd *hgosd){
hgosd->opened = 0;
hgosd->use_dma = 0;
hgosd->irq_hdl = NULL;
hgosd->irq_data = 0;
hgosd->dev.dev.ops = (const struct devobj_ops *)&dev_ops;
irq_disable(hgosd->irq_num);
dev_register(dev_id, (struct dev_obj *)hgosd);
return 0;
}
Reference in New Issue View Git Blame Copy Permalink