228 lines
6.2 KiB
C
228 lines
6.2 KiB
C
|
#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;
|
||
|
|
}
|
||
|
|
|
||
|
|
|