Extra inputs for Devo Tx's

// PPM Encoder Analog Add-ons for Devo7e
// For use with Arduino Pro Mini 328P
// J. Diehl 04/08/2015
// Based on a sketch by Ian Johnston 29/04/2010
//  modified by Epyon and Cereal_Killer
// Version 2.0 
// Low cost way to add extra POT's to any radio that accepts PPM input for <$15
//  using an arduino nano and a few POT's, visit DeviationTX.com for info. 
// POT's on A1 and A2, optional Thumbwheel on A3, optional switches on D6-D10
// PPM output on D13
//  PPM inout to tip of 3.5 stereo, this is the black wire on your Devo 7E
//  Ring Shunt on D11 when shorted indicate DSC port in use (e.g. Plug inserted)
//  this will stop monitoring the inputs and outputs until these are no longer shorted
//
//  Original Sketch uses:
//  A1-3 Analog in for Pots 1, 2 and 3
//  D6-10 Digital in for up to 5 switches
//  D11 - Devo7e DSC Port "Ring Shunt"  high; goes low when plug is inserted into DSC
//  D13 - PPM Output with LED


int potPin_A1= A1;  //Declare potPin_A1 to be analog pin A1
int potPin_A2= A2;  //Declare potPin_A2 to be analog pin A2
int potPin_A3= A3;  //Declare potPin_A3 to be analog pin A3
int AI_Raw_A1;        // Analog In raw var - 0->1023
int AI_Raw_A2;        // Analog In raw var - 0->1023
int AI_Raw_A3;        // Analog In raw var - 0->1023
int A1_uS = 750;     // Analog 1 uS var
int A2_uS = 750;     // Analog 2 uS var
int A3_uS = 750;     // Analog 3 uS var

int swPin_D1= 6;   //Declare swPin_D1 to be Digital pin 6
int swPin_D2= 7;   //Declare swPin_D2 to be Digital pin 7
int swPin_D3= 8;   //Declare swPin_D3 to be Digital pin 8
int swPin_D4= 9;   //Declare swPin_D4 to be Digital pin 9
int swPin_D5= 10;  //Declare swPin_D5 to be Digital pin 10
int sw1_uS = 750;     // Switch 1
int sw2_uS = 750;     // Switch 2
int sw3_uS = 750;     // Switch 3
int sw4_uS = 750;     // Switch 4 // not used
int sw5_uS = 750;     // Switch 5 // not used

int rshPin = 11; // DSC Ring Shunt ping goes to ground when DSC in use
int rshPinState;
 String rshPinStr; // debug

int outPinPPM = 13;  // Declare ppmPin to be arduino pin 13

int Fixed_uS = 300;       // PPM frame fixed LOW phase
int pulseMin = 750;          // pulse minimum width minus start in uS
int pulseMax = 1700;      // pulse maximum width in uS

ISR(TIMER1_COMPA_vect) {
    ppmoutput(); // Jump to ppmoutput subroutine
}


void setup() {
  pinMode(potPin_A1, INPUT);  //set potPin_A1 to be an input
  pinMode(potPin_A2, INPUT);  //set potPin_A2 to be an input
  pinMode(potPin_A3, INPUT);  //set potPin_A3 to be an input
  pinMode(swPin_D1, INPUT);  //set swPin_D1 to be an input
  digitalWrite(swPin_D1, HIGH);  // turn on pull-up resistor
  pinMode(swPin_D2, INPUT);  //set swPin_D2 to be an input
  digitalWrite(swPin_D2, HIGH);  // turn on pull-up resistor
  pinMode(swPin_D3, INPUT);  //set swPin_D3 to be an input
  digitalWrite(swPin_D3, HIGH);  // turn on pull-up resistor

//  pinMode(rngPin, INPUT);  //set rngPin to be an input - not used
  pinMode(rshPin, INPUT);  //set rshPin to be an input - do not initialize here
//  digitalWrite(rshPin, HIGH);
  pinMode(outPinPPM, OUTPUT); //set ppmPin to be an OUTPUT
  digitalWrite(outPinPPM, HIGH); // turn on LED

//  rshPinStr = "RSH: "; // debug string

     // Setup timer
  TCCR1A = B00110001; // Compare register B used in mode '3'
  TCCR1B = B00010010; // WGM13 and CS11 set to 1
  TCCR1C = B00000000; // All set to 0
  TIMSK1 = B00000010; // Interrupt on compare B
  TIFR1  = B00000010; // Interrupt on compare B
  OCR1A = 22000; // 22mS PPM output refresh
  OCR1B = 1000;


  Serial.begin(9600);      // turn on Serial Port

}

void ppmoutput() { // PPM output sub

if (rshPinState == HIGH) {

 // Channel 1 - Analog 1
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(A1_uS);  // Hold for A1_uS microseconds 

 // Channel 2 - Analog 2
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(A2_uS);  // Hold for A2_uS microseconds 

 // Channel 3 - Analog 3
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(A3_uS);  // Hold for A3_uS microseconds 

// Channel 4 - Switch 1
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw1_uS);     // Hold for sw1_uS microseconds 

// Channel 5 - Switch 2
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw2_uS);     // Hold for sw2_uS microseconds 

