450 lines
11 KiB
C++
450 lines
11 KiB
C++
/*********************************************************************
|
|
|
|
NMM-1
|
|
NMEA0183 serial simulator.
|
|
|
|
By Jony Silva
|
|
Wed 24 Jan 23:11:25 GMT 2018
|
|
*********************************************************************/
|
|
|
|
// Libraries to be included
|
|
#include <SPI.h>
|
|
#include <Wire.h>
|
|
#include <SoftwareSerial.h>
|
|
#include <Adafruit_GFX.h>
|
|
#include <Adafruit_SSD1306.h>
|
|
|
|
#define OLED_RESET 8
|
|
Adafruit_SSD1306 display(OLED_RESET);
|
|
|
|
#define ON 0 // ON means pin is on GND
|
|
#define OFF 1 // OFF means pin is on VCC
|
|
|
|
// Assign switches and led's to arduino pins
|
|
#define UP 2 // Switch 1 will be function UP connected to arduino PD 2
|
|
#define OK 3 // Switch 2 will be function OK connected to arduino pin 3
|
|
#define DOWN 4 // Switch 3 will be function DOWN connected to arduino pin 4
|
|
#define CANCEL 5 // Switch 4 will be function CANCEL connected to arduino pin 5
|
|
#define led1 9 // Led 1 connected to arduino pin 9
|
|
#define led2 10 // Led 2 connected to arduino pin 10
|
|
#define batt 17 // Battery plus connected to arduino pin 17
|
|
|
|
// Macros to read the switchs
|
|
#define rUP digitalRead(UP) // Read button UP state
|
|
#define rOK digitalRead(OK) // Read button OK state
|
|
#define rDOWN digitalRead(DOWN) // Read button DOWN state
|
|
#define rCANCEL digitalRead(CANCEL) // Read button CANCEL state
|
|
|
|
|
|
// Function declarations
|
|
void one(); // Menu one
|
|
void two(); // Menu two
|
|
void three(); // Menu three
|
|
void four(); // Menu four
|
|
void read_serial(); // Menu that reads the serial
|
|
void write_gps(); // Menu that writes gps out to serial
|
|
void write_hdg(); // Menu that writes hdg out to serial
|
|
void write_dep(); // Menu that writes dep out to serial
|
|
void batt_icon(); // Draws the battery icon acording to value
|
|
|
|
void write_serial(); // Menu that writes to serial
|
|
|
|
|
|
|
|
// Variables creation
|
|
int menuState = 1; // Integer with the number of the menu you are in
|
|
int prevMenu = 1; // Previous menu
|
|
int UP_state = OFF; // Holds state for UP, either ON or OFF
|
|
int OK_state = OFF; // Holds state for OK, either ON or OFF
|
|
int DOWN_state = OFF; // Holds state for DOWN, either ON or OFF
|
|
int CANCEL_state = OFF; // Holds state for CANCEL, either ON or OFF
|
|
int batt_val = 0; // Holds the value of battery voltage
|
|
int incomingByte; // Serial incoming byte buffer
|
|
int read_s = 0;
|
|
|
|
|
|
// Create SoftwareSerial object and designate pins
|
|
SoftwareSerial mySerial(6, 7); // RX, TX
|
|
|
|
void setup() { // BEGIN SETUP ------------------------------------
|
|
|
|
|
|
pinMode(led1, OUTPUT); // Led 1 is an output
|
|
pinMode(led2, OUTPUT); // Led 2 is an output
|
|
pinMode(UP, INPUT); // Switch 1 is an input
|
|
pinMode(OK, INPUT); // Switch 2 is an input
|
|
pinMode(DOWN, INPUT); // Switch 3 is an input
|
|
pinMode(CANCEL, INPUT); // Switch 4 is an input
|
|
|
|
// Define the starting state of the led's
|
|
digitalWrite(led1,HIGH); // Turn off led 1
|
|
digitalWrite(led2,HIGH); // Turn off led 2
|
|
|
|
// set the data rate for the SoftwareSerial port
|
|
|
|
// set the data rate for the Serial port
|
|
Serial.begin(4800);
|
|
|
|
// by default, we'll generate the high voltage from the 3.3v line internally! (neat!)
|
|
display.begin(SSD1306_SWITCHCAPVCC, 0x3C); // initialize with the I2C addr 0x3C (for the 128x32)
|
|
// init done
|
|
|
|
|
|
// initialize timer1 ---------------------------------------
|
|
noInterrupts(); // disable all interrupts
|
|
TCCR1A = 0;
|
|
TCCR1B = 0;
|
|
TCNT1 = 0;
|
|
|
|
OCR1A = 9000; // Load value to compare
|
|
TCCR1B |= (1 << WGM12); // CTC mode
|
|
TCCR1B |= (1 << CS10); // 64 prescaler
|
|
TCCR1B |= (1 << CS11); //
|
|
TIMSK1 |= (1 << OCIE1A); // enable timer compare interrupt
|
|
interrupts(); // enable all interrupts
|
|
// ----------------------------------------------------------
|
|
|
|
|
|
// Clear the buffer.
|
|
display.clearDisplay();
|
|
display.display();
|
|
|
|
display.setTextSize(2);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(36,22);
|
|
display.println("NMM-1");
|
|
display.display();
|
|
delay(3000);
|
|
display.clearDisplay();
|
|
display.display();
|
|
|
|
} // END SETUP --------------------------------------------------------------------
|
|
|
|
|
|
|
|
// Timer compare interrupt service routine --------------------------
|
|
ISR(TIMER1_COMPA_vect) //
|
|
{ //
|
|
if (!rUP) {
|
|
if (menuState == 1) {
|
|
menuState = 1;
|
|
}
|
|
else if (menuState == 2) {
|
|
menuState = 1;
|
|
}
|
|
else if (menuState == 3) {
|
|
menuState = 2;
|
|
}
|
|
else if (menuState == 4) {
|
|
menuState = 3;
|
|
}
|
|
while (!rUP); // Check if button is still pressed do nothing
|
|
}
|
|
|
|
|
|
if (!rDOWN) {
|
|
if (menuState == 1) {
|
|
menuState = 2;
|
|
}
|
|
else if (menuState == 2) {
|
|
menuState = 3;
|
|
}
|
|
else if (menuState == 3) {
|
|
menuState = 4;
|
|
}
|
|
else if (menuState == 4) {
|
|
menuState = 4;
|
|
}
|
|
while (!rDOWN); // Check if button is still pressed do nothing
|
|
}
|
|
|
|
|
|
if (!rOK) {
|
|
if (menuState == 1) {
|
|
menuState = 10;
|
|
prevMenu = 1;
|
|
}
|
|
else if (menuState == 2) {
|
|
menuState = 11;
|
|
prevMenu = 2;
|
|
}
|
|
else if (menuState == 3) {
|
|
menuState = 12;
|
|
prevMenu = 3;
|
|
}
|
|
else if (menuState == 4) {
|
|
menuState = 13;
|
|
prevMenu = 4;
|
|
}
|
|
while (!rOK); // Check if button is still pressed do nothing
|
|
}
|
|
|
|
|
|
if (!rCANCEL) {
|
|
if (prevMenu == 1) {
|
|
menuState = 1;
|
|
}
|
|
else if (prevMenu == 2) {
|
|
menuState = 2;
|
|
}
|
|
else if (prevMenu == 3) {
|
|
menuState = 3;
|
|
}
|
|
else if (prevMenu == 4) {
|
|
menuState = 4;
|
|
}
|
|
while (!rCANCEL); // Check if button is still pressed do nothing
|
|
}
|
|
}
|
|
// -------------------------------------------------------------------
|
|
|
|
|
|
|
|
void loop() {
|
|
|
|
batt_val = analogRead(batt);
|
|
|
|
if (menuState == 1) {
|
|
one();
|
|
mySerial.end();
|
|
read_s = 0;
|
|
}
|
|
else if (menuState == 2) {
|
|
two();
|
|
mySerial.end();
|
|
read_s = 0;
|
|
}
|
|
else if (menuState == 3) {
|
|
three();
|
|
mySerial.end();
|
|
read_s = 0;
|
|
}
|
|
else if (menuState == 4) {
|
|
four();
|
|
mySerial.end();
|
|
read_s = 0;
|
|
}
|
|
else if (menuState == 10) {
|
|
if (read_s == 0) {
|
|
mySerial.begin(4800);
|
|
read_s = 1;
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,17);
|
|
display.println("Sending GPS.....");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
write_gps();
|
|
}
|
|
else if (menuState == 11) {
|
|
if (read_s == 0) {
|
|
mySerial.begin(4800);
|
|
read_s = 1;
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,17);
|
|
display.println("Sending Heading.....");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
write_hdg();
|
|
}
|
|
else if (menuState == 12) {
|
|
if (read_s == 0) {
|
|
mySerial.begin(4800);
|
|
read_s = 1;
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,17);
|
|
display.println("Sending Depth.....");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
write_dep();
|
|
}
|
|
else if (menuState == 13) {
|
|
if (read_s == 0) {
|
|
mySerial.begin(4800);
|
|
read_s = 1;
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,17);
|
|
display.println("RS-422 to USB");
|
|
display.println("Sending...");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
read_serial();
|
|
}
|
|
else {
|
|
one();
|
|
mySerial.end();
|
|
read_s = 0;
|
|
}
|
|
}
|
|
|
|
|
|
void batt_icon (void) {
|
|
|
|
|
|
if (batt_val > 962) {
|
|
// Draw the battery icon - Full battery
|
|
display.drawRect(111, 1, 16, 6, WHITE);
|
|
display.drawRect(112, 2, 14, 4, WHITE);
|
|
display.drawRect(113, 3, 12, 2, WHITE);
|
|
display.drawPixel(110, 3, WHITE);
|
|
display.drawPixel(110, 4, WHITE);
|
|
display.drawPixel(109, 3, WHITE);
|
|
display.drawPixel(109, 4, WHITE);
|
|
display.drawPixel(108, 3, WHITE);
|
|
display.drawPixel(108, 4, WHITE);
|
|
}
|
|
|
|
else if ((batt_val > 901) & (batt_val < 962)) {
|
|
// Draw the battery icon - 2/3 battery
|
|
display.drawRect(111, 1, 16, 6, WHITE);
|
|
display.drawRect(116, 2, 10, 4, WHITE);
|
|
display.drawRect(117, 3, 8, 2, WHITE);
|
|
display.drawPixel(110, 3, WHITE);
|
|
display.drawPixel(110, 4, WHITE);
|
|
display.drawPixel(109, 3, WHITE);
|
|
display.drawPixel(109, 4, WHITE);
|
|
display.drawPixel(108, 3, WHITE);
|
|
display.drawPixel(108, 4, WHITE);
|
|
}
|
|
|
|
else if ((batt_val > 840) & (batt_val < 901)) {
|
|
// Draw the battery icon - 1/3 battery
|
|
display.drawRect(111, 1, 16, 6, WHITE);
|
|
display.drawRect(121, 2, 5, 4, WHITE);
|
|
display.drawRect(122, 3, 3, 2, WHITE);
|
|
display.drawPixel(110, 3, WHITE);
|
|
display.drawPixel(110, 4, WHITE);
|
|
display.drawPixel(109, 3, WHITE);
|
|
display.drawPixel(109, 4, WHITE);
|
|
display.drawPixel(108, 3, WHITE);
|
|
display.drawPixel(108, 4, WHITE);
|
|
}
|
|
|
|
else {
|
|
// Draw the battery icon - Empty battery
|
|
display.setCursor(35,1);
|
|
display.println("BATT LOW");
|
|
display.drawRect(111, 1, 16, 6, WHITE);
|
|
display.drawPixel(110, 3, WHITE);
|
|
display.drawPixel(110, 4, WHITE);
|
|
display.drawPixel(109, 3, WHITE);
|
|
display.drawPixel(109, 4, WHITE);
|
|
display.drawPixel(108, 3, WHITE);
|
|
display.drawPixel(108, 4, WHITE);
|
|
}
|
|
}
|
|
|
|
void one (void) {
|
|
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,22);
|
|
display.println("Send GPS <--");
|
|
display.setCursor(1,32);
|
|
display.println("Send Heading");
|
|
display.setCursor(1,42);
|
|
display.println("Send Depth");
|
|
display.setCursor(1,52);
|
|
display.println("RS422 ==> USB");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
|
|
void two (void) {
|
|
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,22);
|
|
display.println("Send GPS");
|
|
display.setCursor(1,32);
|
|
display.println("Send Heading <--");
|
|
display.setCursor(1,42);
|
|
display.println("Send Depth");
|
|
display.setCursor(1,52);
|
|
display.println("RS422 ==> USB");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
|
|
void three (void) {
|
|
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,22);
|
|
display.println("Send GPS");
|
|
display.setCursor(1,32);
|
|
display.println("Send Heading");
|
|
display.setCursor(1,42);
|
|
display.println("Send Depth <--");
|
|
display.setCursor(1,52);
|
|
display.println("RS422 ==> USB");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
|
|
void four (void) {
|
|
|
|
display.clearDisplay();
|
|
display.setTextSize(1);
|
|
display.setTextColor(WHITE);
|
|
display.setCursor(1,22);
|
|
display.println("Send GPS");
|
|
display.setCursor(1,32);
|
|
display.println("Send Heading");
|
|
display.setCursor(1,42);
|
|
display.println("Send Depth");
|
|
display.setCursor(1,52);
|
|
display.println("RS422 ==> USB <--");
|
|
batt_icon();
|
|
display.display();
|
|
}
|
|
|
|
void read_serial (void) {
|
|
|
|
if (mySerial.available()) {
|
|
Serial.write(mySerial.read());
|
|
}
|
|
}
|
|
|
|
void write_gps (void) {
|
|
|
|
mySerial.print("$GPGGA,090000.10,6350.37829338,N,02225.18272240,W,1,05,2.87,160.00,M,-21.3213,M,,*64");
|
|
mySerial.println();
|
|
delay(100);
|
|
}
|
|
|
|
void write_hdg (void) {
|
|
|
|
mySerial.print("$HEHDT,268.4,T*27");
|
|
mySerial.println();
|
|
delay(100);
|
|
}
|
|
|
|
void write_dep (void) {
|
|
|
|
mySerial.print("$SDDBT,0038.0,f,0011.6,M,0006.3,F");
|
|
mySerial.println();
|
|
delay(100);
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|