roboforum.ru

#include <ORM128S.h>

/*
  Скетч blink_servo_and_led
    Зажигает светодиод на 1 секунду и тушит его в цикле,
    параллельно с зажиганием\тушением качает серву №0 между положениями соответствующими 1400мкс и 1600мкс.

  Схема:
    Светодиод подключен к пину PF7 одной ножкой и на землю другой.
    Серва подключена на порт 0 сервоконтроллера.
*/

int ledPin =  47;    // Светодиод подключен к пину 47 (PF7)

// Функция setup() вызываетс раз при запуске скетча

void setup()   {               
  // Установка пина на вывод:
  pinMode(ledPin, OUTPUT);
  or_m128s_init();
}

//Основной цикл программы
void loop()                     
{
  digitalWrite(ledPin, HIGH);   // включим светодиод
  or_m128s_servo_set_position(0,1400);
  delay(1000);                  // ждем секунду
  digitalWrite(ledPin, LOW);    // выключим светодиод
  or_m128s_servo_set_position(0,1600);
  delay(1000);                  // ждем секунду
}