   pinMode(31, OUTPUT);
   Serial.begin(57600);
   Serial1.begin(57600);
-  pinMode(RRWL, OUTPUT);
-  pinMode(LRWL, OUTPUT);
+   pinMode(RRWL, OUTPUT);
+   pinMode(LRWL, OUTPUT);
   pinMode(RRRL, OUTPUT);
   pinMode(LRRL, OUTPUT);
-  pinMode(RFWL, OUTPUT);
-  pinMode(LFWL, OUTPUT);
+  // pinMode(RFWL, OUTPUT);
+  // pinMode(LFWL, OUTPUT);
   pinMode(statpin, OUTPUT);
+  //togalFor(RRRL,1000);
   Serial.println("startup");
   // Initialize digital pins as outputs
   for (int i = 0; i < 2; i++)

int enpin[2] = {0, 1}; // EN: Status of switches output (Analog pin)
int RRWL = 35;
int LRWL = 32;
int RFWL = 36;
int LFWL = 37;
int RRRL = 33;
int LRRL = 34;
int seirnRed[5] = {22, 24, 26, 28, 30};
int seirnBlue[5] = {23, 25, 27, 29, 31};
int statpin = 13;
void setup() {
  BTLEserial.setDeviceName("Pi Car"); /* 7 characters max! */
  BTLEserial.begin();
  pinMode(22, OUTPUT);
  pinMode(23, OUTPUT);
  pinMode(24, OUTPUT);

#define CCW  2
#define BRAKEGND 3
#define CS_THRESHOLD 100
bool headLightON = false;
//variable declarations
int horn = 23;
/*  VNH2SP30 pin definitions