// Channel 6 - Switch 3
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw3_uS);     // Hold for sw3_uS microseconds 

// Channel 7 - Switch 4
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw4_uS);     // Hold for sw4_uS microseconds 

// Channel 8 - Switch 5
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw5_uS);     // Hold for sw5_uS microseconds 

 // Synchro pulse
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);  // Start Synchro pulse

//  Serial.println(rshPinStr + rshPinState);
/* Serial.print("You are writing a value of ");  //for debugging print your values
 Serial.print(A1_uS);
 Serial.print("  ");
 Serial.print(A2_uS);
 Serial.print("  ");
 Serial.print(A3_uS);
 Serial.print("  ");
 Serial.print(sw1_uS);
 Serial.print("  ");
 Serial.print(sw2_uS);
 Serial.print("  ");
 Serial.print(sw3_uS);
 Serial.print("  ");
 Serial.print(sw4_uS);
 Serial.print("  ");
 Serial.print(sw5_uS);
 Serial.print("  ");

 Serial.println(" End");
*/
}
 else {
//  Serial.println(rshPinStr + rshPinState);
 }
}


void loop() {

// logic used to determine if the DSC port has a plug inserted
//   set pin 11 to HIGH until it is LOW
//   this will indicate that there is a plug in the DSC jack
//

//  digitalWrite(rshPin, HIGH);
  rshPinState = digitalRead(rshPin);

// logic to read each analog input

 // Read analog pins
   AI_Raw_A1 = analogRead(potPin_A1); // Analog Pot 1
   AI_Raw_A2 = analogRead(potPin_A2); // Analog Pot 2
   AI_Raw_A3 = analogRead(potPin_A3); // Thumbwheel Pot 3
   
 // Map analog inputs to PPM rates for each of the channels
   A1_uS = AI_Raw_A1 + pulseMin;
   A2_uS = AI_Raw_A2 + pulseMin;
   A3_uS = AI_Raw_A3 + pulseMin;

 // Check limits
  if (A1_uS <= 750) A1_uS = 750;     // Min
  if (A1_uS >= 1700) A1_uS = 1700;   // Max   
  if (A2_uS <= 750) A2_uS = 750;   // Min
  if (A2_uS >= 1700) A2_uS = 1700; // Max 
  if (A3_uS <= 750) A3_uS = 750;   // Min
  if (A3_uS >= 1700) A3_uS = 1700; // Max 

  if (digitalRead(swPin_D1) == 1) { // Switch 1  
           sw1_uS = 1700;
 } else {
           sw1_uS = 750;
 }
  if (digitalRead(swPin_D2) == 1) { // Switch 2  
           sw2_uS = 1700;
 } else {
           sw2_uS = 750;
 }
  if (digitalRead(swPin_D3) == 1) { // Switch 3  
           sw3_uS = 1700;
 } else {
           sw3_uS = 750;
 }
  if (digitalRead(swPin_D4) == 1) { // Switch 4  
           sw4_uS = 1700;
 } else {
           sw4_uS = 750;
 }
  if (digitalRead(swPin_D5) == 1) { // Switch 5  
           sw5_uS = 1700;
 } else {
           sw5_uS = 750;
 }
}

// Devo 7e PPM input
// For use with Arduino Nano V3.0
// Based on sketch by Ian Johnston

int AI_Pin_A1 = 1;    // Analog In 1
int AI_Pin_A2 = 2;    // Analog In 2
int AI_Raw_A1;        // Analog In raw var - 0->1023
int AI_Raw_A2;        // Analog In raw var - 0->1023
int A1_uS = 750;     // Analog 1 uS var
int A2_uS = 750;     // Analog 2 uS var
int sw1_uS = 750;     // 6-way switch
int sw2_uS = 750;     // 3-way switch pos 0
int sw3_uS = 750;     // 3-way switch pos 1
int sw4_uS = 750;     // 3-way switch pos 2

int Fixed_uS = 300;       // PPM frame fixed LOW phase
int pulseMin = 750;       // pulse minimum width minus start in uS
int pulseMax = 1700;      // pulse maximum width in uS

int outPinPPM = 10;       // PPM out on digital pin 10
int inPinD1 = 2;        // 6-way inputs: digital pin 2
int inPinD2 = 3;        // digital pin 3
int inPinD3 = 4;        // digital pin 4
int inPinD4 = 5;        // digital pin 5
int inPinD5 = 6;        // digital pin 6
int inPinD6 = 7;        // digital pin 7
int inPinD7 = 8;        // 3-way inputs: digital pin 8
int inPinD8 = 9;        // digital pin 9

int piezoPin = 13;        // piezo buzzer on digital pin 13

boolean Beep1 = false;
boolean Beep2 = false;
boolean Beep3 = false;
boolean Beep4 = false;
boolean Beep5 = false;
boolean Beep6 = false;

ISR(TIMER1_COMPA_vect) {
    ppmoutput(); // Jump to ppmoutput subroutine
}

