ESP32 Sensor+Servo

[Andrea I. (andele)]

- ESP32
- 4x IR Sensor (lm393)
- 2x Servo (SG90)
- 2x DC Motoren
- 1X Adafruit 16-Kanal (PCA9685)

Hallo zusammen, habe folgendes Problem:
Versuche mit 4XSensoren und 2XServo Pan/Tilt nachzumachen, soweit 
funktionert das ohne Probleme. Jedoch wenn ich das als Webserver laufen 
lasse funktioniert das nicht ,bin am zweifeln und weiss nicht woran es 
liegt.
Das ganze ist einen kleiner roboter der über Wifi gesteuert wird und 
soll sein Kopf nach links/rechts/oben und unten bewegen je nach sensor 
aktivität.
Hoffe da kann jemand helfen.

INO sind gepackt im Anhang

[Stefan F. (Gast)]

Andrea I. schrieb:
> Jedoch wenn ich das als Webserver laufen
> lasse funktioniert das nicht

Was genau funktioniert nicht?

[Andrea I. (andele)]

Die reaktion der sensoren ist unterschiedlich, im Serial wird es zwar 
angezeigt aber es bewegt sich nur ein Servo, Servo1(links und rechts) 
funktioniert aber Servo2(oben und unten) nicht.

[Stefan F. (Gast)]

Dann reduziere dein Programm auf ganz kleine Demos, die nur jeweils eine 
Funktion durchtesten. Wenn das klappt, baue es schrittweise zusammen, 
bis es wieder nicht funktioniert. Dann weist du, in welchem Schritt der 
Fehler steckt.

Was die vielen String-Konstanten angeht: beschäftige dich mal mit dem 
F() Makro, sonst belegst du sehr viel Platz im ohnehin knappen Stack.

[leo (Gast)]

Stefan ⛄ F. schrieb:
> Was die vielen String-Konstanten angeht: beschäftige dich mal mit dem
> F() Makro,

Auf dem ESP32? Du sollst auch lesen, nicht nur posten.

leo

[Andrea I. (andele)]

So klappt es

#include <Adafruit_PWMServoDriver.h>
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
#define I2C_SDA 22
#define I2C_SCL 21

#define SERVOMIN 1100
#define SERVOMAX 3000

//Sensor pins
const int IR_O = 39;
const int IR_U = 36;
const int IR_L = 35;
const int IR_R = 34;

int posA = 40;
int posB = 60;
int stepsize = 2;

void setup() {
  Serial.begin(115200);
  Wire.begin(I2C_SDA, I2C_SCL);
  pinMode (IR_O, INPUT);
  pinMode (IR_U, INPUT);
  pinMode (IR_L, INPUT);
  pinMode (IR_R, INPUT);
  pwm.begin();
  pwm.setPWMFreq(50);
}

void loop() {
  bewegung();
}

void bewegung() {
  int statusSensor_O = digitalRead(IR_O);
  int statusSensor_U = digitalRead(IR_U);
  int statusSensor_R = digitalRead(IR_R);
  int statusSensor_L = digitalRead(IR_L);

  if (statusSensor_O == 0){
    Serial.println("Oben") ;
    posA = posA + stepsize;
    pwm.setPWM(4, 0, pulseWidth(posA));
    delay(10); 
    if (posA > 150){
      posA = 150;
    }    
  }
  
  if (statusSensor_U == 0){
    Serial.println("Unten") ;
    posA = posA - stepsize;
    pwm.setPWM(4, 0, pulseWidth(posA));
    delay(10);  
    if (posA < 40){
      posA = 40;
    }  
  }
  
  if (statusSensor_L == 0){
    Serial.println("Links") ;
    posB = posB + stepsize;
    pwm.setPWM(2, 0, pulseWidth(posB));
    delay(10);   
    if (posB > 120){
      posB = 120;     
    }  
  }
  
  if (statusSensor_R == 0){
    Serial.println("Rechts") ;
    posB = posB - stepsize;
    pwm.setPWM(2, 0, pulseWidth(posB));
    delay(10);
    if (posB < 10) {
      posB = 10;        
    }
  }
}

