blob: 94ab2613fe17543cf09020601afa3874a6244ddb (
plain)
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
|
#include "driver/soft_i2c.h"
#include "driver/gpio.h"
signed char SoftI2C::setup()
{
gpio.write(sda, 0);
gpio.write(scl, 0);
return 0;
}
void SoftI2C::start()
{
gpio.input(sda);
gpio.input(scl);
//
gpio.output(sda);
//
gpio.output(scl);
}
void SoftI2C::stop()
{
gpio.output(scl);
//
gpio.output(sda);
//
gpio.input(scl);
//
gpio.input(sda);
}
bool SoftI2C::tx(unsigned char byte)
{
unsigned char got_ack = 0;
for (unsigned char i = 0; i <= 8; i++) {
if ((byte & 0x80) || (i == 8)) {
gpio.input(sda);
} else {
gpio.output(sda);
}
byte <<= 1;
//
gpio.input(scl);
//
if (i == 8) {
if (!gpio.read(sda)) {
got_ack = 1;
}
}
gpio.output(scl);
//
}
return got_ack;
}
unsigned char SoftI2C::rx(bool send_ack)
{
unsigned char byte = 0;
gpio.input(sda);
for (unsigned char i = 0; i <= 8; i++) {
//
gpio.input(scl);
//
if ((i < 8) && gpio.read(sda)) {
byte |= 1 << (7 - i);
}
//
gpio.output(scl);
//
if ((i == 7) && send_ack) {
gpio.output(sda);
} else if ((i == 8) && send_ack) {
gpio.input(sda);
}
}
return byte;
}
void SoftI2C::scan(unsigned int *results)
{
unsigned char i2caddr;
for (unsigned char address = 0; address < 128; address++) {
i2caddr = (address << 1) | 0;
start();
if (tx(i2caddr)) {
results[address / (8 * sizeof(unsigned int))] |= 1 << (address % (8 * sizeof(unsigned int)));
stop();
}
}
stop();
}
signed char SoftI2C::xmit(unsigned char address,
unsigned char tx_len, unsigned char *tx_buf,
unsigned char rx_len, unsigned char *rx_buf)
{
unsigned char i;
if (tx_len) {
start();
tx((address << 1) | 0);
for (i = 0; i < tx_len; i++) {
tx(tx_buf[i]);
}
}
if (rx_len) {
start();
tx((address << 1) | 1);
for (i = 1; i <= rx_len; i++) {
rx_buf[i-1] = rx((i < rx_len) * 1);
}
}
stop();
return 0;
}
#ifdef MULTIPASS_ARCH_esp8266
SoftI2C i2c(GPIO::d7, GPIO::d8);
#elif MULTIPASS_ARCH_arduino_nano
SoftI2C i2c(GPIO::pc5, GPIO::pc4);
#elif MULTIPASS_ARCH_msp430fr5969lp
SoftI2C i2c(GPIO::p1_6, GPIO::p1_7);
#endif
|
