1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
|
/* (c) Itai Nahshon */
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "xf86.h"
#include "xf86_OSproc.h"
#include "compiler.h"
#include "xf86Pci.h"
#include "vgaHW.h"
#include "cir.h"
#define _ALP_PRIVATE_
#include "alp.h"
static char strI2CBus1[] = "I2C bus 1";
static char strI2CBus2[] = "I2C bus 2";
/*
* Switch between internal I2C bus and external (DDC) bus.
* There is one I2C port controlled bu SR08 and the programmable
* outputs control a multiplexer.
*/
static Bool
AlpI2CSwitchToBus(I2CBusPtr b)
{
CirPtr pCir = ((CirPtr)b->DriverPrivate.ptr);
vgaHWPtr hwp = VGAHWPTR(pCir->pScrn);
CARD8 reg = hwp->readGr(hwp, 0x17);
if (b == pCir->I2CPtr1) {
if ((reg & 0x60) == 0)
return TRUE;
reg &= ~0x60;
}
else if(b == pCir->I2CPtr2) {
if ((reg & 0x60) != 0)
return TRUE;
reg |= 0x60;
} else return FALSE;
/* ErrorF("AlpI2CSwitchToBus: \"%s\"\n", b->BusName); */
hwp->writeGr(hwp, 0x17, reg);
return TRUE;
}
static void
AlpI2CPutBits(I2CBusPtr b, int clock, int data)
{
unsigned int reg = 0xfc;
CirPtr pCir = ((CirPtr)b->DriverPrivate.ptr);
vgaHWPtr hwp = VGAHWPTR(pCir->pScrn);
if (!AlpI2CSwitchToBus(b))
return;
if (clock) reg |= 1;
if (data) reg |= 2;
hwp->writeSeq(hwp, 0x08, reg);
/* ErrorF("AlpI2CPutBits: %d %d\n", clock, data); */
}
static void
AlpI2CGetBits(I2CBusPtr b, int *clock, int *data)
{
unsigned int reg;
CirPtr pCir = ((CirPtr)b->DriverPrivate.ptr);
vgaHWPtr hwp = VGAHWPTR(pCir->pScrn);
if (!AlpI2CSwitchToBus(b))
return;
reg = hwp->readSeq(hwp, 0x08);
*clock = (reg & 0x04) != 0;
*data = (reg & 0x80) != 0;
/* ErrorF("AlpI2CGetBits: %d %d\n", *clock, *data); */
}
Bool
AlpI2CInit(ScrnInfoPtr pScrn)
{
CirPtr pCir = CIRPTR(pScrn);
I2CBusPtr I2CPtr;
#ifdef ALP_DEBUG
ErrorF("AlpI2CInit\n");
#endif
switch(pCir->Chipset) {
case PCI_CHIP_GD5446:
case PCI_CHIP_GD5480:
break;
default:
return FALSE;
}
I2CPtr = xf86CreateI2CBusRec();
if (!I2CPtr) return FALSE;
pCir->I2CPtr1 = I2CPtr;
I2CPtr->BusName = strI2CBus1;
I2CPtr->scrnIndex = pScrn->scrnIndex;
I2CPtr->I2CPutBits = AlpI2CPutBits;
I2CPtr->I2CGetBits = AlpI2CGetBits;
I2CPtr->DriverPrivate.ptr = pCir;
if (!xf86I2CBusInit(I2CPtr))
return FALSE;
I2CPtr = xf86CreateI2CBusRec();
if (!I2CPtr) return FALSE;
pCir->I2CPtr2 = I2CPtr;
I2CPtr->BusName = strI2CBus2;
I2CPtr->scrnIndex = pScrn->scrnIndex;
I2CPtr->I2CPutBits = AlpI2CPutBits;
I2CPtr->I2CGetBits = AlpI2CGetBits;
I2CPtr->DriverPrivate.ptr = pCir;
if (!xf86I2CBusInit(I2CPtr))
return FALSE;
return TRUE;
}
|