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
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
|
/* $Id: envctrl.c,v 1.3 1998/04/10 08:42:24 jj Exp $
* envctrl.c: Temperature and Fan monitoring on Machines providing it.
*
* Copyright (C) 1998 Eddie C. Dost (ecd@skynet.be)
*/
#include <linux/config.h>
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/errno.h>
#include <linux/delay.h>
#include <linux/ioport.h>
#include <linux/init.h>
#include <asm/ebus.h>
#define PCF8584_ADDRESS 0x55
#define CONTROL_PIN 0x80
#define CONTROL_ES0 0x40
#define CONTROL_ES1 0x20
#define CONTROL_ES2 0x10
#define CONTROL_ENI 0x08
#define CONTROL_STA 0x04
#define CONTROL_STO 0x02
#define CONTROL_ACK 0x01
#define STATUS_PIN 0x80
#define STATUS_STS 0x20
#define STATUS_BER 0x10
#define STATUS_LRB 0x08
#define STATUS_AD0 0x08
#define STATUS_AAB 0x04
#define STATUS_LAB 0x02
#define STATUS_BB 0x01
/*
* CLK Mode Register.
*/
#define BUS_CLK_90 0x00
#define BUS_CLK_45 0x01
#define BUS_CLK_11 0x02
#define BUS_CLK_1_5 0x03
#define CLK_3 0x00
#define CLK_4_43 0x10
#define CLK_6 0x14
#define CLK_8 0x18
#define CLK_12 0x1c
#define I2C_WRITE 0x00
#define I2C_READ 0x01
struct pcf8584_reg
{
__volatile__ unsigned char data;
__volatile__ unsigned char csr;
};
static struct pcf8584_reg *i2c;
struct i2c_addr_map {
unsigned char addr;
unsigned char mask;
char *name;
};
static struct i2c_addr_map devmap[] = {
{ 0x38, 0x78, "PCF8574A" },
{ 0x20, 0x78, "TDA8444" },
{ 0x48, 0x78, "PCF8591" },
};
#define NR_DEVMAP (sizeof(devmap) / sizeof(devmap[0]))
static int
envctrl_read(unsigned char dev, char *buffer, int len)
{
unsigned char dummy;
unsigned char stat;
int error = -ENODEV;
int count = -1;
if (len == 0)
return 0;
i2c->data = (dev << 1) | I2C_READ;
while (!(i2c->csr & STATUS_BB))
udelay(1);
i2c->csr = CONTROL_PIN | CONTROL_ES0 | CONTROL_STA | CONTROL_ACK;
do {
udelay(1);
while ((stat = i2c->csr) & STATUS_PIN)
udelay(1);
if (stat & STATUS_LRB)
goto stop;
error = 0;
if (count == (len - 2))
goto final;
if (++count > 0)
*buffer++ = i2c->data;
else
dummy = i2c->data;
} while (1);
final:
i2c->csr = CONTROL_ES0;
if (++count > 0)
*buffer++ = i2c->data;
else
dummy = i2c->data;
udelay(1);
while ((stat = i2c->csr) & STATUS_PIN)
udelay(1);
stop:
i2c->csr = CONTROL_PIN | CONTROL_ES0 | CONTROL_STO | CONTROL_ACK;
if (++count > 0)
*buffer++ = i2c->data;
else
dummy = i2c->data;
if (error)
return error;
return count;
}
static int
envctrl_write(unsigned char dev, char *buffer, int len)
{
int error = -ENODEV;
int count = 0;
while (!(i2c->csr & STATUS_BB))
udelay(1);
i2c->data = (dev << 1) | I2C_WRITE;
i2c->csr = CONTROL_PIN | CONTROL_ES0 | CONTROL_STA | CONTROL_ACK;
do {
unsigned char stat;
udelay(1);
while ((stat = i2c->csr) & STATUS_PIN)
udelay(1);
if (stat & STATUS_LRB)
goto stop;
error = count;
if (count == len)
goto stop;
i2c->data = *buffer++;
count++;
} while (1);
stop:
i2c->csr = CONTROL_PIN | CONTROL_ES0 | CONTROL_STO | CONTROL_ACK;
return error;
}
__initfunc(static int scan_bus(void))
{
unsigned char dev;
int count = 0;
int i;
/* scan */
for (dev = 1; dev < 128; dev++)
if (envctrl_write(dev, 0, 0) == 0) {
for (i = 0; i < NR_DEVMAP; i++)
if ((dev & devmap[i].mask) == devmap[i].addr)
break;
printk("envctrl: i2c device at %02x: %s\n", dev,
i < NR_DEVMAP ? devmap[i].name : "unknown");
{
unsigned char buf[4];
if (envctrl_read(dev, buf, 4) == 4)
printk("envctrl: read %02x %02x %02x %02x\n",
buf[0], buf[1], buf[2], buf[3]);
}
count++;
}
return count ? 0 : -ENODEV;
}
#ifdef MODULE
int init_module(void)
#else
__initfunc(int envctrl_init(void))
#endif
{
#ifdef CONFIG_PCI
struct linux_ebus *ebus;
struct linux_ebus_device *edev;
for_all_ebusdev(edev, ebus)
if (!strcmp(edev->prom_name, "SUNW,envctrl"))
break;
if (!edev)
return -ENODEV;
if (check_region(edev->base_address[0], sizeof(*i2c))) {
prom_printf("%s: Can't get region %lx, %d\n",
__FUNCTION__, edev->base_address[0],
sizeof(*i2c));
prom_halt();
}
request_region(edev->base_address[0],
sizeof(*i2c), "i2c");
i2c = (struct pcf8584_reg *)edev->base_address[0];
i2c->csr = CONTROL_PIN;
i2c->data = PCF8584_ADDRESS;
i2c->csr = CONTROL_PIN | CONTROL_ES1;
i2c->data = CLK_4_43 | BUS_CLK_90;
i2c->csr = CONTROL_PIN | CONTROL_ES0 | CONTROL_ACK;
udelay(10000);
return scan_bus();
#else
return -ENODEV;
#endif
}
#ifdef MODULE
void cleanup_module(void)
{
}
#endif
|
