added via accelerant, a copy of skeleton driver yet.
git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@13604 a95241bf-73f2-0310-859d-f6bbb57e9c96
This commit is contained in:
Rudolf Cornelissen
@@ -0,0 +1,348 @@
|
||||
/*
|
||||
* i2c interface for the G400 MAVEN under BeOS
|
||||
*
|
||||
* Provides I2CR,I2CW - functions to parallel DACW,DACR
|
||||
* Bus should be run at max. 100kHz: see original Philips I2C specification
|
||||
*
|
||||
* Much help was provided by observing the Linux i2c code,
|
||||
* so thanks go to: Gerd Knorr
|
||||
*
|
||||
* Other authors:
|
||||
* Mark Watson 6/2000,
|
||||
* Rudolf Cornelissen 12/2002-12/2003
|
||||
*/
|
||||
|
||||
#define MODULE_BIT 0x00004000
|
||||
|
||||
#include "std.h"
|
||||
|
||||
int i2c_set_lines(int clock, int data);
|
||||
int i2c_get_data(void);
|
||||
void i2c_start(void);
|
||||
void i2c_stop(void);
|
||||
void i2c_high(void);
|
||||
void i2c_low(void);
|
||||
int i2c_get_ack(void);
|
||||
void i2c_send_ack(void);
|
||||
int i2c_sendbyte(unsigned char data);
|
||||
unsigned char i2c_readbyte(int ack_required);
|
||||
|
||||
/*which device on the bus is the MAVEN?*/
|
||||
#define MAVEN_WRITE (0x1B<<1)
|
||||
#define MAVEN_READ ((0x1B<<1)|1)
|
||||
|
||||
#define I2C_CLOCK 0x20
|
||||
#define I2C_DATA 0x10
|
||||
|
||||
/* NV-TVO I2C for G200, G400 */
|
||||
#define I2C_CLOCK 0x20
|
||||
#define I2C_DATA 0x10
|
||||
/* primary head DDC for Mystique(?), G100, G200, G400 */
|
||||
#define DDC1_CLK 0x08
|
||||
#define DDC1_DATA 0x02
|
||||
/* primary head DDC for Millennium, Millennium II */
|
||||
#define DDC1B_CLK 0x10
|
||||
#define DDC1B_DATA 0x04
|
||||
/* secondary head DDC for G400, G450 and G550 */
|
||||
#define DDC2_CLK 0x04
|
||||
#define DDC2_DATA 0x01
|
||||
|
||||
status_t i2c_sec_tv_adapter()
|
||||
{
|
||||
status_t result = B_ERROR;
|
||||
|
||||
/* The secondary DDC channel only exist on dualhead cards */
|
||||
if (!si->ps.secondary_head) return result;
|
||||
|
||||
/* make sure the output lines will be active-low when enabled
|
||||
* (they will be pulled 'passive-high' when disabled) */
|
||||
// DXIW(GENIODATA,0x00);
|
||||
/* send out B_STOP condition on secondary head DDC channel and use it to
|
||||
* check for 'shortcut', indicating the Matrox VGA->TV adapter is connected */
|
||||
|
||||
/* make sure SDA is low */
|
||||
// DXIW(GENIOCTRL, (DXIR(GENIOCTRL) | DDC2_DATA));
|
||||
snooze(2);
|
||||
/* make sure SCL should be high */
|
||||
// DXIW(GENIOCTRL, (DXIR(GENIOCTRL) & ~DDC2_CLK));
|
||||
snooze(2);
|
||||
/* if SCL is low then the bus is blocked by a TV adapter */
|
||||
// if (!(DXIR(GENIODATA) & DDC2_CLK)) result = B_OK;
|
||||
snooze(5);
|
||||
/* set SDA while SCL should be set (generates actual bus-stop condition) */
|
||||
// DXIW(GENIOCTRL, (DXIR(GENIOCTRL) & ~DDC2_DATA));
|
||||
snooze(5);
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
/*-----------------------------
|
||||
*low level hardware access
|
||||
*/
|
||||
#define I2C_DELAY 2
|
||||
#define I2C_TIMEOUT 100
|
||||
int i2c_set_lines(int clock,int data)
|
||||
{
|
||||
int count=0;
|
||||
int program;
|
||||
int required;
|
||||
|
||||
/*work out which bits to zero*/
|
||||
program =
|
||||
(clock ? 0 : I2C_CLOCK)|
|
||||
(data ? 0 : I2C_DATA);
|
||||
|
||||
/*what value do I require on data lines*/
|
||||
required =
|
||||
(clock ? I2C_CLOCK : 0);
|
||||
|
||||
/*set the bits to zero*/
|
||||
// DXIW(GENIOCTRL,program); /*drive these bits*/
|
||||
// DXIW(GENIODATA,0x00); /*to zero*/
|
||||
|
||||
/*wait a bit*/
|
||||
delay(I2C_DELAY);
|
||||
|
||||
/*loop until the clock is as required*/
|
||||
// while ((DXIR(GENIODATA)&I2C_CLOCK)!=required)
|
||||
{
|
||||
delay(I2C_DELAY);
|
||||
count++;
|
||||
if (count>I2C_TIMEOUT)
|
||||
{
|
||||
// LOG(8,("I2C: Timeout on set lines - clock:%d data:%d actual:%x\n",clock,data,DXIR(GENIODATA)));
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int i2c_get_data()
|
||||
{
|
||||
int data = 0;
|
||||
int clock;
|
||||
int count=0;
|
||||
|
||||
do
|
||||
{
|
||||
/*read the data and clock lines*/
|
||||
// data = DXIR(GENIODATA);
|
||||
clock = (data&I2C_CLOCK) ? 1 : 0;
|
||||
data = (data&I2C_DATA) ? 1 : 0;
|
||||
|
||||
/*manage timeout*/
|
||||
count++;
|
||||
if (count>I2C_TIMEOUT)
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
|
||||
/*wait a bit, so not hammering bus*/
|
||||
delay(I2C_DELAY);
|
||||
|
||||
}while (!clock); /*wait for high clock*/
|
||||
|
||||
return data;
|
||||
}
|
||||
|
||||
|
||||
/*-----------------------
|
||||
*Standard I2C operations
|
||||
*/
|
||||
void i2c_start()
|
||||
{
|
||||
int error=0;
|
||||
|
||||
error+= i2c_set_lines(0,1);
|
||||
error+= i2c_set_lines(1,1);
|
||||
error+= i2c_set_lines(1,0);
|
||||
error+= i2c_set_lines(0,0);
|
||||
|
||||
if (error)
|
||||
{
|
||||
LOG(8,("I2C: start - %d\n",error));
|
||||
}
|
||||
}
|
||||
|
||||
void i2c_stop()
|
||||
{
|
||||
int error=0;
|
||||
|
||||
error+= i2c_set_lines(0,0);
|
||||
error+= i2c_set_lines(1,0);
|
||||
error+= i2c_set_lines(1,1);
|
||||
error+= i2c_set_lines(0,1);
|
||||
|
||||
if (error)
|
||||
{
|
||||
LOG(8,("I2C: stop - %d\n",error));
|
||||
}
|
||||
}
|
||||
|
||||
void i2c_high()
|
||||
{
|
||||
int error=0;
|
||||
|
||||
error+= i2c_set_lines(0,1);
|
||||
error+= i2c_set_lines(1,1);
|
||||
error+= i2c_set_lines(0,1);
|
||||
|
||||
if (error)
|
||||
{
|
||||
LOG(8,("I2C: high - %d\n",error));
|
||||
}
|
||||
}
|
||||
|
||||
void i2c_low()
|
||||
{
|
||||
int error=0;
|
||||
|
||||
error+= i2c_set_lines(0,0);
|
||||
error+= i2c_set_lines(1,0);
|
||||
error+= i2c_set_lines(0,0);
|
||||
|
||||
if (error)
|
||||
{
|
||||
LOG(8,("I2C: low - %d\n",error));
|
||||
}
|
||||
}
|
||||
|
||||
int i2c_get_ack()
|
||||
{
|
||||
int error=0;
|
||||
int ack;
|
||||
|
||||
error+= i2c_set_lines(0,1);
|
||||
error+= i2c_set_lines(1,1);
|
||||
ack = i2c_get_data();
|
||||
error+= i2c_set_lines(0,1);
|
||||
|
||||
if (error)
|
||||
{
|
||||
LOG(8,("I2C: get_ack - %d value:%x\n",error,ack));
|
||||
}
|
||||
|
||||
return ack;
|
||||
}
|
||||
|
||||
void i2c_send_ack()
|
||||
{
|
||||
int error=0;
|
||||
|
||||
error+= i2c_set_lines(0,0);
|
||||
error+= i2c_set_lines(1,0);
|
||||
error+= i2c_set_lines(0,0);
|
||||
|
||||
if (error)
|
||||
{
|
||||
LOG(8,("I2C: send_ack - %d\n",error));
|
||||
}
|
||||
}
|
||||
|
||||
/*------------------------------
|
||||
*use above functions to send and receive bytes
|
||||
*/
|
||||
|
||||
int i2c_sendbyte(unsigned char data)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i=7; i>=0; i--)
|
||||
{
|
||||
if (data&(1<<i))
|
||||
{
|
||||
i2c_high();
|
||||
}
|
||||
else
|
||||
{
|
||||
i2c_low();
|
||||
}
|
||||
}
|
||||
|
||||
return i2c_get_ack();
|
||||
}
|
||||
|
||||
unsigned char i2c_readbyte(int ack_required)
|
||||
{
|
||||
int i;
|
||||
unsigned char data=0;
|
||||
|
||||
/*read data*/
|
||||
i2c_set_lines(0,1);
|
||||
for (i=7; i>=0; i--)
|
||||
{
|
||||
i2c_set_lines(1,1);
|
||||
if (i2c_get_data()==1)
|
||||
data |= (1<<i);
|
||||
i2c_set_lines(0,1);
|
||||
}
|
||||
|
||||
/*send acknowledge*/
|
||||
if (ack_required) i2c_send_ack();
|
||||
|
||||
return data;
|
||||
}
|
||||
|
||||
/*-------------------------------------------
|
||||
*PUBLIC functions
|
||||
*/
|
||||
int i2c_maven_read(unsigned char address)
|
||||
{
|
||||
int error=0;
|
||||
int data;
|
||||
|
||||
i2c_start();
|
||||
{
|
||||
error+=i2c_sendbyte(MAVEN_READ);
|
||||
error+=i2c_sendbyte(address);
|
||||
data = i2c_readbyte(0);
|
||||
}
|
||||
i2c_stop();
|
||||
if (error>0) LOG(8,("I2C: MAVR ERROR - %x\n",error));
|
||||
return data;
|
||||
}
|
||||
|
||||
void i2c_maven_write(unsigned char address, unsigned char data)
|
||||
{
|
||||
int error=0;
|
||||
|
||||
i2c_start();
|
||||
{
|
||||
error+=i2c_sendbyte(MAVEN_WRITE);
|
||||
error+=i2c_sendbyte(address);
|
||||
error+=i2c_sendbyte(data);
|
||||
}
|
||||
i2c_stop();
|
||||
if (error>0) LOG(8,("I2C: MAVW ERROR - %x\n",error));
|
||||
}
|
||||
|
||||
status_t i2c_init(void)
|
||||
{
|
||||
/*init g400 i2c*/
|
||||
// DXIW(GENIODATA,0x00); /*to zero*/
|
||||
// DXIW(GENIOCTRL,0x30); /*drive clock and data*/
|
||||
// DXIW(GENIOCTRL,0x00); /*stop driving*/
|
||||
|
||||
return B_OK;
|
||||
}
|
||||
|
||||
status_t i2c_maven_probe(void)
|
||||
{
|
||||
int ack;
|
||||
|
||||
/*scan the bus for the MAVEN*/
|
||||
i2c_start();
|
||||
{
|
||||
ack = i2c_sendbyte(MAVEN_READ);
|
||||
}
|
||||
i2c_stop();
|
||||
if (ack==0)
|
||||
{
|
||||
return B_OK;
|
||||
}
|
||||
else
|
||||
{
|
||||
return B_ERROR;
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user