#include <Servo.h>
Servo s;
int trigpin=3;
int ecopin=2;
int space, distance;
void setup() {
// put your setup code here, to run once:
Serial1.begin(115200);
Serial1.println("Hello, Raspberry Pi Pico!");
s.attach(18);
pinMode( trigpin, OUTPUT);
pinMode( ecopin, INPUT);
}
void loop() {
digitalWrite(trigpin, LOW);
delayMicroseconds(2);
digitalWrite(trigpin, HIGH);
delayMicroseconds(10);
digitalWrite(trigpin, LOW);
space = pulseIn(ecopin, HIGH);
distance = (space*.0343)/2;
if(distance>200){
s.write(180);
}
else{
s.write(45);
}
}