Serial_Master.ino

#include <SoftwareSerial.h>
#include <SPI.h>
#include <SD.h> //include the SD library
#include <Arduino.h>
#include <TM1637Display.h>

// Module connection pins (Digital Pins)
#define DISPLAY_CLK 8 
#define SPEED_DISPLAY_DIO 4 //speed display
#define BATT_DISPLAY_DIO 5 //battery display
#define LAP_DISPLAY_DIO 6 //lap number display
#define TIME_DISPLAY_DIO 7 //time display

#define Timer_Button 2 //Push Button for timer
#define Lap_Button 3 //Push Button for lap count
#define NoOfLaps 7;

//Arduino 2 uses normal serial & Arduino 3 uses software serial
#define rxPin2 A0 //Arduino 3 rx
#define txPin2 A1 //Arduino 3 tx
#define ssPin 10 //SD Card 
#define IntPin3 A4//Interrupt for Arduino 3
#define IntPin2 A5//Interrupt for Arduino 2
SoftwareSerial mySerial =  SoftwareSerial(rxPin2, txPin2); //Arduino 3 comms

bool sdInitSuccess = false; //card init status
File myFile;
String Str2 = "";
String Str3 = "";
long Start_Time;
bool Timer = false;
int Lap_Counter;

TM1637Display speed_display(DISPLAY_CLK, SPEED_DISPLAY_DIO);  //set up the speed display
TM1637Display batt_display(DISPLAY_CLK, BATT_DISPLAY_DIO);  //set up the battery display
TM1637Display lap_display(DISPLAY_CLK, LAP_DISPLAY_DIO);  //set up the lap display
TM1637Display time_display(DISPLAY_CLK, TIME_DISPLAY_DIO);  //set up the stopwatch display

/* Useful Constants */
#define SECS_PER_MIN  (60UL)
#define SECS_PER_HOUR (3600UL)
#define SECS_PER_DAY  (SECS_PER_HOUR * 24L)

/* Useful Macros for getting elapsed time */
#define numberOfSeconds(_time_) (_time_ % SECS_PER_MIN)  
#define numberOfMinutes(_time_) ((_time_ / SECS_PER_MIN) % SECS_PER_MIN) 
#define numberOfHours(_time_) (( _time_% SECS_PER_DAY) / SECS_PER_HOUR)
#define elapsedDays(_time_) ( _time_ / SECS_PER_DAY) 

void setup()
{
  Lap_Counter = NoOfLaps;
  pinMode(Timer_Button,INPUT_PULLUP);
  attachInterrupt(digitalPinToInterrupt(Timer_Button), Start_Timer, RISING);

  pinMode(Lap_Button,INPUT_PULLUP);
  attachInterrupt(digitalPinToInterrupt(Lap_Button), Lap_Count, RISING);
  
  batt_display.setBrightness(0x0f);
  speed_display.setBrightness(0x0f);
  time_display.setBrightness(0x0f);
  lap_display.setBrightness(0x0f);
  
  // To arduino 2
  Serial.begin(9600); 
  pinMode(IntPin2, OUTPUT);
  digitalWrite(IntPin2, LOW);

  // To arduino 3
  mySerial.begin(9600); 
  pinMode(IntPin3, OUTPUT);
  digitalWrite(IntPin3, LOW);
  
  if(SD.begin(ssPin))
  {
    sdInitSuccess = true;
  }
  
  if (SD.exists("TEST.txt"))
  {
    SD.remove("TEST.txt");
  }
  myFile = SD.open("TEST.txt", FILE_WRITE);
  myFile.println("Time,BatLvl,Speed,Lat,Log,AccX,AccY,AccZ,Pitch,Yaw,Roll,Current,Temp");
  myFile.close();
  
}

