// https://github.com/KleistRobotics/Pico-Servo

#include "servo.h"
#include <stdio.h>
#include "pico/stdlib.h"

bool direction = true;
int currentMillis = 400;
int servoPin = 28;

int main()
{
    setServo(servoPin, currentMillis);
    while (true)
    {
        currentMillis += (direction)?5:-5;
        if (currentMillis >= 2400) direction = false;
        if (currentMillis <= 400) direction = true;
        setMillis(servoPin, currentMillis);
        sleep_ms(10);
    }
}