void hdmi_in1_isr(void)
{
int fb_index = -1;
int length;
int expected_length;
unsigned int address_min, address_max;
address_min = HDMI_IN1_FRAMEBUFFERS_BASE & 0x0fffffff;
address_max = address_min + HDMI_IN1_FRAMEBUFFERS_SIZE*FRAMEBUFFER_COUNT;
if((hdmi_in1_dma_slot0_status_read() == DVISAMPLER_SLOT_PENDING)
&& ((hdmi_in1_dma_slot0_address_read() < address_min) || (hdmi_in1_dma_slot0_address_read() > address_max)))
printf("dvisampler1: slot0: stray DMA\n");
if((hdmi_in1_dma_slot1_status_read() == DVISAMPLER_SLOT_PENDING)
&& ((hdmi_in1_dma_slot1_address_read() < address_min) || (hdmi_in1_dma_slot1_address_read() > address_max)))
printf("dvisampler1: slot1: stray DMA\n");
if((hdmi_in1_resdetection_hres_read() != hdmi_in1_hres)
|| (hdmi_in1_resdetection_vres_read() != hdmi_in1_vres)) {
/* Dump frames until we get the expected resolution */
if(hdmi_in1_dma_slot0_status_read() == DVISAMPLER_SLOT_PENDING) {
hdmi_in1_dma_slot0_address_write(hdmi_in1_framebuffer_base(hdmi_in1_fb_slot_indexes[0]));
hdmi_in1_dma_slot0_status_write(DVISAMPLER_SLOT_LOADED);
}
if(hdmi_in1_dma_slot1_status_read() == DVISAMPLER_SLOT_PENDING) {
hdmi_in1_dma_slot1_address_write(hdmi_in1_framebuffer_base(hdmi_in1_fb_slot_indexes[1]));
hdmi_in1_dma_slot1_status_write(DVISAMPLER_SLOT_LOADED);
}
return;
}
expected_length = hdmi_in1_hres*hdmi_in1_vres*2;
if(hdmi_in1_dma_slot0_status_read() == DVISAMPLER_SLOT_PENDING) {
length = hdmi_in1_dma_slot0_address_read() - (hdmi_in1_framebuffer_base(hdmi_in1_fb_slot_indexes[0]) & 0x0fffffff);
if(length == expected_length) {
fb_index = hdmi_in1_fb_slot_indexes[0];
hdmi_in1_fb_slot_indexes[0] = hdmi_in1_next_fb_index;
hdmi_in1_next_fb_index = (hdmi_in1_next_fb_index + 1) & FRAMEBUFFER_MASK;
} else
printf("dvisampler1: slot0: unexpected frame length: %d\n", length);
hdmi_in1_dma_slot0_address_write(hdmi_in1_framebuffer_base(hdmi_in1_fb_slot_indexes[0]));
hdmi_in1_dma_slot0_status_write(DVISAMPLER_SLOT_LOADED);
}
if(hdmi_in1_dma_slot1_status_read() == DVISAMPLER_SLOT_PENDING) {
length = hdmi_in1_dma_slot1_address_read() - (hdmi_in1_framebuffer_base(hdmi_in1_fb_slot_indexes[1]) & 0x0fffffff);
if(length == expected_length) {
fb_index = hdmi_in1_fb_slot_indexes[1];
hdmi_in1_fb_slot_indexes[1] = hdmi_in1_next_fb_index;
hdmi_in1_next_fb_index = (hdmi_in1_next_fb_index + 1) & FRAMEBUFFER_MASK;
} else
printf("dvisampler1: slot1: unexpected frame length: %d\n", length);
hdmi_in1_dma_slot1_address_write(hdmi_in1_framebuffer_base(hdmi_in1_fb_slot_indexes[1]));
hdmi_in1_dma_slot1_status_write(DVISAMPLER_SLOT_LOADED);
}
if(fb_index != -1)
hdmi_in1_fb_index = fb_index;
processor_update();
}
void hdmi_in1_init_video(int hres, int vres)
{
unsigned int mask;
hdmi_in1_clocking_pll_reset_write(1);
hdmi_in1_connected = hdmi_in1_locked = 0;
hdmi_in1_hres = hres; hdmi_in1_vres = vres;
hdmi_in1_dma_frame_size_write(hres*vres*2);
hdmi_in1_fb_slot_indexes[0] = 0;
hdmi_in1_dma_slot0_address_write(hdmi_in1_framebuffer_base(0));
hdmi_in1_dma_slot0_status_write(DVISAMPLER_SLOT_LOADED);
hdmi_in1_fb_slot_indexes[1] = 1;
hdmi_in1_dma_slot1_address_write(hdmi_in1_framebuffer_base(1));
hdmi_in1_dma_slot1_status_write(DVISAMPLER_SLOT_LOADED);
hdmi_in1_next_fb_index = 2;
hdmi_in1_dma_ev_pending_write(hdmi_in1_dma_ev_pending_read());
hdmi_in1_dma_ev_enable_write(0x3);
mask = irq_getmask();
mask |= 1 << HDMI_IN1_INTERRUPT;
irq_setmask(mask);
hdmi_in1_fb_index = 3;
}
