#include <VirtualWire.h>
#include <ServoTimer2.h>
const int ledtest_pin = 9;
const int servoPin = 6;
//const int transmit_pin = 12; //Transmit not needed on this board
const int receive_pin = 3;//pin connected between RX module and Arduino
//const int transmit_en_pin = 5; //Transmit not needed on this board

ServoTimer2 rangefinder;

void setup()
{
    pinMode(servoPin, OUTPUT);
    //Serial.begin(9600);
    //Serial.println("setup");
    rangefinder.attach(servoPin);
    rangefinder.write(0);
    //delay(1000);
    //vw_set_tx_pin(transmit_pin); //Transmit not needed on this board
    vw_set_rx_pin(receive_pin);
    //vw_set_ptt_pin(transmit_en_pin); //Transmit not needed on this board
    //vw_set_ptt_inverted(true); //Transmit not needed on this board
    vw_setup(2000);//speed communication bps

    vw_rx_start();       // activate receiving mode

    pinMode(ledtest_pin, OUTPUT);

    pinMode(LED_BUILTIN, OUTPUT); //Debug
}

void loop()
{
  {
    uint8_t buf[VW_MAX_MESSAGE_LEN];
    uint8_t buflen = VW_MAX_MESSAGE_LEN;
    if (vw_get_message(buf, &buflen))  //verify if any data is received
    {
      if(buf[0]=='1')//if received 1 turn ON ledtest_pin
        {
        rangefinder.attach(servoPin);
        rangefinder.write(180);
        //Serial.println("90");
        digitalWrite(ledtest_pin , HIGH);
        digitalWrite(LED_BUILTIN, HIGH); //Debug
        rangefinder.detach();
        delay(100);
        }
     if(buf[0]=='0')
        {
        rangefinder.attach(servoPin);
        rangefinder.write(0);
        //Serial.println("180");
        digitalWrite(ledtest_pin , LOW);
        digitalWrite(LED_BUILTIN, LOW); //Debug
        rangefinder.detach();
        delay(100);
        }
    }
  }
}