Hardware
/
litex
mirror of https://github.com/enjoy-digital/litex.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

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
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

46
software/videomixer/dvisamplerX.c
View File

@ -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,27 +226,45 @@ 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_locked) {
if(dvisamplerX_clocking_locked_read()) {
if(elapsed(&dvisamplerX_last_event, identifier_frequency_read()/2)) {
dvisamplerX_adjust_phase();
dvisamplerX_print_status();
}
} else {
printf("dvisamplerX: lost PLL lock\n");
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)) {
dvisamplerX_adjust_phase();
dvisamplerX_print_status();
}
} else {
printf("dvisamplerX: lost PLL lock\n");
dvisamplerX_locked = 0;
}
} else {
if(dvisamplerX_clocking_locked_read()) {
printf("dvisamplerX: PLL locked\n");
dvisamplerX_phase_startup();
dvisamplerX_print_status();
dvisamplerX_locked = 1;
}
}
}
} else {
if(dvisamplerX_clocking_locked_read()) {
printf("dvisamplerX: PLL locked\n");
dvisamplerX_phase_startup();
dvisamplerX_print_status();
dvisamplerX_locked = 1;
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();