//
// hello.servo.RP2350.ino
//    RP2350 servo hello-world
//
// Neil Gershenfeld 8/9/26
//
// This work may be reproduced, modified, distributed,
// performed, and displayed for any purpose, but must
// acknowledge this project. Copyright is retained and
// must be preserved. The work is provided as is; no
// warranty is provided, and users accept all liability.
//

#include <Servo.h>

#define delay_time 5 // delay time between steps (ms)
#define pause_time 500 // pause time between steps (ms)
#define servo_pin1 0 // servo 1 pin (GPIO0)
#define servo_pin2 1 // servo 2 pin (GPIO1)
#define max_angle 180 // max servo angle

Servo servo1,servo2; //declare servos
int angle = 0;

void setup() {
   servo1.attach(servo_pin1); // attach servos to pins
   servo2.attach(servo_pin2);
   }

void loop() {
   //
   // step servo 1 slowly
   //
   for (angle = 0; angle <= max_angle; ++angle) {
      servo1.write(angle);
      delay(delay_time);
      }
   //
   // step servo 2 slowly
   //
   for (angle = 0; angle <= max_angle; ++angle) {
      servo2.write(angle);
      delay(delay_time);
      }
   //
   // step both quickly
   //
   servo1.write(0);
   servo2.write(0);
   delay(pause_time);
   servo1.write(max_angle);
   servo2.write(max_angle);
   delay(pause_time);
   servo1.write(0);
   servo2.write(0);
   delay(pause_time);
   }