mirror of https://github.com/marqs85/ossc.git
84 lines
1.9 KiB
C
84 lines
1.9 KiB
C
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include "system.h"
|
|
#include "i2c_opencores.h"
|
|
#include "it6613.h"
|
|
|
|
volatile alt_u8 cur_bank;
|
|
|
|
inline void select_bank_it(alt_u8 bank) {
|
|
cur_bank = bank;
|
|
I2C_start(I2CA_BASE, IT_BASE, 0);
|
|
I2C_write(I2CA_BASE, IT_CURBANK, 0);
|
|
I2C_write(I2CA_BASE, cur_bank, 1);
|
|
}
|
|
|
|
inline alt_u32 read_it(alt_u32 regaddr) {
|
|
if ((regaddr > 0xFF) && (cur_bank == 0))
|
|
select_bank_it(1);
|
|
else if ((regaddr <= 0xFF) && (cur_bank == 1))
|
|
select_bank_it(0);
|
|
|
|
I2C_start(I2CA_BASE, IT_BASE, 0);
|
|
I2C_write(I2CA_BASE, (regaddr & 0xFF), 1);
|
|
I2C_start(I2CA_BASE, IT_BASE, 1);
|
|
return I2C_read(I2CA_BASE,1);
|
|
}
|
|
|
|
inline void write_it(alt_u32 regaddr, alt_u8 data) {
|
|
if ((regaddr > 0xFF) && (cur_bank == 0))
|
|
select_bank_it(1);
|
|
else if ((regaddr <= 0xFF) && (cur_bank == 1))
|
|
select_bank_it(0);
|
|
|
|
I2C_start(I2CA_BASE, IT_BASE, 0);
|
|
I2C_write(I2CA_BASE, (regaddr & 0xFF), 0);
|
|
I2C_write(I2CA_BASE, data, 1);
|
|
}
|
|
|
|
/*inline void reset_it() {
|
|
usleep(100000);
|
|
IOWR_ALTERA_AVALON_PIO_DATA(PIO_0_BASE, 0x00);
|
|
usleep(100000);
|
|
IOWR_ALTERA_AVALON_PIO_DATA(PIO_0_BASE, 0x01);
|
|
usleep(100000);
|
|
}*/
|
|
|
|
int init_it() {
|
|
alt_u32 vendor_id, device_id;
|
|
alt_u32 i;
|
|
|
|
cur_bank = 0;
|
|
select_bank_it(cur_bank);
|
|
|
|
vendor_id = read_it(IT_VENDORID);
|
|
device_id = read_it(IT_DEVICEID);
|
|
|
|
printf("VEN: 0x%.2X, DEV: 0x%.2X\n", vendor_id, device_id);
|
|
|
|
if (!((vendor_id == IT6613_VENDORID) && (device_id == IT6613_DEVICEID)))
|
|
return -1;
|
|
|
|
write_it(REG_TX_SW_RST,B_REF_RST|B_VID_RST|B_AUD_RST|B_AREF_RST|B_HDCP_RST) ;
|
|
usleep(1000);
|
|
write_it(REG_TX_SW_RST,B_VID_RST|B_AUD_RST|B_AREF_RST|B_HDCP_RST) ;
|
|
|
|
write_it(IT_DRIVECTRL, 0x10);
|
|
|
|
write_it(IT_HDMIMODE, 0);
|
|
for (i=0xC1; i<=0xD0; i++)
|
|
write_it(i, 0);
|
|
|
|
write_it(IT_OUTCOLOR, 0);
|
|
|
|
// enable video
|
|
//HDMITX_WriteI2C_Byte(REG_TX_SW_RST,B_VID_RST|B_AUD_RST|B_AREF_RST|B_HDCP_RST) ;
|
|
|
|
write_it(REG_TX_SW_RST, B_AUD_RST|B_AREF_RST|B_HDCP_RST) ;
|
|
usleep(1000);
|
|
|
|
|
|
|
|
return 0;
|
|
}
|