int I2C_senddata(unsigned char id, unsigned char addr,unsigned char value)
{
I2C_start();
if(I2C_sendbyte(id<<1) != 0)
{
goto error;
}
if(I2C_sendbyte(addr) != 0)
{
goto error;
}
if(I2C_sendbyte(value)!= 0)
{
goto error;
}
I2C_end();

return 0;

error:
I2C_end();
return -1;

}

I2C_ctrl.h
#ifndef I2C_CTRL_H_
#define I2C_CTRL_H_

void I2C_start(void);
void I2C_end(void);

//void I2C_sendbyte( unsigned char value );

int I2C_senddata(unsigned char id, unsigned char subaddr,unsigned char value);
int I2C_readdata(unsigned char id, unsigned char addr, unsigned char *value);

#endif /* I2C_CTRL_H_ */

helloworld.c
#define ADV7511_I2C_ADDR (0x72 >> 1)

int main()
{
unsigned char data;
int Status;

init_platform();

EMIO_I2C_init();

usleep(500*1000);

while(1)
{

//讀取PID
data = 0;
I2C_senddata(ADV7511_I2C_ADDR,0x41,0x40);
sleep(1);
if(I2C_readdata(ADV7511_I2C_ADDR,0x41,&data) != 0)
{
print("error ");
}
else
{
if(data != 0x40)
print("error ");
}

data = 0;
if(I2C_readdata(ADV7511_I2C_ADDR,0xf5,&data) != 0)
{
print("error ");
}
else
{
if(data != 0x75)
print("error ");
}

data = 0;

if(I2C_readdata(ADV7511_I2C_ADDR,0xf6,&data) != 0)
{
print("error ");
}
else
{
if(data != 0x11)
print("error ");
}

sleep(2);

}

cleanup_platform();
return 0;
}