Blink

This sketch is a twist on blink.ino, the quintessential Arduino "Hello World" sketch. This example blinks the built-in LED of a Herkulex Servo.

Note: Be sure to change SERVO_ID to the ID of the servo you want to blink, otherwise nothing will happen.

#include <Arduino.h>
#include <SoftwareSerial.h>
#include <HerkulexServo.h>

#define PIN_SW_RX 8
#define PIN_SW_TX 9
#define SERVO_ID  12

SoftwareSerial   servo_serial(PIN_SW_RX, PIN_SW_TX);
HerkulexServoBus herkulex_bus(servo_serial);
HerkulexServo    my_servo(herkulex_bus, SERVO_ID);


void setup() {
  Serial.begin(115200);
  servo_serial.begin(115200);
}

void loop() {
  herkulex_bus.update();

  my_servo.setLedColor(HerkulexLed::White);
  delay(1000);
  my_servo.setLedColor(HerkulexLed::Off);
  delay(1000);
}