void loop()
{

  /// Arduino 3 //// 
  Str3 = "";
  digitalWrite(IntPin3, HIGH);        // sets the digital pin 3 off
  
  while (mySerial.available())
 {
   char c = mySerial.read(); 
   Str3.concat(c);
 }
  digitalWrite(IntPin3, LOW);        // sets the digital pin 13 off
  delay(500);

  int Str3CommaIndex1 = Str3.indexOf(",");//Lat
  int Str3CommaIndex2 = Str3.indexOf(",",Str3CommaIndex1+1);//Long
  int Str3CommaIndex3 = Str3.indexOf(",",Str3CommaIndex2+1);//Speed
  int Str3CommaIndex4 = Str3.indexOf(",",Str3CommaIndex3+1);//Acc1
  int Str3CommaIndex5 = Str3.indexOf(",",Str3CommaIndex4+1);//Acc2
  int Str3CommaIndex6 = Str3.indexOf(",",Str3CommaIndex5+1);//Acc3
  int Str3CommaIndex7 = Str3.indexOf(",",Str3CommaIndex6+1);//Pos1 - Pitch
  int Str3CommaIndex8 = Str3.indexOf(",",Str3CommaIndex7+1);//Pos2 - Yaw
  //Pos3 - Roll

  float Lat = (Str3.substring(1,Str3CommaIndex1)).toFloat();
  float Long = (Str3.substring(Str3CommaIndex1+1,Str3CommaIndex2)).toFloat();
  float Speed = (Str3.substring(Str3CommaIndex2+1,Str3CommaIndex3)).toFloat();
  float AccX = (Str3.substring(Str3CommaIndex3+1,Str3CommaIndex4)).toFloat();
  float AccY = (Str3.substring(Str3CommaIndex4+1,Str3CommaIndex5)).toFloat();
  float AccZ = (Str3.substring(Str3CommaIndex5+1,Str3CommaIndex6)).toFloat();
  float Pitch = (Str3.substring(Str3CommaIndex6+1,Str3CommaIndex7)).toFloat();
  float Yaw = (Str3.substring(Str3CommaIndex7+1,Str3CommaIndex8)).toFloat();
  float Roll = (Str3.substring(Str3CommaIndex8+1,Str3.length()-1)).toFloat();

  Speed = abs(int(Speed));
  speed_display.showNumberDec(Speed, false);
  

/// Arduino 2 //// 
  Str2 = "";
  digitalWrite(IntPin2, HIGH);        // sets the digital pin 2 high
  
  while (Serial.available())
 {
   char c = Serial.read(); 
   Str2.concat(c);
 }
  digitalWrite(IntPin2, LOW);        // sets the digital pin 2 low
  delay(500);

  int Str2CommaIndex1 = Str2.indexOf(",");//Current
  int Str2CommaIndex2 = Str2.indexOf(",",Str2CommaIndex1+1);//Temp
  //BatLvl

  float Current = (Str2.substring(1,Str2CommaIndex1)).toFloat();
  float Temp = (Str2.substring(Str2CommaIndex1+1,Str2CommaIndex2)).toFloat();
  int BatLvl = (Str2.substring(Str2CommaIndex2+1,Str2.length()-1)).toInt();
  batt_display.showNumberDec(BatLvl, false);

  if(Timer == true)
  {
    long Elasped_Time = 2400-((millis()-Start_Time)/1000);
    int minutes = numberOfMinutes(Elasped_Time);
    int seconds = numberOfSeconds(Elasped_Time);
    time_display.showNumberDec((minutes*100)+seconds, false);
  }

  long val = millis()/1000;
  int hours = numberOfHours(val);
  int minutes = numberOfMinutes(val);
  int seconds = numberOfSeconds(val);
  String Time = String(hours) + "h " + String(minutes) + "m " + String(seconds) + "s ";

  myFile = SD.open("TEST.txt", FILE_WRITE);
  myFile.println(String(Time)+","+String(BatLvl)+","+String(Speed)+","+String(Lat)+","+String(Long)+","+String(AccX)+","+String(AccY)+","+String(AccZ)+","+String(Pitch)+","+String(Yaw)+","+String(Roll)+","+String(Current)+","+String(Temp));

  myFile.close();
}

void Start_Timer() {
  Start_Time = millis();
  Timer = true;
}

void Lap_Count() {
  Lap_Counter = Lap_Counter - 1;
  if(Lap_Counter < 0)
  {
    Lap_Counter = NoOfLaps;
  }
  lap_display.showNumberDec(Lap_Counter, false);
}