Hallo zusammen, habe folgendes Problem: an einen ESP32 ist ein PCA9685(SDA(21), SCL(22)) und ein GYUS42-Sensor(SDA(15), SCL(4)).
Wenn man es einzeln testet funktioniert ohne Problem, der Servo erfüllt die Bedingungen sowie der Sensor misst die Entfernung, beides zusammen funktioniert nicht.
Ich finde den Fehler nicht.
Hier ist der nicht funktionierende Code:
1 |
#include <Wire.h>
|
2 |
#include <Adafruit_PWMServoDriver.h>
|
3 |
|
4 |
#define SERVO_PIN 0 // Der Kanal des PCA9685, an den der Servo angeschlossen ist
|
5 |
#define SensorAddresse 0x70
|
6 |
#define Reichweitenbefehl 0x51
|
7 |
|
8 |
#define PCA9685_SDA_PIN 21
|
9 |
#define PCA9685_SCL_PIN 22
|
10 |
|
11 |
#define SENSOR_SDA_PIN 15
|
12 |
#define SENSOR_SCL_PIN 4
|
13 |
|
14 |
TwoWire pca9685Wire = TwoWire(0);
|
15 |
TwoWire sensorWire = TwoWire(1);
|
16 |
|
17 |
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
|
18 |
|
19 |
unsigned long servoDelay = 15;
|
20 |
int minWinkel = 60;
|
21 |
int maxWinkel = 200;
|
22 |
int minServoimpulsBreite = 150;
|
23 |
int maxServoimpulsBreite = 600;
|
24 |
|
25 |
void setup() {
|
26 |
Serial.begin(115200);
|
27 |
while (!Serial);
|
28 |
|
29 |
pca9685Wire.begin(PCA9685_SDA_PIN, PCA9685_SCL_PIN);
|
30 |
|
31 |
pwm.begin();
|
32 |
pwm.setPWMFreq(60);
|
33 |
|
34 |
sensorWire.begin(SENSOR_SDA_PIN, SENSOR_SCL_PIN);
|
35 |
|
36 |
}
|
37 |
|
38 |
void loop() {
|
39 |
for (int winkel = minWinkel; winkel <= maxWinkel; winkel++) {
|
40 |
int pulsBreite = map(winkel, 0, 180, minServoimpulsBreite, maxServoimpulsBreite);
|
41 |
pwm.setPWM(SERVO_PIN, 0, pulsBreite);
|
42 |
|
43 |
delay(servoDelay);
|
44 |
|
45 |
Wire.beginTransmission(SensorAddresse);
|
46 |
Wire.write(Reichweitenbefehl);
|
47 |
Wire.endTransmission();
|
48 |
delay(65);
|
49 |
|
50 |
Wire.requestFrom(SensorAddresse, 2);
|
51 |
if (Wire.available() >= 2) {
|
52 |
byte highByte = Wire.read();
|
53 |
byte lowByte = Wire.read();
|
54 |
int distanz = highByte * 256 + lowByte;
|
55 |
// Verarbeite die Distanz
|
56 |
Serial.print("Winkel: ");
|
57 |
Serial.print(winkel);
|
58 |
Serial.print(" Grad, Entfernung: ");
|
59 |
Serial.print(distanz);
|
60 |
Serial.println(" cm");
|
61 |
}
|
62 |
}
|
63 |
}
|
