mirror of https://github.com/marqs85/ossc.git
94 lines
1.8 KiB
C
94 lines
1.8 KiB
C
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include "system.h"
|
|
#include "i2c_opencores.h"
|
|
#include "hdmitx.h"
|
|
#include "it6613.h"
|
|
|
|
inline alt_u32 read_it2(alt_u32 regaddr)
|
|
{
|
|
I2C_start(I2CA_BASE, IT_BASE, 0);
|
|
I2C_write(I2CA_BASE, regaddr, 0);
|
|
I2C_start(I2CA_BASE, IT_BASE, 1);
|
|
return I2C_read(I2CA_BASE,1);
|
|
}
|
|
|
|
inline void write_it2(alt_u32 regaddr, alt_u8 data)
|
|
{
|
|
I2C_start(I2CA_BASE, IT_BASE, 0);
|
|
I2C_write(I2CA_BASE, regaddr, 0);
|
|
I2C_write(I2CA_BASE, data, 1);
|
|
}
|
|
|
|
BYTE I2C_Read_Byte(BYTE Addr,BYTE RegAddr)
|
|
{
|
|
I2C_start(I2CA_BASE, Addr, 0);
|
|
I2C_write(I2CA_BASE, RegAddr, 0);
|
|
I2C_start(I2CA_BASE, Addr, 1);
|
|
return I2C_read(I2CA_BASE,1);
|
|
}
|
|
|
|
SYS_STATUS I2C_Write_Byte(BYTE Addr,BYTE RegAddr,BYTE Data)
|
|
{
|
|
I2C_start(I2CA_BASE, Addr, 0);
|
|
I2C_write(I2CA_BASE, RegAddr, 0);
|
|
I2C_write(I2CA_BASE, Data, 1);
|
|
return 0;
|
|
}
|
|
|
|
SYS_STATUS I2C_Read_ByteN(BYTE Addr,BYTE RegAddr,BYTE *pData,int N)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<N; i++)
|
|
pData[i] = I2C_Read_Byte(Addr, RegAddr+i);
|
|
|
|
return 0;
|
|
}
|
|
|
|
SYS_STATUS I2C_Write_ByteN(BYTE Addr,BYTE RegAddr,BYTE *pData,int N)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<N; i++)
|
|
I2C_Write_Byte(Addr, RegAddr+i, pData[i]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
BYTE HDMITX_ReadI2C_Byte(BYTE RegAddr)
|
|
{
|
|
return read_it2(RegAddr);
|
|
}
|
|
|
|
SYS_STATUS HDMITX_WriteI2C_Byte(BYTE RegAddr,BYTE val)
|
|
{
|
|
write_it2(RegAddr, val);
|
|
return 0;
|
|
}
|
|
|
|
SYS_STATUS HDMITX_ReadI2C_ByteN(BYTE RegAddr,BYTE *pData,int N)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<N; i++)
|
|
pData[i] = HDMITX_ReadI2C_Byte(RegAddr+i);
|
|
|
|
return 0;
|
|
}
|
|
|
|
SYS_STATUS HDMITX_WriteI2C_ByteN(BYTE RegAddr,BYTE *pData,int N)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<N; i++)
|
|
HDMITX_WriteI2C_Byte(RegAddr+i, pData[i]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void DelayMS(unsigned int ms)
|
|
{
|
|
usleep(1000*ms);
|
|
}
|