Hey internet,
I've got a problem with a class for controlling a servo. In the constructor the servo should be initialized and set to 0 degrees. What actually happens: The Arduino (UNO R3) sends "Se" to serial, after that nothing happens. I don't think the program has any problems with memory, since there are not that many variables and I don't even work with pointers.
I'll try to include only as much code as needed, for comments you need to scroll right:
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>
#include <Ramp.h>
#define SERVOMIN 460 //Minimum PWM for servo
#define SERVOMAX 1075 //Maximum PWM for servo
#define SERVOMINDEG 30 //Minimum servo rotation
#define SERVOMAXDEG 120 //Maximum servo rotation
class ServoMotor{ //New class: ServoMotor
private:
int servopwm; //declaring member for current pwm
int servonum; //declaring member for servo number
Adafruit_PWMServoDriver& driver; //declaring reference to the driver
public:
void drive(float deg);
ServoMotor(int servonum, Adafruit_PWMServoDriver& driver): servonum(servonum), driver(driver){ //constructor
Serial.begin(9600); //begin serial communication
Serial.print("Servo is getting initialized. Servo number: "); //print message
Serial.println(servonum); //print servo number
driver.begin(); //begin I²C communivation with driver
driver.setPWMFreq(125); //set driver pwm frequency to 125 Hz
delay(10); //wait for 10 ms
this->servopwm=SERVOMIN; //initialize current pwm with minimum value
driver.setPWM(this->servonum, 0, this->servopwm); //set pwm for servo to initial position
return;
}
~ServoMotor(){
//empty destructor
}
};
Adafruit_PWMServoDriver ServoDriver = Adafruit_PWMServoDriver(); //driver object is initialized
ServoMotor shoulder(0, ServoDriver); //servo object is initialized
void setup() {
//nothing to do here
}
void loop() {
shoulder.drive(90); //drive shoulder servo to 90 deg
delay(2000);
shoulder.drive(120);
delay(2000);
shoulder.drive(30);
delay(2000);
}