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
242
243
244
245
246
247
248
249
250
251
252
253
254
|
/*
ESS1995 communications test
proof of concept
*/
#include "electic.h"
extern "C" void __cxa_pure_virtual()
{
cli();
for (;;);
}
int main(){
init(); //-- init Arduino library - delay, PWM setup messes with timers, millis(), micros() etc don't work without it
pinMode(CS,OUTPUT);
digitalWrite(CS,LOW); //turn off DMM, maybe it doesn't like waiting around
setupBlueTooth();
pinMode(DATA_NEW,INPUT);
pinMode(SCLK,OUTPUT);
pinMode(BTC,INPUT);
pinMode(OUTPUT1, OUTPUT);
pinMode(OUTPUT2, OUTPUT);
digitalWrite(OUTPUT2,HIGH);
digitalWrite(CS,HIGH); //select DMM
uint16_t delayMillis=250;
//send 1st write to initiate readings - not necessary - what is default mode?
/*
writeDMM();
delay(delayMillis);
startWrite();
writeStartBit();
writeByte(WRITE_ID);
writeByte(WB1);
writeByte(WB2);
writeByte(WB3);
writeByte(WB4);
writeStopBit(); //is ACK already the same as stop bit?
*/
//variables to read
uint8_t DB_STATUS;
/*
uint8_t DB_ASIGN;
uint8_t DB_BSIGN;
uint8_t DB_PMAX;
uint8_t DB_PMIN;
uint8_t DB_BTS;
uint8_t DB_ALARM;
uint8_t DB_HF;
uint8_t DB_LF;
uint8_t DB_LDUTY;
uint8_t DB_STA;
uint8_t DB_F_FIN;
*/
uint32_t DB_D0;
uint16_t DB_D1;
uint32_t DB_D2;
uint32_t DB_D3;
delay(delayMillis);
writeDMM();
while(1) {
if (digitalRead(DATA_NEW)==HIGH){ //DMM is ready to send data
digitalWrite(OUTPUT1,HIGH);
digitalWrite(OUTPUT2,LOW);
startWrite();
writeStartBit();
writeByte(READ_ID);
if (digitalRead(DATA_NEW)==LOW){ //ID confirmed
digitalWrite(OUTPUT2,HIGH);
startRead();
for (int i=0;i<10;i++) {
data[i] = readByte();
}
//stop bit comes from the MPU? does seem to be necessary.
startWrite();
writeStopBit();
//parse data
DB_STATUS=data[0];
/*
DB_ASIGN=data[0]>>7;
DB_BSIGN=(data[0]>>6) & 0b01;
DB_PMAX=(data[0]>>5) & 0b01;
DB_PMIN=(data[0]>>4) & 0b01;
DB_BTS=(data[0]>>2) & 0b11;
DB_ALARM=data[0]& 0b01;
DB_HF=data[1]>>7;
DB_LF=(data[1]>>6) & 0b01;
DB_LDUTY=(data[1]>>5) & 0b01;
DB_STA=((data[1]>>3) & 0b10)|((data[0]>>1) & 0b01);
DB_F_FIN=(data[1]>>3) & 0b01;
*/
DB_D0=(((uint32_t)( data[1] & 0b111))<<16)|(((uint32_t)data[2])<<8)|data[3];
DB_D1=(((uint16_t)data[4])<<2)|((data[5] & 0b11000000)>>6);
DB_D2=(((uint32_t)( data[5] & 0b111111))<<13)|(((uint32_t) data[6] )<<5)|(((uint32_t)( data[7] & 0b11111000))>>3);
DB_D3=(((uint32_t)( data[7] & 0b111))<<16)|(((uint32_t) data[8])<<8)|data[9];
while (Serial.available() > 0) {
// get incoming byte:
uint8_t sampleCode = Serial.read();
switch (sampleCode) {
case 1:
delayMillis=1000;
break;
case 2:
delayMillis=250;
break;
case 3:
delayMillis=50;
break;
}
}
if (digitalRead(BTC)){
if (!connected) connected=true;
// data packet :
// ID (2 byte)
// no of bytes (max 255)
// data bytes
Serial.write((uint8_t*)&ELECTIC_ID,2);
Serial.write((uint8_t*)&packetSize,1);
Serial.write((uint8_t*)&DB_STATUS,1);
Serial.write((uint8_t*)&DB_D0,4);
Serial.write((uint8_t*)&DB_D1,2);
}
else {
if (connected) {
advertise();
connected=false;
}
}
}
}
delay(delayMillis);
digitalWrite(OUTPUT1,LOW);
digitalWrite(OUTPUT2,LOW);
//delay(delayMillis);
}
}
void startWrite() {
pinMode(SDATA,OUTPUT);
digitalWrite(SCLK, HIGH);
}
void startRead() {
pinMode(SDATA,INPUT);
digitalWrite(SCLK, HIGH);
}
void SCLKcycle_W() {
//insert a high clock cycle, normally LOW
delayMicroseconds(START_DELAY);
digitalWrite(SCLK, HIGH);
delayMicroseconds(CLOCK_DELAY);
digitalWrite(SCLK, LOW);
delayMicroseconds(START_DELAY);
}
void SCLKcycle_R() {
//insert a low clock cycle, normally HIGH
delayMicroseconds(START_DELAY);
digitalWrite(SCLK, LOW);
delayMicroseconds(CLOCK_DELAY);
digitalWrite(SCLK, HIGH);
delayMicroseconds(START_DELAY);
}
void writeByte(uint8_t data){
for (uint8_t i=0,bit=7;i<8;i++,bit--) {
digitalWrite(SDATA,(data>>bit)&0b01);
SCLKcycle_W();
}
digitalWrite(SDATA,HIGH); //ACK/ stopbit should be HIGH?
SCLKcycle_W(); //ACK INTERVAL
}
void writeStopBit(){
digitalWrite(SDATA,LOW); //prepare SDATA
delayMicroseconds(START_DELAY);
digitalWrite(SCLK,HIGH);
delayMicroseconds(START_DELAY);
digitalWrite(SDATA,HIGH); //stop bit
}
void writeStartBit(){
digitalWrite(SDATA, HIGH); //should be anyway
digitalWrite(SCLK, HIGH);
delayMicroseconds(START_DELAY);
digitalWrite(SDATA,LOW); //start bit
delayMicroseconds(START_DELAY);
digitalWrite(SCLK, LOW);
delayMicroseconds(START_DELAY);
}
uint8_t readByte(){
uint8_t data=0;
uint8_t thisdata;
//delayMicroseconds(START_DELAY);
//digitalWrite(SCLK, HIGH); //load first bit
delayMicroseconds(START_DELAY);
for (uint8_t i=0,bit=7;i<8;i++,bit--) {
thisdata=digitalRead(SDATA);
data = data | (thisdata<<bit);
digitalWrite(OUTPUT1,thisdata);
SCLKcycle_R();
}
SCLKcycle_R(); //ACK
return data;
}
void writeDMM(){
uint8_t WB1 = (CB_SHBP << 7) | (CB_function << 3) | (CB_VARCrange);
uint8_t WB2 = (CB_BUZfreq << 5) | (CB_ADCrate << 3) | (CB_FREQrange);
uint8_t WB3 = (CB_ACmode << 7) | (CB_EXTdiode << 4) | (CB_DCfs << 3) | (CB_LPFbw << 1) | (CB_FREQinprest);
uint8_t WB4 = (CB_PEAKmode << 7) | (CB_PCALmode << 6) | (CB_OPconf << 2) | (CB_ADPext);
startWrite();
writeStartBit();
writeByte(WRITE_ID);
writeByte(WB1);
writeByte(WB2);
writeByte(WB3);
writeByte(WB4);
writeStopBit();
}
|
