#include <Servo.h>

#define numOfvalsRec 5
#define digitsPerValRec 1

Servo servoThumb;
Servo servoIndex;
Servo servoMiddle;
Servo servoRing;
Servo servoPinky;


int valsRec[numOfvalsRec];
int stringLength = numOfvalsRec * digitsPerValRec +1; //$00000
int counter = 0;
bool counterStart = false;
String receivedString;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  servoThumb.attach(7);
  servoIndex.attach(2);
  servoMiddle.attach(3);
  servoRing.attach(4);
  servoPinky.attach(5);

}
void receiveData(){
    while(Serial.available())
    {
      char c = Serial.read();

      if (c=='$'){counterStart = true;}
      if (counterStart){
        if ( counter < stringLength){
          receivedString = String(receivedString+c);
          counter++;
        }
        if (counter >=stringLength){
          for(int i = 0; i<numOfvalsRec; i++){
            int num = (i*digitsPerValRec)+1;
            valsRec[i] = receivedString.substring(num,num + digitsPerValRec).toInt();
          }
          receivedString = "";
          counter = 0;
          counterStart = false;
          
        }
      }
    }
}

void loop() {
  // put your main code here, to run repeatedly:

  Serial.print("test");
  receiveData();
  if (valsRec[0] ==1) {servoThumb.write(180);}else{servoThumb.write(0);}
  if (valsRec[1] ==1) {servoIndex.write(180);}else{servoIndex.write(0);}
  if (valsRec[2] ==1) {servoMiddle.write(180);}else{servoMiddle.write(0);}
  if (valsRec[3] ==1) {servoRing.write(180);}else{servoRing.write(0);}
  if (valsRec[4] ==1) {servoPinky.write(180);}else{servoPinky.write(0);}

}