repo2/firmware_eclairexl/vidi2c/vidi2c.c @ 1476
| 650 | markw | #include "vidi2c.h"
|
|
#include "regs.h"
|
|||
#include "integer.h"
|
|||
void set_vidi2c()
|
|||
{
|
|||
//wait_us(5000000);
|
|||
int i;
|
|||
unsigned int slave = 0x70;
|
|||
unsigned int read = 0x1;
|
|||
unsigned int write = 0x0;
|
|||
// write this to the control reg to change which channel is selected, then stop...
|
|||
| 651 | markw | unsigned int channel0 = 0x4; //VGA
|
|
unsigned int channel1 = 0x5; //HDMI
|
|||
| 650 | markw | ||
unsigned int anotherslave = 0x50;
|
|||
// *zpu_i2c_1 = (slave<<9) | write<<8 | channel0; // select channel 0
|
|||
// while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
//
|
|||
// *zpu_i2c_1 = (anotherslave<<9) | write<<8 | 0xaa;
|
|||
// while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
//
|
|||
// *zpu_i2c_1 = (slave<<9) | read<<8; // read control reg
|
|||
// while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
//
|
|||
// *zpu_i2c_1 = (slave<<9) | write<<8 | channel1; // select channel 1
|
|||
// while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
//
|
|||
// *zpu_i2c_1 = (anotherslave<<9) | write<<8 | 0xf0;
|
|||
// while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
//
|
|||
// *zpu_i2c_1 = (slave<<9) | read<<8; // read control reg
|
|||
// while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
// From here we can either decode or write a function just to say 'VGA connected'/'HDMI connected'
|
|||
// If we decode then we can set the timings from here then program clock chip for the pixel clock (TODO)
|
|||
// Read DDC from HDMI
|
|||
*zpu_i2c_1 = (slave<<9) | write<<8 | channel0; // select channel 0
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
*zpu_i2c_1 = (anotherslave<<9) | write<<8; // starting from addr 0
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
for (i=0;i!=128;++i)
|
|||
{
|
|||
*zpu_i2c_1 = (anotherslave<<9) | read<<8;
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
}
|
|||
*zpu_i2c_1 = (slave<<9) | read<<8; // read control reg
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
// Read DDC from VGA
|
|||
*zpu_i2c_1 = (slave<<9) | write<<8 | channel1; // select channel 1
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
*zpu_i2c_1 = (anotherslave<<9) | write<<8; // starting from addr 0
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
for (i=0;i!=128;++i)
|
|||
{
|
|||
*zpu_i2c_1 = (anotherslave<<9) | read<<8;
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
}
|
|||
*zpu_i2c_1 = (slave<<9) | read<<8; // read control reg
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
}
|
|||
| 654 | markw | void readDDC(int channel, uint8_t * buffer, int maxLen)
|
|
| 651 | markw | {
|
|
int i=0;
|
|||
unsigned int slave = 0x70;
|
|||
unsigned int read = 0x1;
|
|||
unsigned int write = 0x0;
|
|||
unsigned int anotherslave = 0x50;
|
|||
| 662 | markw | if (1==*zpu_board)
|
|
return;
|
|||
| 651 | markw | *zpu_i2c_1 = (slave<<9) | write<<8 | channel; // select channel 0
|
|
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
*zpu_i2c_1 = (anotherslave<<9) | write<<8; // starting from addr 0
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
| 654 | markw | for (i=0;i!=maxLen;++i)
|
|
| 651 | markw | {
|
|
*zpu_i2c_1 = (anotherslave<<9) | read<<8;
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
buffer[i] = (*zpu_i2c_1)&0xff;
|
|||
}
|
|||
*zpu_i2c_1 = (slave<<9) | write<<8; // deselect channel 0
|
|||
while ((*zpu_i2c_1)&0x100); // wait until busy not asserted
|
|||
}
|
|||
int isVideoConnected(int channel)
|
|||
{
|
|||
int res = 0;
|
|||
| 654 | markw | uint8_t buffer[5];
|
|
| 651 | markw | ||
| 654 | markw | readDDC(channel,&buffer[0],5);
|
|
| 651 | markw | ||
res = (buffer[0]==0x00 && buffer[1]==0xff && buffer[2]==0xff);
|
|||
return res;
|
|||
}
|
|||
int isHDMIConnected()
|
|||
{
|
|||
return isVideoConnected(0x5);
|
|||
}
|
|||
int isVGAConnected()
|
|||
{
|
|||
return isVideoConnected(0x4);
|
|||
}
|