From 467a1866ca64ed9dca59054bae068fc15d43b50c Mon Sep 17 00:00:00 2001 From: Geoff Bunza Date: Fri, 18 Dec 2015 11:16:40 -0800 Subject: [PATCH] Bug fix line 625- missing break statement added --- ...ecoder_15ServosReleased_2LED_4Function.ino | 1279 +++++++++-------- 1 file changed, 640 insertions(+), 639 deletions(-) diff --git a/examples/SMA/AccessoryDecoder_15ServosReleased_2LED_4Function/AccessoryDecoder_15ServosReleased_2LED_4Function.ino b/examples/SMA/AccessoryDecoder_15ServosReleased_2LED_4Function/AccessoryDecoder_15ServosReleased_2LED_4Function.ino index dbe2375..eac379c 100755 --- a/examples/SMA/AccessoryDecoder_15ServosReleased_2LED_4Function/AccessoryDecoder_15ServosReleased_2LED_4Function.ino +++ b/examples/SMA/AccessoryDecoder_15ServosReleased_2LED_4Function/AccessoryDecoder_15ServosReleased_2LED_4Function.ino @@ -1,640 +1,641 @@ -// Production 17 Function DCC Acessory Decoder Dual Address w/CV Access -// Version 4.0 Geoff Bunza 2014 -// Uses modified software servo Lib -// -// ******** UNLESS YOU WANT ALL CV'S RESET UPON EVERY POWER UP -// ******** AFTER THE INITIAL DECODER LOAD REMOVE THE "//" IN THE FOOLOWING LINE!! -//#define DECODER_LOADED - -#include -#include - -SoftwareServo servo0; -SoftwareServo servo1; -SoftwareServo servo2; -SoftwareServo servo3; -SoftwareServo servo4; -SoftwareServo servo5; -SoftwareServo servo6; -SoftwareServo servo7; -SoftwareServo servo8; -SoftwareServo servo9; -SoftwareServo servo10; -SoftwareServo servo11; -SoftwareServo servo12; -SoftwareServo servo13; -SoftwareServo servo14; -SoftwareServo servo15; -SoftwareServo servo16; -#define servo_start_delay 50 -#define servo_init_delay 7 - -int tim_delay = 500; -int numfpins = 17; -byte fpins [] = {3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19}; -const int FunctionPin0 = 3; -const int FunctionPin1 = 4; -const int FunctionPin2 = 5; -const int FunctionPin3 = 6; -const int FunctionPin4 = 7; -const int FunctionPin5 = 8; -const int FunctionPin6 = 9; -const int FunctionPin7 = 10; -const int FunctionPin8 = 11; -const int FunctionPin9 = 12; -const int FunctionPin10 = 13; -const int FunctionPin11 = 14; //A0 -const int FunctionPin12 = 15; //A1 -const int FunctionPin13 = 16; //A2 -const int FunctionPin14 = 17; //A3 -const int FunctionPin15 = 18; //A4 -const int FunctionPin16 = 19; //A5 -NmraDcc Dcc ; -DCC_MSG Packet ; - -int t; // temp -#define SET_CV_Address 24 // THIS ADDRESS IS FOR SETTING CV'S Like a Loco -#define Accessory_Address 40 // THIS ADDRESS IS THE START OF THE SWITCHES RANGE - // WHICH WILL EXTEND FOR 16 MORE SWITCH ADDRESSES -uint8_t CV_DECODER_MASTER_RESET = 120; // THIS IS THE CV ADDRESS OF THE FULL RESET -#define CV_To_Store_SET_CV_Address 121 -#define CV_Accessory_Address CV_ACCESSORY_DECODER_ADDRESS_LSB - -struct QUEUE -{ - int inuse; - int current_position; - int increment; - int stop_value; - int start_value; -}; -QUEUE *ftn_queue = new QUEUE[16]; - -struct CVPair -{ - uint16_t CV; - uint8_t Value; -}; -CVPair FactoryDefaultCVs [] = -{ - {CV_ACCESSORY_DECODER_ADDRESS_LSB, Accessory_Address}, - {CV_ACCESSORY_DECODER_ADDRESS_MSB, 0}, - {CV_MULTIFUNCTION_EXTENDED_ADDRESS_MSB, 0}, - {CV_MULTIFUNCTION_EXTENDED_ADDRESS_LSB, 0}, - {CV_DECODER_MASTER_RESET, 0}, - {CV_To_Store_SET_CV_Address, SET_CV_Address}, - {CV_To_Store_SET_CV_Address+1, 0}, - {30, 2}, //F0 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {31, 1}, //F0 Rate Blink=Eate,PWM=Rate,Servo=Rate - {32, 28}, //F0 Start Position F0=0 - {33, 140}, //F0 End Position F0=1 - {34, 28}, //F0 Current Position - {35, 2}, //F1 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {36, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {37, 28}, // Start Position Fx=0 - {38, 140}, // End Position Fx=1 - {39, 28}, // Current Position - {40, 2}, //F2 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {41, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {42, 28}, // Start Position Fx=0 - {43, 140}, // End Position Fx=1 - {44, 28}, // Current Position - {45, 2}, //F3 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {46, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {47, 28}, // Start Position Fx=0 - {48, 140}, // End Position Fx=1 - {49, 28}, // Current Position - {50, 2}, //F4 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {51, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {52, 28}, // Start Position Fx=0 - {53, 140}, // End Position Fx=1 - {54, 28}, // Current Position - {55, 2}, //F5 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {56, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {57, 28}, // Start Position Fx=0 - {58, 140}, // End Position Fx=1 - {59, 28}, // Current Position - {60, 2}, //F6 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {61, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {62, 28}, // Start Position Fx=0 - {63, 140}, // End Position Fx=1 - {64, 28}, // Current Position - {65, 2}, //F7 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {66, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {67, 28}, // Start Position Fx=0 - {68, 140}, // End Position Fx=1 - {69, 28}, // Current Position - {70, 2}, //F8 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {71, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {72, 28}, // Start Position Fx=0 - {73, 140}, // End Position Fx=1 - {74, 28}, // Current Position - {75, 2}, //F9 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {76, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {77, 28}, // Start Position Fx=0 - {78, 140}, // End Position Fx=1 - {79, 28}, // Current Position - {80, 2}, //F10 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {81, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {82, 28}, // Start Position Fx=0 - {83, 140}, // End Position Fx=1 - {84, 28}, // Current Position - {85, 2}, //F11 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {86, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {87, 28}, // Start Position Fx=0 - {88, 140}, // End Position Fx=1 - {89, 28}, // Current Position - {90, 2}, //F12 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {91, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {92, 28}, // Start Position Fx=0 - {93, 140}, // End Position Fx=1 - {94, 28}, // Current Position - {95, 2}, //F13 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {96, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {97, 28}, // Start Position Fx=0 - {98, 140}, // End Position Fx=1 - {99, 28}, // Current Position - {100, 2}, //F14 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {101, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {102, 28}, // Start Position Fx=0 - {103, 140}, // End Position Fx=1 - {104, 28}, // Current Position - {105, 1}, //F15 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {106, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {107, 1}, // Start Position Fx=0 - {108, 10}, // End Position Fx=1 - {109, 1}, // Current Position - {110, 0}, //F16 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {111, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {112, 1}, // Start Position Fx=0 - {113, 10}, // End Position Fx=1 - {114, 1}, // Current Position -//FUTURE USE - {115, 0}, //F17 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - {116, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate - {117, 28}, // Start Position Fx=0 - {118, 50}, // End Position Fx=1 - {119, 28}, // Current Position -}; -uint8_t FactoryDefaultCVIndex = sizeof(FactoryDefaultCVs)/sizeof(CVPair); - -void setup() //****************************************************** -{ - int i; - uint8_t cv_value; - Serial.begin(115200); - // initialize the digital pins as outputs - for (int i=0; i < numfpins; i++) { - pinMode(fpins[i], OUTPUT); - digitalWrite(fpins[i], 0); - } - for (int i=0; i < numfpins; i++) { - digitalWrite(fpins[i], 1); - delay (tim_delay/10); - } - delay( tim_delay); - for (int i=0; i < numfpins; i++) { - digitalWrite(fpins[i], 0); - delay (tim_delay/10); - } - delay( tim_delay); - - // Setup which External Interrupt, the Pin it's associated with that we're using - Dcc.pin(0, 2, 0); - // Call the main DCC Init function to enable the DCC Receiver - Dcc.init( MAN_ID_DIY, 100, FLAGS_OUTPUT_ADDRESS_MODE | FLAGS_DCC_ACCESSORY_DECODER, CV_To_Store_SET_CV_Address); - delay(800); - - #if defined(DECODER_LOADED) - if ( Dcc.getCV(CV_DECODER_MASTER_RESET)== CV_DECODER_MASTER_RESET ) - #endif - - { - for (int j=0; j < sizeof(FactoryDefaultCVs)/sizeof(CVPair); j++ ) - Dcc.setCV( FactoryDefaultCVs[j].CV, FactoryDefaultCVs[j].Value); - digitalWrite(fpins[14], 1); - delay (1000); - digitalWrite(fpins[14], 0); - } - for ( i=0; i < numfpins; i++) { - cv_value = Dcc.getCV( 30+(i*5)) ; - //Serial.print(" cv_value: "); - //Serial.println(cv_value, DEC) ; - switch ( cv_value ) { - case 0: // LED on/off - ftn_queue[i].inuse = 0; - break; - case 1: // LED Blink - { - ftn_queue[i].inuse = 0; - ftn_queue[i].current_position = 0; - ftn_queue[i].start_value = 0; - ftn_queue[i].increment = int (char (Dcc.getCV( 31+(i*5)))); - digitalWrite(fpins[i], 0); - ftn_queue[i].stop_value = int(Dcc.getCV( 33+(i*5))) ; - } - break; - case 2: //servo - { ftn_queue[i].current_position =int (Dcc.getCV( 34+(i*5))); - ftn_queue[i].stop_value = int (Dcc.getCV( 33+(i*5))); - ftn_queue[i].start_value = int (Dcc.getCV( 32+(i*5))); - ftn_queue[i].increment = -int (char (Dcc.getCV( 31+(i*5)))); - switch ( i ) { - case 0: servo0.attach(FunctionPin0); // attaches servo on pin to the servo object - ftn_queue[i].inuse = 1; - servo0.write(ftn_queue[i].start_value); - for (t=0; t ftn_queue[i].stop_value) { - ftn_queue[i].start_value = ~ftn_queue[i].start_value; - digitalWrite(fpins[i], ftn_queue[i].start_value); - ftn_queue[i].current_position = 0; - ftn_queue[i].stop_value = int(Dcc.getCV( 33+(i*5))); - } - break; - case 2: - { - if (ftn_queue[i].increment > 0) { - if (ftn_queue[i].current_position > ftn_queue[i].stop_value) { - ftn_queue[i].current_position = ftn_queue[i].stop_value; - servo_on = false; - detach_servo (i); - } - } - if (ftn_queue[i].increment < 0) { - if (ftn_queue[i].current_position < ftn_queue[i].start_value) { - ftn_queue[i].current_position = ftn_queue[i].start_value; - servo_on = false; - detach_servo (i); - } - } - if (servo_on) { - set_servo(i, ftn_queue[i].current_position); - } - } - break; - case 3: - if (ftn_queue[i].current_position > ftn_queue[i].stop_value) { - ftn_queue[i].start_value = ~ftn_queue[i].start_value; - digitalWrite(fpins[i], ftn_queue[i].start_value); - digitalWrite(fpins[i]+1, ~ftn_queue[i].start_value); - ftn_queue[i].current_position = 0; - ftn_queue[i].stop_value = int(Dcc.getCV( 33+(i*5))); - } - i++; - break; - case 4: //FUTURE FUNCTION - break; - default: - break; - } - } - } -} - -extern void notifyDccAccState( uint16_t Addr, uint16_t BoardAddr, uint8_t OutputAddr, uint8_t State) { - uint16_t Current_Decoder_Addr; - uint8_t Bit_State; - Current_Decoder_Addr = Dcc.getAddr(); - Bit_State = OutputAddr & 0x01; - - if ( Addr >= Current_Decoder_Addr || Addr < Current_Decoder_Addr+17) { //Controls Accessory_Address+16 - switch (Addr-Current_Decoder_Addr) { - case 0: exec_function( 0, FunctionPin0, Bit_State ); - break; - case 1: exec_function( 1, FunctionPin1, Bit_State ); - break; - case 2: exec_function( 2, FunctionPin2, Bit_State ); - break; - case 3: exec_function( 3, FunctionPin3, Bit_State ); - break; - case 4: exec_function( 4, FunctionPin4, Bit_State ); - break; - case 5: exec_function( 5, FunctionPin5, Bit_State ); - break; - case 6: exec_function( 6, FunctionPin6, Bit_State ); - break; - case 7: exec_function( 7, FunctionPin7, Bit_State ); - break; - case 8: exec_function( 8, FunctionPin8, Bit_State ); - break; - case 9: exec_function( 9, FunctionPin9, Bit_State ); - break; - case 10: exec_function( 10, FunctionPin10, Bit_State ); - break; - case 11: exec_function( 11, FunctionPin11, Bit_State ); - break; - case 12: exec_function( 12, FunctionPin12, Bit_State ); - break; - case 13: exec_function( 13, FunctionPin13, Bit_State ); - break; - case 14: exec_function( 14, FunctionPin14, Bit_State ); - break; - case 15: exec_function( 15, FunctionPin15, Bit_State ); - break; - case 16: exec_function( 16, FunctionPin16, Bit_State ); - break; - default: - break; - } - } -} -void exec_function (int function, int pin, int FuncState) { - switch ( Dcc.getCV( 30+(function*5)) ) { // Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink - case 0: // On - Off LED - digitalWrite (pin, FuncState); - ftn_queue[function].inuse = 0; - break; - case 1: // Blinking LED - if ((ftn_queue[function].inuse==0) && (FuncState==1)) { - ftn_queue[function].inuse = 1; - ftn_queue[function].start_value = 0; - digitalWrite(pin, 0); - ftn_queue[function].stop_value = int(Dcc.getCV( 33+(function*5))); - } else { - if ((ftn_queue[function].inuse==1) && (FuncState==0)) { - ftn_queue[function].inuse = 0; - digitalWrite(pin, 0); - } - } - break; - case 2: // Servo - ftn_queue[function].inuse = 1; - if (FuncState==1) ftn_queue[function].increment = char ( Dcc.getCV( 31+(function*5))); - else ftn_queue[function].increment = - char(Dcc.getCV( 31+(function*5))); - if (FuncState==1) ftn_queue[function].stop_value = Dcc.getCV( 33+(function*5)); - else ftn_queue[function].stop_value = Dcc.getCV( 32+(function*5)); - break; - case 3: // Blinking LED PAIR - if ((ftn_queue[function].inuse==0) && (FuncState==1)) { - ftn_queue[function].inuse = 1; - ftn_queue[function].start_value = 0; - digitalWrite(fpins[function], 0); - digitalWrite(fpins[function+1], 1); - ftn_queue[function].stop_value = int(Dcc.getCV( 33+(function*5))); - } else { - if (FuncState==0) { - ftn_queue[function].inuse = 0; - digitalWrite(fpins[function], 0); - digitalWrite(fpins[function+1], 0); - } - } - break; - case 4: // Future Function - ftn_queue[function].inuse = 0; - break; - default: - ftn_queue[function].inuse = 0; - break; - } -} -void set_servo (int servo_num, int servo_pos) { - switch (servo_num) { - case 0: - if (servo0.attached()==0) servo0.attach(FunctionPin0); - servo0.write(servo_pos); - break; - case 1: - if (servo1.attached()==0) servo1.attach(FunctionPin1); - servo1.write(servo_pos); - break; - case 2: - if (servo2.attached()==0) servo2.attach(FunctionPin2); - servo2.write(servo_pos); - break; - case 3: - if (servo3.attached()==0) servo3.attach(FunctionPin3); - servo3.write(servo_pos); - break; - case 4: - if (servo4.attached()==0) servo4.attach(FunctionPin4); - servo4.write(servo_pos); - break; - case 5: - if (servo5.attached()==0) servo5.attach(FunctionPin5); - servo5.write(servo_pos); - break; - case 6: - if (servo6.attached()==0) servo6.attach(FunctionPin6); - servo6.write(servo_pos); - break; - case 7: - if (servo7.attached()==0) servo7.attach(FunctionPin7); - servo7.write(servo_pos); - break; - case 8: - if (servo8.attached()==0) servo8.attach(FunctionPin8); - servo8.write(servo_pos); - break; - case 9: - if (servo9.attached()==0) servo9.attach(FunctionPin9); - servo9.write(servo_pos); - break; - case 10: - if (servo10.attached()==0) servo10.attach(FunctionPin10); - servo10.write(servo_pos); - break; - case 11: - if (servo11.attached()==0) servo11.attach(FunctionPin11); - servo11.write(servo_pos); - break; - case 12: - if (servo12.attached()==0) servo12.attach(FunctionPin12); - servo12.write(servo_pos); - case 13: - if (servo13.attached()==0) servo13.attach(FunctionPin13); - servo13.write(servo_pos); - break; - case 14: - if (servo14.attached()==0) servo12.attach(FunctionPin14); - servo14.write(servo_pos); - break; - case 15: - if (servo15.attached()==0) servo15.attach(FunctionPin15); - servo15.write(servo_pos); - break; - case 16: - if (servo16.attached()==0) servo16.attach(FunctionPin16); - servo16.write(servo_pos); - break; - default: - break; - } -} -void detach_servo (int servo_num) { - switch (servo_num) { - case 0: - if (servo0.attached()!=0) servo0.detach(); - break; - case 1: - if (servo1.attached()!=0) servo1.detach(); - break; - case 2: - if (servo2.attached()!=0) servo2.detach(); - break; - case 3: - if (servo3.attached()!=0) servo3.detach(); - break; - case 4: - if (servo4.attached()!=0) servo4.detach(); - break; - case 5: - if (servo5.attached()!=0) servo5.detach(); - break; - case 6: - if (servo6.attached()!=0) servo6.detach(); - break; - case 7: - if (servo7.attached()!=0) servo7.detach(); - break; - case 8: - if (servo8.attached()!=0) servo8.detach(); - break; - case 9: - if (servo9.attached()!=0) servo9.detach(); - break; - case 10: - if (servo10.attached()!=0) servo10.detach(); - break; - case 11: - if (servo11.attached()!=0) servo11.detach(); - break; - case 12: - if (servo12.attached()!=0) servo12.detach(); - case 13: - if (servo13.attached()!=0) servo13.detach(); - break; - case 14: - if (servo14.attached()!=0) servo12.detach(); - break; - case 15: - if (servo15.attached()!=0) servo15.detach(); - break; - case 16: - if (servo16.attached()!=0) servo16.detach(); - break; - default: - break; - } +// Production 17 Function DCC Acessory Decoder Dual Address w/CV Access +// Version 4.0 Geoff Bunza 2014 +// Uses modified software servo Lib +// +// ******** UNLESS YOU WANT ALL CV'S RESET UPON EVERY POWER UP +// ******** AFTER THE INITIAL DECODER LOAD REMOVE THE "//" IN THE FOOLOWING LINE!! +//#define DECODER_LOADED + +#include +#include + +SoftwareServo servo0; +SoftwareServo servo1; +SoftwareServo servo2; +SoftwareServo servo3; +SoftwareServo servo4; +SoftwareServo servo5; +SoftwareServo servo6; +SoftwareServo servo7; +SoftwareServo servo8; +SoftwareServo servo9; +SoftwareServo servo10; +SoftwareServo servo11; +SoftwareServo servo12; +SoftwareServo servo13; +SoftwareServo servo14; +SoftwareServo servo15; +SoftwareServo servo16; +#define servo_start_delay 50 +#define servo_init_delay 7 + +int tim_delay = 500; +int numfpins = 17; +byte fpins [] = {3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19}; +const int FunctionPin0 = 3; +const int FunctionPin1 = 4; +const int FunctionPin2 = 5; +const int FunctionPin3 = 6; +const int FunctionPin4 = 7; +const int FunctionPin5 = 8; +const int FunctionPin6 = 9; +const int FunctionPin7 = 10; +const int FunctionPin8 = 11; +const int FunctionPin9 = 12; +const int FunctionPin10 = 13; +const int FunctionPin11 = 14; //A0 +const int FunctionPin12 = 15; //A1 +const int FunctionPin13 = 16; //A2 +const int FunctionPin14 = 17; //A3 +const int FunctionPin15 = 18; //A4 +const int FunctionPin16 = 19; //A5 +NmraDcc Dcc ; +DCC_MSG Packet ; + +int t; // temp +#define SET_CV_Address 24 // THIS ADDRESS IS FOR SETTING CV'S Like a Loco +#define Accessory_Address 40 // THIS ADDRESS IS THE START OF THE SWITCHES RANGE + // WHICH WILL EXTEND FOR 16 MORE SWITCH ADDRESSES +uint8_t CV_DECODER_MASTER_RESET = 120; // THIS IS THE CV ADDRESS OF THE FULL RESET +#define CV_To_Store_SET_CV_Address 121 +#define CV_Accessory_Address CV_ACCESSORY_DECODER_ADDRESS_LSB + +struct QUEUE +{ + int inuse; + int current_position; + int increment; + int stop_value; + int start_value; +}; +QUEUE *ftn_queue = new QUEUE[16]; + +struct CVPair +{ + uint16_t CV; + uint8_t Value; +}; +CVPair FactoryDefaultCVs [] = +{ + {CV_ACCESSORY_DECODER_ADDRESS_LSB, Accessory_Address}, + {CV_ACCESSORY_DECODER_ADDRESS_MSB, 0}, + {CV_MULTIFUNCTION_EXTENDED_ADDRESS_MSB, 0}, + {CV_MULTIFUNCTION_EXTENDED_ADDRESS_LSB, 0}, + {CV_DECODER_MASTER_RESET, 0}, + {CV_To_Store_SET_CV_Address, SET_CV_Address}, + {CV_To_Store_SET_CV_Address+1, 0}, + {30, 2}, //F0 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {31, 1}, //F0 Rate Blink=Eate,PWM=Rate,Servo=Rate + {32, 28}, //F0 Start Position F0=0 + {33, 140}, //F0 End Position F0=1 + {34, 28}, //F0 Current Position + {35, 2}, //F1 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {36, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {37, 28}, // Start Position Fx=0 + {38, 140}, // End Position Fx=1 + {39, 28}, // Current Position + {40, 2}, //F2 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {41, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {42, 28}, // Start Position Fx=0 + {43, 140}, // End Position Fx=1 + {44, 28}, // Current Position + {45, 2}, //F3 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {46, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {47, 28}, // Start Position Fx=0 + {48, 140}, // End Position Fx=1 + {49, 28}, // Current Position + {50, 2}, //F4 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {51, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {52, 28}, // Start Position Fx=0 + {53, 140}, // End Position Fx=1 + {54, 28}, // Current Position + {55, 2}, //F5 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {56, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {57, 28}, // Start Position Fx=0 + {58, 140}, // End Position Fx=1 + {59, 28}, // Current Position + {60, 2}, //F6 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {61, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {62, 28}, // Start Position Fx=0 + {63, 140}, // End Position Fx=1 + {64, 28}, // Current Position + {65, 2}, //F7 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {66, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {67, 28}, // Start Position Fx=0 + {68, 140}, // End Position Fx=1 + {69, 28}, // Current Position + {70, 2}, //F8 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {71, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {72, 28}, // Start Position Fx=0 + {73, 140}, // End Position Fx=1 + {74, 28}, // Current Position + {75, 2}, //F9 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {76, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {77, 28}, // Start Position Fx=0 + {78, 140}, // End Position Fx=1 + {79, 28}, // Current Position + {80, 2}, //F10 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {81, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {82, 28}, // Start Position Fx=0 + {83, 140}, // End Position Fx=1 + {84, 28}, // Current Position + {85, 2}, //F11 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {86, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {87, 28}, // Start Position Fx=0 + {88, 140}, // End Position Fx=1 + {89, 28}, // Current Position + {90, 2}, //F12 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {91, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {92, 28}, // Start Position Fx=0 + {93, 140}, // End Position Fx=1 + {94, 28}, // Current Position + {95, 2}, //F13 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {96, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {97, 28}, // Start Position Fx=0 + {98, 140}, // End Position Fx=1 + {99, 28}, // Current Position + {100, 2}, //F14 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {101, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {102, 28}, // Start Position Fx=0 + {103, 140}, // End Position Fx=1 + {104, 28}, // Current Position + {105, 1}, //F15 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {106, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {107, 1}, // Start Position Fx=0 + {108, 10}, // End Position Fx=1 + {109, 1}, // Current Position + {110, 0}, //F16 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {111, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {112, 1}, // Start Position Fx=0 + {113, 10}, // End Position Fx=1 + {114, 1}, // Current Position +//FUTURE USE + {115, 0}, //F17 Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + {116, 1}, // Rate Blink=Eate,PWM=Rate,Servo=Rate + {117, 28}, // Start Position Fx=0 + {118, 50}, // End Position Fx=1 + {119, 28}, // Current Position +}; +uint8_t FactoryDefaultCVIndex = sizeof(FactoryDefaultCVs)/sizeof(CVPair); + +void setup() //****************************************************** +{ + int i; + uint8_t cv_value; + Serial.begin(115200); + // initialize the digital pins as outputs + for (int i=0; i < numfpins; i++) { + pinMode(fpins[i], OUTPUT); + digitalWrite(fpins[i], 0); + } + for (int i=0; i < numfpins; i++) { + digitalWrite(fpins[i], 1); + delay (tim_delay/10); + } + delay( tim_delay); + for (int i=0; i < numfpins; i++) { + digitalWrite(fpins[i], 0); + delay (tim_delay/10); + } + delay( tim_delay); + + // Setup which External Interrupt, the Pin it's associated with that we're using + Dcc.pin(0, 2, 0); + // Call the main DCC Init function to enable the DCC Receiver + Dcc.init( MAN_ID_DIY, 100, FLAGS_OUTPUT_ADDRESS_MODE | FLAGS_DCC_ACCESSORY_DECODER, CV_To_Store_SET_CV_Address); + delay(800); + + #if defined(DECODER_LOADED) + if ( Dcc.getCV(CV_DECODER_MASTER_RESET)== CV_DECODER_MASTER_RESET ) + #endif + + { + for (int j=0; j < sizeof(FactoryDefaultCVs)/sizeof(CVPair); j++ ) + Dcc.setCV( FactoryDefaultCVs[j].CV, FactoryDefaultCVs[j].Value); + digitalWrite(fpins[14], 1); + delay (1000); + digitalWrite(fpins[14], 0); + } + for ( i=0; i < numfpins; i++) { + cv_value = Dcc.getCV( 30+(i*5)) ; + //Serial.print(" cv_value: "); + //Serial.println(cv_value, DEC) ; + switch ( cv_value ) { + case 0: // LED on/off + ftn_queue[i].inuse = 0; + break; + case 1: // LED Blink + { + ftn_queue[i].inuse = 0; + ftn_queue[i].current_position = 0; + ftn_queue[i].start_value = 0; + ftn_queue[i].increment = int (char (Dcc.getCV( 31+(i*5)))); + digitalWrite(fpins[i], 0); + ftn_queue[i].stop_value = int(Dcc.getCV( 33+(i*5))) ; + } + break; + case 2: //servo + { ftn_queue[i].current_position =int (Dcc.getCV( 34+(i*5))); + ftn_queue[i].stop_value = int (Dcc.getCV( 33+(i*5))); + ftn_queue[i].start_value = int (Dcc.getCV( 32+(i*5))); + ftn_queue[i].increment = -int (char (Dcc.getCV( 31+(i*5)))); + switch ( i ) { + case 0: servo0.attach(FunctionPin0); // attaches servo on pin to the servo object + ftn_queue[i].inuse = 1; + servo0.write(ftn_queue[i].start_value); + for (t=0; t ftn_queue[i].stop_value) { + ftn_queue[i].start_value = ~ftn_queue[i].start_value; + digitalWrite(fpins[i], ftn_queue[i].start_value); + ftn_queue[i].current_position = 0; + ftn_queue[i].stop_value = int(Dcc.getCV( 33+(i*5))); + } + break; + case 2: + { + if (ftn_queue[i].increment > 0) { + if (ftn_queue[i].current_position > ftn_queue[i].stop_value) { + ftn_queue[i].current_position = ftn_queue[i].stop_value; + servo_on = false; + detach_servo (i); + } + } + if (ftn_queue[i].increment < 0) { + if (ftn_queue[i].current_position < ftn_queue[i].start_value) { + ftn_queue[i].current_position = ftn_queue[i].start_value; + servo_on = false; + detach_servo (i); + } + } + if (servo_on) { + set_servo(i, ftn_queue[i].current_position); + } + } + break; + case 3: + if (ftn_queue[i].current_position > ftn_queue[i].stop_value) { + ftn_queue[i].start_value = ~ftn_queue[i].start_value; + digitalWrite(fpins[i], ftn_queue[i].start_value); + digitalWrite(fpins[i]+1, ~ftn_queue[i].start_value); + ftn_queue[i].current_position = 0; + ftn_queue[i].stop_value = int(Dcc.getCV( 33+(i*5))); + } + i++; + break; + case 4: //FUTURE FUNCTION + break; + default: + break; + } + } + } +} + +extern void notifyDccAccState( uint16_t Addr, uint16_t BoardAddr, uint8_t OutputAddr, uint8_t State) { + uint16_t Current_Decoder_Addr; + uint8_t Bit_State; + Current_Decoder_Addr = Dcc.getAddr(); + Bit_State = OutputAddr & 0x01; + + if ( Addr >= Current_Decoder_Addr || Addr < Current_Decoder_Addr+17) { //Controls Accessory_Address+16 + switch (Addr-Current_Decoder_Addr) { + case 0: exec_function( 0, FunctionPin0, Bit_State ); + break; + case 1: exec_function( 1, FunctionPin1, Bit_State ); + break; + case 2: exec_function( 2, FunctionPin2, Bit_State ); + break; + case 3: exec_function( 3, FunctionPin3, Bit_State ); + break; + case 4: exec_function( 4, FunctionPin4, Bit_State ); + break; + case 5: exec_function( 5, FunctionPin5, Bit_State ); + break; + case 6: exec_function( 6, FunctionPin6, Bit_State ); + break; + case 7: exec_function( 7, FunctionPin7, Bit_State ); + break; + case 8: exec_function( 8, FunctionPin8, Bit_State ); + break; + case 9: exec_function( 9, FunctionPin9, Bit_State ); + break; + case 10: exec_function( 10, FunctionPin10, Bit_State ); + break; + case 11: exec_function( 11, FunctionPin11, Bit_State ); + break; + case 12: exec_function( 12, FunctionPin12, Bit_State ); + break; + case 13: exec_function( 13, FunctionPin13, Bit_State ); + break; + case 14: exec_function( 14, FunctionPin14, Bit_State ); + break; + case 15: exec_function( 15, FunctionPin15, Bit_State ); + break; + case 16: exec_function( 16, FunctionPin16, Bit_State ); + break; + default: + break; + } + } +} +void exec_function (int function, int pin, int FuncState) { + switch ( Dcc.getCV( 30+(function*5)) ) { // Config 0=On/Off,1=Blink,2=Servo,3=Double LED Blink + case 0: // On - Off LED + digitalWrite (pin, FuncState); + ftn_queue[function].inuse = 0; + break; + case 1: // Blinking LED + if ((ftn_queue[function].inuse==0) && (FuncState==1)) { + ftn_queue[function].inuse = 1; + ftn_queue[function].start_value = 0; + digitalWrite(pin, 0); + ftn_queue[function].stop_value = int(Dcc.getCV( 33+(function*5))); + } else { + if ((ftn_queue[function].inuse==1) && (FuncState==0)) { + ftn_queue[function].inuse = 0; + digitalWrite(pin, 0); + } + } + break; + case 2: // Servo + ftn_queue[function].inuse = 1; + if (FuncState==1) ftn_queue[function].increment = char ( Dcc.getCV( 31+(function*5))); + else ftn_queue[function].increment = - char(Dcc.getCV( 31+(function*5))); + if (FuncState==1) ftn_queue[function].stop_value = Dcc.getCV( 33+(function*5)); + else ftn_queue[function].stop_value = Dcc.getCV( 32+(function*5)); + break; + case 3: // Blinking LED PAIR + if ((ftn_queue[function].inuse==0) && (FuncState==1)) { + ftn_queue[function].inuse = 1; + ftn_queue[function].start_value = 0; + digitalWrite(fpins[function], 0); + digitalWrite(fpins[function+1], 1); + ftn_queue[function].stop_value = int(Dcc.getCV( 33+(function*5))); + } else { + if (FuncState==0) { + ftn_queue[function].inuse = 0; + digitalWrite(fpins[function], 0); + digitalWrite(fpins[function+1], 0); + } + } + break; + case 4: // Future Function + ftn_queue[function].inuse = 0; + break; + default: + ftn_queue[function].inuse = 0; + break; + } +} +void set_servo (int servo_num, int servo_pos) { + switch (servo_num) { + case 0: + if (servo0.attached()==0) servo0.attach(FunctionPin0); + servo0.write(servo_pos); + break; + case 1: + if (servo1.attached()==0) servo1.attach(FunctionPin1); + servo1.write(servo_pos); + break; + case 2: + if (servo2.attached()==0) servo2.attach(FunctionPin2); + servo2.write(servo_pos); + break; + case 3: + if (servo3.attached()==0) servo3.attach(FunctionPin3); + servo3.write(servo_pos); + break; + case 4: + if (servo4.attached()==0) servo4.attach(FunctionPin4); + servo4.write(servo_pos); + break; + case 5: + if (servo5.attached()==0) servo5.attach(FunctionPin5); + servo5.write(servo_pos); + break; + case 6: + if (servo6.attached()==0) servo6.attach(FunctionPin6); + servo6.write(servo_pos); + break; + case 7: + if (servo7.attached()==0) servo7.attach(FunctionPin7); + servo7.write(servo_pos); + break; + case 8: + if (servo8.attached()==0) servo8.attach(FunctionPin8); + servo8.write(servo_pos); + break; + case 9: + if (servo9.attached()==0) servo9.attach(FunctionPin9); + servo9.write(servo_pos); + break; + case 10: + if (servo10.attached()==0) servo10.attach(FunctionPin10); + servo10.write(servo_pos); + break; + case 11: + if (servo11.attached()==0) servo11.attach(FunctionPin11); + servo11.write(servo_pos); + break; + case 12: + if (servo12.attached()==0) servo12.attach(FunctionPin12); + servo12.write(servo_pos); + case 13: + if (servo13.attached()==0) servo13.attach(FunctionPin13); + servo13.write(servo_pos); + break; + case 14: + if (servo14.attached()==0) servo12.attach(FunctionPin14); + servo14.write(servo_pos); + break; + case 15: + if (servo15.attached()==0) servo15.attach(FunctionPin15); + servo15.write(servo_pos); + break; + case 16: + if (servo16.attached()==0) servo16.attach(FunctionPin16); + servo16.write(servo_pos); + break; + default: + break; + } +} +void detach_servo (int servo_num) { + switch (servo_num) { + case 0: + if (servo0.attached()!=0) servo0.detach(); + break; + case 1: + if (servo1.attached()!=0) servo1.detach(); + break; + case 2: + if (servo2.attached()!=0) servo2.detach(); + break; + case 3: + if (servo3.attached()!=0) servo3.detach(); + break; + case 4: + if (servo4.attached()!=0) servo4.detach(); + break; + case 5: + if (servo5.attached()!=0) servo5.detach(); + break; + case 6: + if (servo6.attached()!=0) servo6.detach(); + break; + case 7: + if (servo7.attached()!=0) servo7.detach(); + break; + case 8: + if (servo8.attached()!=0) servo8.detach(); + break; + case 9: + if (servo9.attached()!=0) servo9.detach(); + break; + case 10: + if (servo10.attached()!=0) servo10.detach(); + break; + case 11: + if (servo11.attached()!=0) servo11.detach(); + break; + case 12: + if (servo12.attached()!=0) servo12.detach(); + break; + case 13: + if (servo13.attached()!=0) servo13.detach(); + break; + case 14: + if (servo14.attached()!=0) servo12.detach(); + break; + case 15: + if (servo15.attached()!=0) servo15.detach(); + break; + case 16: + if (servo16.attached()!=0) servo16.detach(); + break; + default: + break; + } }