/*********************************************************************

				NMM-1
NMEA0183 serial Monitor.

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);
}