Newer
Older
#define I2C_DELAY 100
static void mi2c_delay()
{
int i;
for(i=0;i<I2C_DELAY;i++) asm volatile ("nop");
}
#define M_SDA_OUT(x) { gpio_out(GPIO_SDA, x); mi2c_delay(); }
#define M_SCL_OUT(x) { gpio_out(GPIO_SCL, x); mi2c_delay(); }
#define M_SDA_IN gpio_in(GPIO_SDA)
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
void mi2c_start()
{
M_SDA_OUT(0);
M_SCL_OUT(0);
}
void mi2c_repeat_start()
{
M_SDA_OUT(1);
M_SCL_OUT(1);
M_SDA_OUT(0);
M_SCL_OUT(0);
}
void mi2c_stop()
{
M_SDA_OUT(0);
M_SCL_OUT(1);
M_SDA_OUT(1);
}
unsigned char mi2c_put_byte(unsigned char data)
{
char i;
unsigned char ack;
for (i=0;i<8;i++, data<<=1)
{
M_SDA_OUT(data&0x80);
M_SCL_OUT(1);
M_SCL_OUT(0);
}
M_SDA_OUT(1);
M_SCL_OUT(1);
ack = M_SDA_IN; /* ack: sda is pulled low ->success. */
M_SCL_OUT(0);
M_SDA_OUT(0);
return ack!=0;
}
void mi2c_get_byte(unsigned char *data)
{
int i;
unsigned char indata = 0;
/* assert: scl is low */
M_SCL_OUT(0);
for (i=0;i<8;i++)
{
M_SCL_OUT(1);
indata <<= 1;
if ( M_SDA_IN ) indata |= 0x01;
M_SCL_OUT(0);
}
M_SDA_OUT(1);
*data= indata;
}
void mi2c_init()
{
M_SCL_OUT(1);
M_SDA_OUT(1);
}
void mi2c_scan()
{
int i;
for(i=0;i<0x80;i++)
{
mi2c_start();
mprintf("scan %d\n",i);
if(!mi2c_put_byte(i<<1)) mprintf("found : %x\n", i);
mi2c_stop();
}
}