#include <VarSpeedServo.h>

//#include <Servo.h>
#include <SoftwareSerial.h>

String buff;

SoftwareSerial mySerial(10, 11); // RX, TX

VarSpeedServo myservo;
int val;
int rw = 0;
int i = 0;
bool start = false;

void setup() {
  // Open serial communications and wait for port to open:

  Serial.begin(9600);
  mySerial.begin(9600);
  mySerial.setTimeout(10);

 myservo.attach(5);

    //delay(3000);

   // for (int i=2300; i>860;i--)
   /// {
   ////   myservo.write(i);
   //   delay(20);
  //  }
  delay(200);
   myservo.write(941);
   delay(3000);
    myservo.write(800);
    delay(3000);


}

int isInt(auto x)
{
    if(x==floor(x))
        return 1;
    return 0;
}

void loop() {

//myservo.write(random(861,941));
//delay(random(100));

  if (mySerial.available()) {
 //  Serial.println(mySerial.read());

   buff = mySerial.readStringUntil("$");

   if (buff.length()>0)
   {
   //buff = mySerial.readStringUntil("$");

   char buffn[buff.length()-1];
   strcpy(buffn, buff.c_str());
   int v = String(buffn).toInt();
   if (isInt(v))
   {
    v = map(v,0,81,860,940);
    v = constrain(v,860,940);
    myservo.write(v,40);
    delay(10);
   }
   }
  //*/
  } else myservo.write(860);
//  if (Serial.available()) {
//    mySerial.write(Serial.read());
//  }
  //val = 500;          // reads the value of the potentiometer (value between 0 and 1023)
 // val = map(val, 0, 1023, 0, 180);     // scale it to use it with the servo (value between 0 and 180)
  //if (i<100 || rw!=1 ) {myservo.write(i++); }
  //if (i==100)  rw
 // myservo.writeMicroseconds(random(850,990 ));
  //if (i!=0)  {myservo.write(i--);}
  //delay(10);
;
  // sets the servo position according to the scaled value

}