/* 
  Objektorientierte Programmierung
  Langsamer Servo
  - Ableitung von 'Servo' und Aufteilung in .h und .cpp
  - Erweiterung um eine Abfragefunktion
    
  Version 1.00, 07.09.2020
  Der Hobbyelektroniker
  https://community.hobbyelektroniker.ch
  https://www.youtube.com/c/HobbyelektronikerCh
  Der Code kann mit Quellenangabe frei verwendet werden.
*/
#include <Arduino.h>
#include <Servo.h>
#include "MySlowServo.h"

const int servo_pin = 7;

LangsamerServo servo;

void setup() {
  servo.attach(servo_pin);
  servo.write(90);
}


// Das soll anstelle von delay() verwendet werden
void pause(int ms) {
  unsigned long start = millis();
  while (millis() < start + ms) {
    _loop();
  }
}

// in diesen Loop kommt alles, was regelmässig aufgerufen werden muss
void _loop() {
  servo.tic();
}

void loop() {
  _loop();
  servo.write(10,50);
  while (!servo.amZiel()) _loop();
  //pause(500);
  servo.write(90,50);
  while (!servo.amZiel()) _loop();
  //pause(500);
}