int pulseWidth(int angle){  
  int pulse_wide, analog_value;
  pulse_wide   = map(angle, 0, 180, SERVOMIN, SERVOMAX);
  analog_value = int(float(pulse_wide) / 1000000 * 50 * 4096);
  return analog_value;
}

[Stefan F. (Gast)]

Die berechneten Werte von pulseWidth() könntest du mal seriell ausgeben 
und kontrollieren. Auch in der Funktion setMotorsXY() könnten Debug 
Meldungen dabei helfen, nachzuvollziehen, was die Funktion bzw. ob sie 
das tut, was sie soll.

Die Schleife
> while (client.connected()) { ...}
blockiert deine Loop für lange Zeit. Eventuell löst da sogar der 
Watchdog aus. Ich würde da mal mindestens ein yield() einfügen. Besser 
wäre, das Programm mittels Zustandsautomaten so umzuschreiben, dass es 
überhaupt keine blockierenden Warteschleifen hat, also auch keine 
delay().

Deine Methode, einzelne Zeichen in der String Variable "header" zu 
sammeln, halte ich für ziemlich problematisch. Damit riskierst du, den 
Heap zu fragmentieren, so dass das Ding nach kurzer Laufzeit abstürzt. 
Da dies der einzige String ist, mit dem du das machst, hast du 
vermutlich noch Glück. Komplexere Anwendungen würden Dir aber mit hoher 
Wahrscheinlichkeit auf die Nase fallen.

Lies dir dazu mal das durch: 
https://cpp4arduino.com/2018/11/21/eight-tips-to-use-the-string-class-efficiently.html
Und das: https://www.mikrocontroller.net/articles/Heap-Fragmentierung
Und das: 
https://hackingmajenkoblog.wordpress.com/2016/02/04/the-evils-of-arduino-strings/

[Stefan F. (Gast)]

Andrea I. schrieb:
> So klappt es

Gut. Dann teste jetzt den Webserver ohne die Motoren anzusteuern. Kannst 
ja mit Textmeldungen ausgeben, welche die Funktion bestätigen.

[Andrea I. (andele)]

Danke Stefan für den Ansatzt, Habe ich alles ausprobiert und dies step 
by step eingebaut, der Webserver läuft ,habe extra noch drei Buttons 
eingebaut um das über Wifi zu bedienen, hab auch ein sensor nach den 
anderen abgebaut bzw. vertauscht. Die bewegungen Links+Rechts klappt nur 
halt Oben+Unten leider nicht.
Du sagst mit der > while (client.connected()) { ...} könnte konflikte 
geben?
wie würdest du das machen bzw. wie könnte man das machen?

[Stefan F. (Gast)]

Andrea I. schrieb:
> wie würdest du das machen bzw. wie könnte man das machen?

Füge da einen yield() ein oder delay(1) ein, dadurch wird etwas Zeit an 
das Betriebssystem abgegeben.

Und versuche mal, die String Variable durch ein char[] mist fester Größe 
zu ersetzen. Dann musst du natürlich auch die C Funktionen der 
<string.h> benutzen, die mit char[] operieren.

[Andrea I. (andele)]

So habe ich das verstanden

    while (client.connected()) { 
        delay(1);
      if (client.available()) {.........

------------------------------------------

//statt
client.println

//das?
const unsigned char client[]PROGMEM = {........

[Stefan F. (Gast)]

Das mit dem Delay ist gut. Deine Printlines sollst du mit dem F() Makro 
machen.

client.println(F("was auch immer"));

Ist viel kompakter, als mit PROGMEM herum zu fummeln.

[Andrea I. (andele)]

- delay blockiert die bedienung für die DC-Motoren.
- client.println(F("was auch immer")); habe es abgeändert jedoch sind 
keine änderungen bei den sensoren.

    while (client.connected()) { 
      delay(1);
      if (client.available()) {

[Stefan F. (Gast)]

Baue ganz viele debug Meldungen ein um den Ablauf und die Variablen zu 
kontrollieren.