#include <Servo.h>
int centimeter=0;
int inches=0;
long readUltrasonic(int triggerPin, int echoPin){
  pinMode(triggerPin, OUTPUT);
  digitalWrite(triggerPin, LOW);
  delayMicroseconds(2);
  digitalWrite(triggerPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(triggerPin, LOW);
  pinMode(echoPin, INPUT);
  return pulseIn(echoPin, HIGH);
}
Servo servo_10;
void setup() {
  // put your setup code here, to run once:
  Serial1.begin(115200);
  servo_10.attach(10,500,2500);
  Serial1.println("Hello, Raspberry Pi Pico!");
}
void loop() {
  centimeter=0.01723*readUltrasonic(8,7);
  inches=centimeter/2.54;
  Serial1.print(centimeter);
  Serial1.print("cm, ");
  Serial1.print(inches);
  Serial1.println("in.");
  delay(1000);
  if(inches<30){
    servo_10.write(90);
  }
  else{
    servo_10.write(0);
  }
}