#include <Servo.h>
int trigger = 8;
int echo = 7;
Servo ser;

void setup() {
 // put your setup code here, to run once:
  ser.attach(22);
  Serial.begin(9600); 
  Serial.println("Hello pi-pico\n");  
  pinMode(trigger, OUTPUT);
  pinMode(echo, INPUT);

}

void loop() {
  // put your setup code here, to run continuous:
  digitalWrite(trigger, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigger, LOW);

  int duration = pulseIn(echo, HIGH);
  int cm = duration * 0.034 / 2;

check_dist(cm);

}

// function check distance rotate & servo //
void check_dist(int res)
{

  if(res < 200){
     ser.write(180);
     delay(500);
  }else{
     ser.write(90);
     delay(500);
  }

}