From 87acb7470a0db3a5370ca732b7335c3fdc917d4b Mon Sep 17 00:00:00 2001 From: Carmine De Rosa Date: Sat, 28 Sep 2019 12:25:24 +0200 Subject: [PATCH] servo setup --- arduino/arduino.ino | 21 ++++++++-- percentage/percentage.pde | 85 --------------------------------------- servoSetup/servoSetup.ino | 84 ++++++++++++++++++++++++++++++++++++++ 3 files changed, 101 insertions(+), 89 deletions(-) delete mode 100644 percentage/percentage.pde create mode 100644 servoSetup/servoSetup.ino diff --git a/arduino/arduino.ino b/arduino/arduino.ino index 7d4c5e0..e6ee21d 100644 --- a/arduino/arduino.ino +++ b/arduino/arduino.ino @@ -3,8 +3,8 @@ Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver(); -#define SERVOMIN 150 // this is the 'minimum' pulse length count (out of 4096) -#define SERVOMAX 600 // this is the 'maximum' pulse length count (out of 4096) +#define SERVOMIN 350 // this is the 'minimum' pulse length count (out of 4096) +#define SERVOMAX 385 // this is the 'maximum' pulse length count (out of 4096) int atomPins[] = {2,3,4,5,6,7,8,9}; @@ -25,6 +25,19 @@ void setup() { delay(10); } +void setServoPulse(uint8_t n, double pulse) { + double pulselength; + + pulselength = 1000000; // 1,000,000 us per second + pulselength /= 60; // 60 Hz + Serial.print(pulselength); Serial.println(" us per period"); + pulselength /= 4096; // 12 bits of resolution + Serial.print(pulselength); Serial.println(" us per bit"); + pulse *= 1000000; // convert to us + pulse /= pulselength; + Serial.println(pulse); + pwm.setPWM(n, 0, pulse); +} void loop() { if(Serial.available()){ @@ -44,10 +57,10 @@ void loop() { if(values[i]>0) { values[i]--; digitalWrite(atomPins[i], HIGH); - pwm.setPWM(i, 0, 400); + pwm.setPWM(i, 0, SERVOMIN); if(values[i]==0) { digitalWrite(atomPins[i], LOW); - pwm.setPWM(i, 0, 100); + pwm.setPWM(i, 0, ((SERVOMAX-SERVOMIN)/2)+SERVOMIN); cycle++; } } diff --git a/percentage/percentage.pde b/percentage/percentage.pde deleted file mode 100644 index 6488c47..0000000 --- a/percentage/percentage.pde +++ /dev/null @@ -1,85 +0,0 @@ -import processing.serial.*; -import processing.video.*; - -int cellSize = 20; -int cols, rows, cellN; -int[] colorValues = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; - -Capture video; - -void setup() { - size(640, 480); - frameRate(10); - colorMode(HSB, 100, 100, 100); - cols = width / cellSize; - rows = height / cellSize; - cellN = (cols)*(rows); - //colorMode(RGB, 255, 255, 255, 100); - - video = new Capture(this, width, height); - video.start(); - - background(0); -} - -void draw() { - if (video.available()) { - video.read(); - video.loadPixels(); - - for(int i = 0; i 20 && briVal < 80) { - colorValues[int(hueVal/8.3)]++; - } else if(briVal <= 20) { - colorValues[12]++; - } else if(briVal >= 20) { - colorValues[13]++; - } - - pushMatrix(); - translate(x+cellSize/2, y+cellSize/2); - rectMode(CENTER); - fill(c); - noStroke(); - rect(0, 0, cellSize+6, cellSize+6); - popMatrix(); - } - } - - // Print colors percentage values - for(int i = 0; i http://www.adafruit.com/products/815 + + These drivers use I2C to communicate, 2 pins are required to + interface. + + Adafruit invests time and resources providing this open source code, + please support Adafruit and open-source hardware by purchasing + products from Adafruit! + + Written by Limor Fried/Ladyada for Adafruit Industries. + BSD license, all text above must be included in any redistribution + ****************************************************/ + +#include +#include + +// called this way, it uses the default address 0x40 +Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver(); +// you can also call it with a different address you want +//Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver(0x41); +// you can also call it with a different address and I2C interface +//Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver(0x40, &Wire); + +// Depending on your servo make, the pulse width min and max may vary, you +// want these to be as small/large as possible without hitting the hard stop +// for max range. You'll have to tweak them as necessary to match the servos you +// have! + +#define SERVOMIN 330 // this is the 'minimum' pulse length count (out of 4096) - increasing SERVOMIN decrease speed +#define SERVOMAX 390 // this is the 'maximum' pulse length count (out of 4096) + +// our servo # counter +uint8_t servonum = 0; + +void setup() { + Serial.begin(9600); + Serial.println("8 channel Servo test!"); + + pwm.begin(); + + pwm.setPWMFreq(60); // Analog servos run at ~60 Hz updates + +pinMode(8, OUTPUT); + delay(10); +} + +// you can use this function if you'd like to set the pulse length in seconds +// e.g. setServoPulse(0, 0.001) is a ~1 millisecond pulse width. its not precise! +void setServoPulse(uint8_t n, double pulse) { + double pulselength; + + pulselength = 1000000; // 1,000,000 us per second + pulselength /= 60; // 60 Hz + Serial.print(pulselength); Serial.println(" us per period"); + pulselength /= 4096; // 12 bits of resolution + Serial.print(pulselength); Serial.println(" us per bit"); + pulse *= 1000000; // convert to us + pulse /= pulselength; + Serial.println(pulse); + pwm.setPWM(n, 0, pulse); +} + +void loop() { + // Drive each servo one at a time + Serial.println(servonum); + + + for(int x=0; x<8; x++) { + + pwm.setPWM(x, 0, SERVOMIN); + delay(1000); + pwm.setPWM(x, 0, ((SERVOMAX-SERVOMIN)/2)+SERVOMIN); + + delay(1000); + } + + +}