esp32AccelStepper — ESP32 simulation

An interactive ESP32 circuit simulation you can run free in your browser on Velxio, by lingl_205.

Components

Sketch code

#include <AccelStepper.h>
const int stepPin=14;
const int dirPin=27;
const int kPin=18;
bool gz=0;
int zjVal=1;
AccelStepper stepper(1,stepPin,dirPin);
#include <MPU6050_tockn.h>
MPU6050 mpu(Wire);
int angleX=0;
int angleY=0;
bool bFlag=0;
void zj(){
  if (stepper.distanceToGo()==0) {
    if (zjVal==1) {
      stepper.moveTo(50);
      zjVal=2;
    }else if (zjVal==2) {
      stepper.moveTo(-50);
      zjVal=3;
    }else if (zjVal==3) {
      stepper.moveTo(0);
      zjVal=4;
    }else if (zjVal==4) {
      delay(1000);
      zjVal=5;
    }
  }
  stepper.run(); 
}
void modeZT(){
  mpu.update();
  angleX=mpu.getAccAngleX();
  angleY=mpu.getAccAngleY();
  if (angleY>=45 and abs(angleX)<45) {
    stepper.moveTo(0);
  }else if (angleY<=-45 and abs(angleX)<45) {
    stepper.moveTo(100);
  }else if (angleX>=45 and abs(angleY)<45) {
    stepper.moveTo(-50);
  }else if (angleX<=-45 and abs(angleY)<45) {
    stepper.moveTo(50);
  }else if(abs(angleX)<45 and abs(angleY)<45){
    if(stepper.distanceToGo()==0){
      bFlag=!bFlag;
    }
    if (bFlag) {
      stepper.moveTo(-25);
    }else{
      stepper.moveTo(25);
    }
  }
  stepper.run();
}
void setup(){
  pinMode(stepPin, OUTPUT);
  pinMode(dirPin, OUTPUT);
  pinMode(kPin, INPUT);
  stepper.setMaxSpeed(500);
  stepper.setAcceleration(100);
  stepper.setCurrentPosition(0);
  Wire.begin();
  mpu.begin();
  mpu.calcGyroOffsets(1);
  Serial.begin(115200);
  Serial.println("Ready!");
  while (!digitalRead(kPin)) {}
}
void loop(){
  //stepper.moveTo(-5);
  //stepper.run();
  if(!gz) {
    zj();
    if(zjVal==5) {
      gz=1;
    }
  }else{
    modeZT();
  }
}

More projects by lingl_205