void setup() {

  // Serial.begin(9600) ; // Test

  pinMode(outPinPPM, OUTPUT);   // sets the digital pin as output
  pinMode(inPinD1, INPUT);      // sets the digital pin as input
  digitalWrite(inPinD1, HIGH);  // turn on pull-up resistor
  pinMode(inPinD2, INPUT);
  digitalWrite(inPinD2, HIGH);
  pinMode(inPinD3, INPUT);
  digitalWrite(inPinD3, HIGH);
  pinMode(inPinD4, INPUT);
  digitalWrite(inPinD4, HIGH);
  pinMode(inPinD5, INPUT);
  digitalWrite(inPinD5, HIGH);
  pinMode(inPinD6, INPUT);
  digitalWrite(inPinD6, HIGH);
  pinMode(inPinD7, INPUT);
  digitalWrite(inPinD7, HIGH);
  pinMode(inPinD8, INPUT);
  digitalWrite(inPinD8, HIGH);

   // Setup timer
  TCCR1A = B00110001; // Compare register B used in mode '3'
  TCCR1B = B00010010; // WGM13 and CS11 set to 1
  TCCR1C = B00000000; // All set to 0
  TIMSK1 = B00000010; // Interrupt on compare B
  TIFR1  = B00000010; // Interrupt on compare B
  OCR1A = 22000; // 22mS PPM output refresh
  OCR1B = 1000;
  
}


void ppmoutput() { // PPM output sub

 // Channel 1 - Analog 1
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(A1_uS);  // Hold for A1_uS microseconds      

 // Channel 2 - Analog 2
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(A2_uS); // Hold for A2_uS microseconds      

// Channel 3 - 6-way switch
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw1_uS);     // Hold for sw1_uS microseconds 

// Channel 4 - 3-way switch pos 0
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw2_uS);     // Hold for sw2_uS microseconds 

// Channel 5 - 3-way switch pos 1
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw3_uS);     // Hold for sw3_uS microseconds 
  
// Channel 6 - 3-way switch pos 2
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw4_uS);     // Hold for sw4_uS microseconds 

// Synchro pulse
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);  // Start Synchro pulse

}


void loop() { // Main loop

 // Read analog pins
   AI_Raw_A1 = analogRead(AI_Pin_A1);
   AI_Raw_A2 = analogRead(AI_Pin_A2);
   
 // Map analog inputs to PPM rates for each of the channels
   A1_uS = AI_Raw_A1 + pulseMin;
   A2_uS = AI_Raw_A2 + pulseMin;

 // Check limits
  if (A1_uS <= 750) A1_uS = 750;     // Min
  if (A1_uS >= 1700) A1_uS = 1700;   // Max   
  if (A2_uS <= 750) A2_uS = 750;   // Min
  if (A2_uS >= 1700) A2_uS = 1700; // Max 
  
  if (digitalRead(inPinD1) == 0) { // Switch 1  
           sw1_uS = 750;
      if (Beep1 == false)
       tone(piezoPin, 2850, 50);
       delay(50);
       Beep1 = true;
 } else {
        noTone(piezoPin);
        Beep1 = false;
 }
  if (digitalRead(inPinD2) == 0) { // Switch 2  
           sw1_uS = 910;
      if (Beep2 == false)
       tone(piezoPin, 2850, 50);
       delay(50);
       Beep2 = true;
 } else {
        noTone(piezoPin);
        Beep2 = false;
 }
  if (digitalRead(inPinD3) == 0) { // Switch 3  
           sw1_uS = 1120;
           if (Beep3 == false)
       tone(piezoPin, 2850, 50);
       delay(50);
       Beep3 = true;
 } else {
        noTone(piezoPin);
        Beep3 = false;
 }
  if (digitalRead(inPinD4) == 0) { // Switch 4  
           sw1_uS = 1330;
           if (Beep4 == false)
       tone(piezoPin, 2850, 50);
       delay(50);
       Beep4 = true;
 } else {
        noTone(piezoPin);
        Beep4 = false;
 }
  if (digitalRead(inPinD5) == 0) { // Switch 5  
           sw1_uS = 1540;
           if (Beep5 == false)
       tone(piezoPin, 2850, 50);
       delay(50);
       Beep5 = true;
 } else {
        noTone(piezoPin);
        Beep5 = false;
 }
  if (digitalRead(inPinD6) == 0) { // Switch 6 
           sw1_uS = 1700;
           tone(piezoPin, 2850, 100);
           delay(100);
           tone(piezoPin, 2700, 100);
           delay(100);
           tone(piezoPin, 2600, 100);
           delay(100);
 } 
  if (digitalRead(inPinD7) == 0) { // Switch 7
           sw2_uS = 750;     
 } else {
           sw2_uS = 1700;  
 }
  if ((digitalRead(inPinD7) == 1) && (digitalRead(inPinD8) == 1)) { // Switch 8
           sw3_uS = 750;             
 } else {
           sw3_uS = 1700;  
 }
  if (digitalRead(inPinD8) == 0) { // Switch 9
           sw4_uS = 750;            
 } else {
           sw4_uS = 1700;  
 }
}