63 lines
2 KiB
C++
63 lines
2 KiB
C++
|
|
/*
|
|
simpleMovements.ino
|
|
|
|
This sketch simpleMovements shows how they move each servo motor of Braccio
|
|
|
|
Created on 18 Nov 2015
|
|
by Andrea Martino
|
|
|
|
This example is in the public domain.
|
|
*/
|
|
|
|
#include <Braccio.h>
|
|
#include <Servo.h>
|
|
|
|
#define error 0 //A
|
|
//#define error 4 //B
|
|
|
|
Servo base;
|
|
Servo shoulder;
|
|
Servo elbow;
|
|
Servo wrist_rot;
|
|
Servo wrist_ver;
|
|
Servo gripper;
|
|
|
|
void setup() {
|
|
//Initialization functions and set up the initial position for Braccio
|
|
//All the servo motors will be positioned in the "safety" position:
|
|
//Base (M1):90 degrees
|
|
//Shoulder (M2): 45 degrees
|
|
//Elbow (M3): 180 degrees
|
|
//Wrist vertical (M4): 180 degrees
|
|
//Wrist rotation (M5): 90 degrees
|
|
//gripper (M6): 10 degrees
|
|
pinMode(12, OUTPUT); //you need to set HIGH the pin 12
|
|
digitalWrite(12, HIGH);
|
|
Braccio.begin(SOFT_START_DISABLED);
|
|
Braccio.ServoMovement(20, 0, 60, 0 + error, 71 + error, 90, 73); //B
|
|
}
|
|
|
|
void loop() {
|
|
/*
|
|
Step Delay: a milliseconds delay between the movement of each servo. Allowed values from 10 to 30 msec.
|
|
M1=base degrees. Allowed values from 0 to 180 degrees
|
|
M2=shoulder degrees. Allowed values from 15 to 165 degrees
|
|
M3=elbow degrees. Allowed values from 0 to 180 degrees
|
|
M4=wrist vertical degrees. Allowed values from 0 to 180 degrees
|
|
M5=wrist rotation degrees. Allowed values from 0 to 180 degrees
|
|
M6=gripper degrees. Allowed values from 10 to 73 degrees. 10: the toungue is open, 73: the gripper is closed.
|
|
*/
|
|
|
|
//(step delay, M1, M2, M3, M4, M5, M6);
|
|
|
|
Braccio.ServoMovement(20, 0, 125, 0 + error, 71 + error, 90, 73); //B
|
|
delay(1000);
|
|
Braccio.ServoMovement(20, 0, 125, 0 + error, 71 + error, 0, 73); //B
|
|
delay(1000);
|
|
Braccio.ServoMovement(20, 0, 125, 0 + error, 71 + error, 90, 73); //B
|
|
delay(1000);
|
|
Braccio.ServoMovement(20, 0, 125, 0 + error, 71 + error, 180, 73); //B
|
|
|
|
}
|