salfter/vgaedidinjector
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

EEPROM write and load works

Browse Source
This commit is contained in:
Wolfgang Draxinger
2013-12-23 17:53:49 +01:00
parent 61bc6f183b
commit 9a140a4a77
1 changed files with 59 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

63
edid_injector.c
View File

@@ -216,17 +216,71 @@ uint8_t edid_readFromDisplay(void)
uint8_t edid_readFromEEPROM(void)
{
EEPROM_WaitForNVM(),
uint8_t eepromedid[EDID_BLOCK_LENGTH];
memset(eepromedid, 0, sizeof(EDID_BLOCK_LENGTH));
EEPROM_WaitForNVM();
EEPROM_FlushBuffer();
EEPROM_DisableMapping();
for(uint8_t i_page = 0;
i_page < EDID_BLOCK_LENGTH / EEPROM_PAGE_SIZE;
i_page++ ) {
for(uint8_t i_b = 0; i_b < EEPROM_PAGE_SIZE; i_b++) {
eepromedid[i_page * EEPROM_PAGE_SIZE + i_b] =
EEPROM_ReadByte(i_page, i_b);
}
}
if( edid_checkData(eepromedid) ) {
/* EDID data read from EEPROM didn't pass sanity checks */
// memset(edid_data, 0, EDID_BLOCK_LENGTH);
return 1;
}
memcpy(edid_data, eepromedid, EDID_BLOCK_LENGTH);
return 0;
}
void edid_writeToEEPROM(void)
{
uint8_t pagebuf[EEPROM_PAGE_SIZE];
EEPROM_WaitForNVM();
EEPROM_FlushBuffer();
EEPROM_DisableMapping();
for(uint8_t i_page = 0;
i_page < EDID_BLOCK_LENGTH / EEPROM_PAGE_SIZE;
i_page++ ) {
for(uint8_t i_b = 0; i_b < EEPROM_PAGE_SIZE; i_b++) {
pagebuf[i_b] = EEPROM_ReadByte(i_page, i_b);
}
if( 0 == memcmp(pagebuf,
edid_data + i_page*EEPROM_PAGE_SIZE,
EEPROM_PAGE_SIZE )
) {
/* page unaltered skip writing it */
continue;
}
memcpy( pagebuf,
edid_data + i_page*EEPROM_PAGE_SIZE,
sizeof(pagebuf) );
EEPROM_LoadPage( pagebuf );
EEPROM_AtomicWritePage(i_page);
EEPROM_WaitForNVM();
}
}
int main(void)
{
memset(edid_data, 0, sizeof(edid_data));
edid_readFromEEPROM();
edid_initHostTWI();
edid_initDisplayTWI();
@@ -239,16 +293,17 @@ int main(void)
delay_ms(20);
#if 1
/* EDID standard requires a host to wait for 20ms after switching +5V
* supply to display before performing the first readout attempt.
* Since uC supply == display +5V supply we're waiting 20ms here.
*/
for(;;) {
edid_readFromDisplay();
if( 0 == edid_readFromDisplay() ) {
edid_writeToEEPROM();
edid_readFromEEPROM();
}
delay_ms(1000);
}
#endif
return 0;
}