#include <Braccio.h>
#include <Servo.h>
//-------------------------------------------------------------------------
Servo base;
Servo shoulder;
Servo elbow;
Servo wrist_rot;
Servo wrist_ver;
Servo gripper;
//----------------------------------------------------------------------------
void setup() {
  Braccio.begin();
  Serial.begin(9600);
}

void loop() {

  Braccio.ServoMovement(20,180,180,180,180,180,180);
  Serial.println("M1=180, M2=180, M3=180, M4=180, M5=180, M6=180");
  delay(1000);

}