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
|
/*************************************************************************
* Simple OBD Data Display
* Works with any Arduino board connected with SH1106 128*64 I2C OLED and
* Freematics OBD-II UART Adapter - https://freematics.com/products
* Distributed under public domain
* Written by Stanley Huang <stanley@freematics.com.au>
*************************************************************************/
#include <Wire.h>
#include <OBD2UART.h>
#include <MicroLCD.h>
LCD_SH1106 lcd;
COBD obd;
void reconnect()
{
lcd.clear();
lcd.setFontSize(FONT_SIZE_MEDIUM);
lcd.print("Reconnecting");
//digitalWrite(SD_CS_PIN, LOW);
for (uint16_t i = 0; !obd.init(); i++) {
if (i == 5) {
lcd.clear();
}
delay(3000);
}
}
void showData(byte pid, int value)
{
switch (pid) {
case PID_RPM:
lcd.setCursor(64, 0);
lcd.setFontSize(FONT_SIZE_XLARGE);
lcd.printInt((unsigned int)value % 10000, 4);
break;
case PID_SPEED:
lcd.setCursor(0, 0);
lcd.setFontSize(FONT_SIZE_XLARGE);
lcd.printInt((unsigned int)value % 1000, 3);
break;
case PID_THROTTLE:
lcd.setCursor(88, 5);
lcd.setFontSize(FONT_SIZE_MEDIUM);
lcd.printInt(value % 100, 3);
lcd.setFontSize(FONT_SIZE_SMALL);
lcd.print(" %");
break;
case PID_ENGINE_LOAD:
lcd.setCursor(12, 5);
lcd.setFontSize(FONT_SIZE_MEDIUM);
lcd.printInt(value, 3);
lcd.setFontSize(FONT_SIZE_SMALL);
lcd.print(" %");
break;
}
}
void initScreen()
{
lcd.clear();
lcd.setFontSize(FONT_SIZE_SMALL);
lcd.setCursor(24, 3);
lcd.print("km/h");
lcd.setCursor(110, 3);
lcd.print("rpm");
lcd.setCursor(0, 7);
lcd.print("ENGINE LOAD");
lcd.setCursor(80, 7);
lcd.print("THROTTLE");
}
void setup()
{
lcd.begin();
lcd.setFontSize(FONT_SIZE_MEDIUM);
lcd.println("OBD DISPLAY");
delay(500);
obd.begin();
lcd.println();
lcd.println("Connecting...");
while (!obd.init());
initScreen();
}
void loop()
{
static byte pids[]= {PID_RPM, PID_SPEED, PID_ENGINE_LOAD, PID_THROTTLE};
static byte index = 0;
byte pid = pids[index];
int value;
// send a query to OBD adapter for specified OBD-II pid
if (obd.readPID(pid, value)) {
showData(pid, value);
}
index = (index + 1) % sizeof(pids);
if (obd.errors >= 2) {
reconnect();
setup();
}
}
|
