Extra inputs for Devo Tx's

if (digitalRead(swPin_D1) != 1) { // 3-way Switch 1
           sw1_uS = pulseMin;
  } else {
           if (digitalRead(swPin_D2) != 1 ) {
            sw1_uS = pulseMax;
  }        else {
            sw1_uS = pulseMid;
            }
  }

// 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 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 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 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 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
int pulseMid = 1180;      // pulse midpoint 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(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(swPin_D4, INPUT);  //set swPin_D4 to be an input
  digitalWrite(swPin_D4, HIGH);  // turn on pull-up resistor

  pinMode(outPinPPM, OUTPUT); //set ppmPin to be an OUTPUT
  digitalWrite(outPinPPM, HIGH); // turn on LED


     // 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


 // 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 - Switch 1
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw1_uS);     // Hold for sw1_uS microseconds 

// Channel 4 - Switch 3
  digitalWrite(outPinPPM, LOW);
  delayMicroseconds(Fixed_uS);    // Hold
  digitalWrite(outPinPPM, HIGH);
  delayMicroseconds(sw3_uS);     // Hold for sw2_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(sw1_uS);
 Serial.print("  ");
 Serial.print(sw2_uS);
 Serial.print("  ");
 Serial.print(sw3_uS);
 Serial.print("  ");
 Serial.print(sw4_uS);
 Serial.print("  ");

 Serial.println(" End");
*/
}

void loop() {


// 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
   
 // 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(swPin_D1) != 1) { // 3-way Switch 1
           sw1_uS = pulseMin;
  } else {
           if (digitalRead(swPin_D2) != 1 ) {
            sw1_uS = pulseMax;
  }        else {
            sw1_uS = pulseMid;
            }
  }
  if (digitalRead(swPin_D3) != 1) { // 3-way Switch 2
           sw3_uS = pulseMin;
  } else {
           if (digitalRead(swPin_D4) != 1 ) {
            sw3_uS = pulseMax;
  }        else {
            sw3_uS = pulseMid;
            }
  }
}

// Devo 7e PPM input
// Adapted for Digispark
// Based on sketch by Ian Johnston 
// Based on sketch adaption by Epyon for Arduino Nano V3.0

int AI_Pin_A1 = 2;    // Analog In 1
int AI_Pin_A2 = 3;    // 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 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 = 0;       // PPM out on digital pin 0

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

void setup() {

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

  pinMode(outPinPPM, OUTPUT);   // sets the digital pin as output

   // 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      

// 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 = 1620;   // Max   
  if (A2_uS <= 750) A2_uS = 750;   // Min
  if (A2_uS >= 1700) A2_uS = 1620; // Max 
}