//Serial Handshake declaration
#include // we'll need this for subString
#define MAX_STRING_LEN 20 // like 3 lines above, change as needed.
const char EOPmarker = '.'; //This is the end of packet marker
char serialbuf[32]; //This gives the incoming serial some room. Change it if you want a longer incoming.
//SoftwareSerial declaration
#include
SoftwareSerial xbee_serial(8, 9);
//Shift Register Pins declaration
int SER_Pin = 10; //pin 14 on the 75HC595
int RCLK_Pin = 11; //pin 12 on the 75HC595
int SRCLK_Pin = 12; //pin 11 on the 75HC595
#define number_of_74hc595s 1 //How many of the shift registers - change this
#define numOfRegisterPins number_of_74hc595s * 8 //do not touch
boolean registers[numOfRegisterPins];
//Servo declarations
#include
Servo left_servo;
Servo rght_servo;
//Misc Pin declaration
//inputs
int pot = 1;
int debug_switch1 = 4;
//outputs
int fade_LED = 13;
int x_LED = 5;
int y_LED = 6;
//int debug_switch1_LED = 12;
//Misc Integer declarations
int brightness = 0; // how bright the LED is
int fadeAmount = 20; // how many points to fade the LED by
int x_upperTrigger = 600;
int x_lowerTrigger = 400;
int y_upperTrigger = 600;
int y_lowerTrigger = 400;
void setup(){
Serial.begin(9600);
xbee_serial.begin(9600);
pinMode(SER_Pin, OUTPUT);
pinMode(RCLK_Pin, OUTPUT);
pinMode(SRCLK_Pin, OUTPUT);
pinMode(0, INPUT);
clearRegisters();
writeRegisters();
pinMode(pot, INPUT);
pinMode(debug_switch1, INPUT);
pinMode(x_LED, OUTPUT);
pinMode(y_LED, OUTPUT);
pinMode(fade_LED, OUTPUT);
xbee_serial.print("0,0,0."); // this is very important as it starts of the loop because it makes "xbee_serial.avalible() > 0.
}
void loop(){
if (xbee_serial.available() > 0) {
static int bufpos = 0;
char inchar = xbee_serial.read();
if (inchar != EOPmarker) {
serialbuf[bufpos] = inchar;
bufpos++;
}
else {
serialbuf[bufpos] = 0; //restart the buff
bufpos = 0; //restart the position of the buff
handshake();
debug_handshake();
setRegisterPin(1, HIGH);
writeRegisters();
}
}
}
void handshake(){
//input, recived from controller
// led1val,ledval2,fade_LEDvalue.
//analogWrite(x_LED, map(atoi(subStr(serialbuf, "," , 1)),0,1023,0,255));
//analogWrite(y_LED, map(atoi(subStr(serialbuf, "," , 2)),0,1023,0,255));
analogWrite(fade_LED, atoi(subStr(serialbuf, "," , 3)));
brightness = brightness + fadeAmount;
// reverse the direction of the fading at the ends of the fade:
if (brightness == 0 || brightness == 255) {
fadeAmount = -fadeAmount ;
}
if (atoi(subStr(serialbuf, "," , 1)) > x_upperTrigger ){
analogWrite(x_LED, map(atoi(subStr(serialbuf, "," , 1)),512,1023,0,255));
setRegisterPin(2, HIGH);
setRegisterPin(3, LOW);
writeRegisters();
}
if (atoi(subStr(serialbuf, "," , 1)) < x_lowerTrigger ){
analogWrite(x_LED, map(atoi(subStr(serialbuf, "," , 1)),512,0,0,255));
setRegisterPin(2, LOW);
setRegisterPin(3, HIGH);
writeRegisters();
}
if (atoi(subStr(serialbuf, "," , 1)) > x_lowerTrigger && atoi(subStr(serialbuf, "," , 1)) < x_upperTrigger){
setRegisterPin(2, LOW);
setRegisterPin(3, LOW);
writeRegisters();
}
if (atoi(subStr(serialbuf, "," , 2)) > y_upperTrigger ){
analogWrite(y_LED, map(atoi(subStr(serialbuf, "," , 2)),512,1023,0,255));
setRegisterPin(4, HIGH);
setRegisterPin(5, LOW);
writeRegisters();
}
if (atoi(subStr(serialbuf, "," , 2)) < y_lowerTrigger ){
analogWrite(y_LED, map(atoi(subStr(serialbuf, "," , 2)),512,0,0,255));
setRegisterPin(4, LOW);
setRegisterPin(5, HIGH);
writeRegisters();
}
if (atoi(subStr(serialbuf, "," , 2)) > y_lowerTrigger && atoi(subStr(serialbuf, "," , 2)) < y_upperTrigger){
setRegisterPin(4, LOW);
setRegisterPin(5, LOW);
writeRegisters();
}
//output, sent to controller
//ledpot1,fade_LEDval.
xbee_serial.print(analogRead(pot));
xbee_serial.print(",");
xbee_serial.print(brightness); //This second byte is for the purpose of the program, it is not being used.
xbee_serial.print("."); //EOP marker
delay(10);
}
void debug_handshake(){
//input, recived from controller
Serial.print("VEHICLE DEBUG: ");
Serial.print("INPUTS|");
Serial.print(" x_LED: ");
Serial.print(map(atoi(subStr(serialbuf, "," , 1)),0,1023,0,255));
Serial.print(" y_LED: ");
Serial.print(map(atoi(subStr(serialbuf, "," , 2)),0,1023,0,255));
Serial.print(" in fade_LED: ");
Serial.print(atoi(subStr(serialbuf, "," , 3)));
//output, sent to controller
Serial.print(" OUTPUTS|");
Serial.print(" Pot 1: ");
Serial.print(analogRead(pot));
Serial.print(" out fade_LED: ");
Serial.print(brightness);
Serial.println("");
}
char* subStr (char* input_string, char *separator, int segment_number) {
char *act, *sub, *ptr;
static char copy[MAX_STRING_LEN];
int i;
strcpy(copy, input_string);
for (i = 1, act = copy; i <= segment_number; i++, act = NULL) {
sub = strtok_r(act, separator, &ptr);
if (sub == NULL) break;
}
return sub;
}
void clearRegisters(){
for(int i = numOfRegisterPins - 1; i >= 0; i--){
registers[i] = LOW;
}
}
void writeRegisters(){
digitalWrite(RCLK_Pin, LOW);
for(int i = numOfRegisterPins - 1; i >= 0; i--){
digitalWrite(SRCLK_Pin, LOW);
int val = registers[i];
digitalWrite(SER_Pin, val);
digitalWrite(SRCLK_Pin, HIGH);
}
digitalWrite(RCLK_Pin, HIGH);
}
//set an individual pin HIGH or LOW
void setRegisterPin(int index, int value){
registers[index] = value;
}