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
|
/*****************************************************************************
Copyright(c) 2012 FCI Inc. All Rights Reserved
File name : fci_i2c.c
Description : fci i2c driver
*******************************************************************************/
#include "fci_types.h"
#include "fci_oal.h"
#include "fc8150_regs.h"
#include "fci_hal.h"
#define I2CSTAT_TIP 0x02 /* Tip bit */
#define I2CSTAT_NACK 0x80 /* Nack bit */
#define I2C_TIMEOUT 100
#define I2C_CR_STA 0x80
#define I2C_CR_STO 0x40
#define I2C_CR_RD 0x20
#define I2C_CR_WR 0x10
#define I2C_CR_NACK 0x08
#define I2C_CR_IACK 0x01
#define I2C_WRITE 0
#define I2C_READ 1
#define I2C_OK 0
#define I2C_NOK 1
#define I2C_NACK 2
#define I2C_NOK_LA 3 /* Lost arbitration */
#define I2C_NOK_TOUT 4 /* time out */
#define FC8150_FREQ_XTAL BBM_XTAL_FREQ
/* static OAL_SEMAPHORE hBbmMutex; */
static int WaitForXfer(HANDLE hDevice)
{
int i;
int res = I2C_OK;
u8 status;
i = I2C_TIMEOUT * 20000;
/* wait for transfer complete */
do {
bbm_read(hDevice, BBM_I2C_SR, &status);
i--;
} while ((i > 0) && (status & I2CSTAT_TIP));
/* check time out or nack */
if (status & I2CSTAT_TIP) {
res = I2C_NOK_TOUT;
} else {
bbm_read(hDevice, BBM_I2C_SR, &status);
if (status & I2CSTAT_NACK)
res = I2C_NACK;
else
res = I2C_OK;
}
return res;
}
static int fci_i2c_transfer(HANDLE hDevice, u8 cmd_type, u8 chip
, u8 addr[], u8 addr_len, u8 data[], u8 data_len)
{
int i;
int result = I2C_OK;
switch (cmd_type) {
case I2C_WRITE:
bbm_write(hDevice, BBM_I2C_TXR, chip | cmd_type);
bbm_write(hDevice, BBM_I2C_CR, I2C_CR_STA | I2C_CR_WR /*0x90*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
if (addr && addr_len) {
i = 0;
while ((i < addr_len) && (result == I2C_OK)) {
bbm_write(hDevice, BBM_I2C_TXR, addr[i]);
bbm_write(hDevice, BBM_I2C_CR
, I2C_CR_WR /*0x10*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
i++;
}
}
i = 0;
while ((i < data_len) && (result == I2C_OK)) {
bbm_write(hDevice, BBM_I2C_TXR, data[i]);
bbm_write(hDevice, BBM_I2C_CR, I2C_CR_WR /*0x10*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
i++;
}
bbm_write(hDevice, BBM_I2C_CR, I2C_CR_STO /*0x40*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
break;
case I2C_READ:
if (addr && addr_len) {
bbm_write(hDevice, BBM_I2C_TXR, chip | I2C_WRITE);
bbm_write(hDevice, BBM_I2C_CR
, I2C_CR_STA | I2C_CR_WR /*0x90*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
i = 0;
while ((i < addr_len) && (result == I2C_OK)) {
bbm_write(hDevice, BBM_I2C_TXR, addr[i]);
bbm_write(hDevice, BBM_I2C_CR
, I2C_CR_WR /*0x10*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
i++;
}
}
bbm_write(hDevice, BBM_I2C_TXR, chip | I2C_READ);
bbm_write(hDevice, BBM_I2C_CR, I2C_CR_STA | I2C_CR_WR /*0x90*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK)
return result;
i = 0;
while ((i < data_len) && (result == I2C_OK)) {
if (i == data_len - 1) {
bbm_write(hDevice, BBM_I2C_CR
, I2C_CR_RD|I2C_CR_NACK/*0x28*/);
result = WaitForXfer(hDevice);
if ((result != I2C_NACK)
&& (result != I2C_OK)) {
PRINTF(hDevice, "NACK4-0[%02x]\n"
, result);
return result;
}
} else {
bbm_write(hDevice, BBM_I2C_CR
, I2C_CR_RD /*0x20*/);
result = WaitForXfer(hDevice);
if (result != I2C_OK) {
PRINTF(hDevice, "NACK4-1[%02x]\n"
, result);
return result;
}
}
bbm_read(hDevice, BBM_I2C_RXR, &data[i]);
i++;
}
bbm_write(hDevice, BBM_I2C_CR, I2C_CR_STO /*0x40*/);
result = WaitForXfer(hDevice);
if ((result != I2C_NACK) && (result != I2C_OK)) {
PRINTF(hDevice, "NACK5[%02X]\n", result);
return result;
}
break;
default:
return I2C_NOK;
}
return I2C_OK;
}
int fci_i2c_init(HANDLE hDevice, int speed, int slaveaddr)
{
u16 r = FC8150_FREQ_XTAL % (5 * speed);
u16 pr = (FC8150_FREQ_XTAL - r) / (5 * speed) - 1;
if (((5 * speed) >> 1) <= r)
pr++;
bbm_word_write(hDevice, BBM_I2C_PR_L, pr);
bbm_write(hDevice, BBM_I2C_CTR, 0xc0);
PRINTF(hDevice, "Internal I2C Pre-scale: 0x%02x\n", pr);
return BBM_OK;
}
int fci_i2c_read(HANDLE hDevice, u8 chip, u8 addr, u8 alen, u8 *data, u8 len)
{
int ret;
ret = fci_i2c_transfer(hDevice, I2C_READ, chip << 1, &addr
, alen, data, len);
if (ret != I2C_OK) {
PRINTF(hDevice, "fci_i2c_read() result=%d, addr = %x, data=%x\n"
, ret, addr, *data);
return ret;
}
return ret;
}
int fci_i2c_write(HANDLE hDevice, u8 chip, u8 addr, u8 alen, u8 *data, u8 len)
{
int ret;
u8 *paddr = &addr;
ret = fci_i2c_transfer(hDevice, I2C_WRITE, chip << 1
, paddr, alen, data, len);
if (ret != I2C_OK)
PRINTF(hDevice, "fci_i2c_write() result=%d, addr= %x, data=%x\n"
, ret, addr, *data);
return ret;
}
int fci_i2c_deinit(HANDLE hDevice)
{
bbm_write(hDevice, BBM_I2C_CTR, 0x00);
return BBM_OK;
}
|
