videomixer: handle HPD
This commit is contained in:
parent
dba6189e38
commit
52be94f060
|
@ -44,6 +44,8 @@ void dvisamplerX_init_video(void)
|
|||
{
|
||||
unsigned int mask;
|
||||
|
||||
dvisamplerX_clocking_pll_reset_write(1);
|
||||
|
||||
dvisamplerX_dma_ev_pending_write(dvisamplerX_dma_ev_pending_read());
|
||||
dvisamplerX_dma_ev_enable_write(0x3);
|
||||
mask = irq_getmask();
|
||||
|
@ -224,11 +226,20 @@ static void dvisamplerX_check_overflow(void)
|
|||
}
|
||||
}
|
||||
|
||||
static int dvisamplerX_connected;
|
||||
static int dvisamplerX_locked;
|
||||
static int dvisamplerX_last_event;
|
||||
|
||||
void dvisamplerX_service(void)
|
||||
{
|
||||
if(dvisamplerX_connected) {
|
||||
if(!dvisamplerX_edid_hpd_notif_read()) {
|
||||
printf("dvisamplerX: disconnected\n");
|
||||
dvisamplerX_connected = 0;
|
||||
dvisamplerX_locked = 0;
|
||||
dvisamplerX_clocking_pll_reset_write(1);
|
||||
dvisamplerX_edid_hpd_en_write(0);
|
||||
} else {
|
||||
if(dvisamplerX_locked) {
|
||||
if(dvisamplerX_clocking_locked_read()) {
|
||||
if(elapsed(&dvisamplerX_last_event, identifier_frequency_read()/2)) {
|
||||
|
@ -247,5 +258,14 @@ void dvisamplerX_service(void)
|
|||
dvisamplerX_locked = 1;
|
||||
}
|
||||
}
|
||||
}
|
||||
} else {
|
||||
if(dvisamplerX_edid_hpd_notif_read()) {
|
||||
printf("dvisamplerX: connected\n");
|
||||
dvisamplerX_connected = 1;
|
||||
dvisamplerX_edid_hpd_en_write(1);
|
||||
dvisamplerX_clocking_pll_reset_write(0);
|
||||
}
|
||||
}
|
||||
dvisamplerX_check_overflow();
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue