videomixer: handle HPD

This commit is contained in:
Sebastien Bourdeauducq 2013-09-08 12:54:48 +02:00
parent dba6189e38
commit 52be94f060
1 changed files with 33 additions and 13 deletions

View File

@ -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();
} }