59 lines
1.4 KiB
Arduino
59 lines
1.4 KiB
Arduino
|
#include <SPI.h>
|
||
|
|
#include <Wire.h>
|
||
|
|
#include <Adafruit_GFX.h>
|
||
|
|
#include <Adafruit_SSD1306.h>
|
||
|
|
|
||
|
|
Adafruit_SSD1306 display(pinDisplayReset);
|
||
|
|
|
||
|
|
void initialiseDisplay()
|
||
|
|
{
|
||
|
|
display.begin(SSD1306_SWITCHCAPVCC, 0x3C); // initialize with the I2C addr 0x3C (for the 128x32)
|
||
|
|
display.clearDisplay();
|
||
|
|
display.setTextSize(1);
|
||
|
|
display.setTextColor(WHITE);
|
||
|
|
display.setCursor(0,0);
|
||
|
|
display.print("RPM: ");
|
||
|
|
display.setCursor(0,16);
|
||
|
|
display.print("CPU: ");
|
||
|
|
|
||
|
|
switch(configPage1.displayType)
|
||
|
|
{
|
||
|
|
case 1:
|
||
|
|
display.SSD1306_SETCOMPINS_V = 0x02;
|
||
|
|
break;
|
||
|
|
case 2:
|
||
|
|
display.SSD1306_SETCOMPINS_V = 0x12;
|
||
|
|
break;
|
||
|
|
case 3:
|
||
|
|
display.SSD1306_SETCOMPINS_V = 0x12;
|
||
|
|
break;
|
||
|
|
case 4:
|
||
|
|
display.SSD1306_SETCOMPINS_V = 0x12;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void updateDisplay()
|
||
|
|
{
|
||
|
|
display.clearDisplay();
|
||
|
|
//display.setCursor(0,0);
|
||
|
|
//display.print("RPM: ");
|
||
|
|
display.setCursor(64,0);
|
||
|
|
display.print("PW: ");
|
||
|
|
display.setCursor(0,11);
|
||
|
|
display.print("CPU: ");
|
||
|
|
/*
|
||
|
|
display.setCursor(28,0);
|
||
|
|
display.print(currentStatus.RPM);
|
||
|
|
display.setCursor(92,0);
|
||
|
|
display.print((currentStatus.PW));*/
|
||
|
|
display.setCursor(28,11);
|
||
|
|
display.print(currentStatus.loopsPerSecond);
|
||
|
|
|
||
|
|
int barWidth = ldiv(((unsigned long)currentStatus.RPM * 128), 9000).quot;
|
||
|
|
//int barWidth = map(currentStatus.RPM, 0, 9000, 0, 128);
|
||
|
|
display.fillRect(0, 20, barWidth, 10, 1);
|
||
|
|
|
||
|
|
display.display();
|
||
|
|
}
|