videomixer: handle HPD
This commit is contained in:
parent
dba6189e38
commit
52be94f060
|
@ -44,6 +44,8 @@ void dvisamplerX_init_video(void)
|
||||||
{
|
{
|
||||||
unsigned int mask;
|
unsigned int mask;
|
||||||
|
|
||||||
|
dvisamplerX_clocking_pll_reset_write(1);
|
||||||
|
|
||||||
dvisamplerX_dma_ev_pending_write(dvisamplerX_dma_ev_pending_read());
|
dvisamplerX_dma_ev_pending_write(dvisamplerX_dma_ev_pending_read());
|
||||||
dvisamplerX_dma_ev_enable_write(0x3);
|
dvisamplerX_dma_ev_enable_write(0x3);
|
||||||
mask = irq_getmask();
|
mask = irq_getmask();
|
||||||
|
@ -224,11 +226,20 @@ static void dvisamplerX_check_overflow(void)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int dvisamplerX_connected;
|
||||||
static int dvisamplerX_locked;
|
static int dvisamplerX_locked;
|
||||||
static int dvisamplerX_last_event;
|
static int dvisamplerX_last_event;
|
||||||
|
|
||||||
void dvisamplerX_service(void)
|
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_locked) {
|
||||||
if(dvisamplerX_clocking_locked_read()) {
|
if(dvisamplerX_clocking_locked_read()) {
|
||||||
if(elapsed(&dvisamplerX_last_event, identifier_frequency_read()/2)) {
|
if(elapsed(&dvisamplerX_last_event, identifier_frequency_read()/2)) {
|
||||||
|
@ -247,5 +258,14 @@ void dvisamplerX_service(void)
|
||||||
dvisamplerX_locked = 1;
|
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();
|
dvisamplerX_check_overflow();
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue