Final Draft Documentation: Servos Part
Arduino Code: #include < Adafruit_PWMServoDriver .h> #include < Wire .h> Adafruit_PWMServoDriver pwm0 = Adafruit_PWMServoDriver (0x40); Adafruit_PWMServoDriver pwm1 = Adafruit_PWMServoDriver (0x42); Adafruit_PWMServoDriver pwm2 = Adafruit_PWMServoDriver (0x44); #define servomin 125 #define servomax 575 #define gridSize 5 uint8_t servonum = 0; void setup () { Serial . begin (9600); pwm0. begin (); pwm1. begin (); pwm2. begin (); pwm0. setPWMFreq (60); pwm1. setPWMFreq (60); pwm2. setPWMFreq (60); } void loop () { int mx = analogRead (A0); int my = analogRead (A1); for (int y = 0; y < gridSize; y++) { for (int x = 0; x < gridSize; x++) { int index = (y * gridSize) + x; int targetX = map (x, 0, gridSize-1, 0, 1023); int targetY = map (y, 0, gridSize-1, 0, 1023); int valX = map ( abs (mx-targetX), ...


留言
發佈留言