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
|
#include "driver/soft_i2c.h"
#include "driver/gpio.h"
#include "arch.h"
#ifdef SOFTI2C_PULLUP
#define SDA_HIGH gpio.input(sda, 1)
#define SDA_LOW gpio.output(sda, 0)
#define SCL_HIGH gpio.input(scl, 1)
#define SCL_LOW gpio.output(scl, 0)
#else
#define SDA_HIGH gpio.input(sda)
#define SDA_LOW gpio.output(sda)
#define SCL_HIGH gpio.input(scl)
#define SCL_LOW gpio.output(scl)
#endif
signed char SoftI2C::setup()
{
SDA_HIGH;
SCL_HIGH;
return 0;
}
void SoftI2C::start()
{
SDA_HIGH;
SCL_HIGH;
//
SDA_LOW;
//
SCL_LOW;
}
void SoftI2C::stop()
{
SCL_LOW;
//
SDA_LOW;
//
SCL_HIGH;
//
SDA_HIGH;
}
bool SoftI2C::tx(unsigned char byte)
{
unsigned char got_ack = 0;
for (unsigned char i = 0; i <= 8; i++) {
if ((byte & 0x80) || (i == 8)) {
SDA_HIGH;
} else {
SDA_LOW;
}
byte <<= 1;
//
SCL_HIGH;
while (!gpio.read(scl)) ;
//
if (i == 8) {
if (!gpio.read(sda)) {
got_ack = 1;
}
}
SCL_LOW;
//
}
return got_ack;
}
unsigned char SoftI2C::rx(bool send_ack)
{
unsigned char byte = 0;
SDA_HIGH;
for (unsigned char i = 0; i <= 8; i++) {
//
SCL_HIGH;
while (!gpio.read(scl)) ;
//
if ((i < 8) && gpio.read(sda)) {
byte |= 1 << (7 - i);
}
//
SCL_LOW;
//
if ((i == 7) && send_ack) {
SDA_LOW;
} else if ((i == 8) && send_ack) {
SDA_HIGH;
}
}
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::pc4, GPIO::pc5);
#elif MULTIPASS_ARCH_blinkenrocket
SoftI2C i2c(GPIO::pc4, GPIO::pc5);
#elif MULTIPASS_ARCH_msp430fr5969lp
SoftI2C i2c(GPIO::p1_6, GPIO::p1_7);
#endif
|
