modules.h

C/C++ header · 58 lines

#ifndef MODULES_H
#define MODULES_H

#include <Arduino.h>
#include <ESP32Servo.h>
#include <Wire.h>
#include <BluetoothSerial.h>
#include <Adafruit_MPU6050.h>
#include <Adafruit_BMP280.h>
#include "DHT.h"

// Logging
#define SERIAL_LOG_LINES 20
String serialLog[SERIAL_LOG_LINES];
int logIndex=0;
void addLog(String line){serialLog[logIndex++]=line;if(logIndex>=SERIAL_LOG_LINES)logIndex=0;Serial.println(line);}

// Bluetooth
BluetoothSerial SerialBT;

// Flight Timer
bool timerArmed=false;
bool flightStarted=false;
unsigned long launchTime=0;
unsigned long flightDuration=0;

// Sensors
Adafruit_MPU6050 mpu;
Adafruit_BMP280 bmp;
DHT dht(15,DHT11);
float accelMag=0, verticalVelocity=0, lastAltitude=0;
float temperature=0, humidity=0, pressure=0;
const float launchThreshold=1.5;

// Servo
Servo testServo;
int servoPos=90;
void initServo(){testServo.attach(13); testServo.write(servoPos);}
void servoLeft(){servoPos-=2;if(servoPos<0)servoPos=0;testServo.write(servoPos);}
void servoRight(){servoPos+=2;if(servoPos>180)servoPos=180;testServo.write(servoPos);}
void servoCenter(){servoPos=90;testServo.write(servoPos);}

// LEDs
#define LED_R 25
#define LED_G 26
#define LED_B 27
void initLEDs(){pinMode(LED_R,OUTPUT);pinMode(LED_G,OUTPUT);pinMode(LED_B,OUTPUT);digitalWrite(LED_R,LOW);digitalWrite(LED_G,LOW);digitalWrite(LED_B,LOW);}
void setLED(int r,int g,int b){analogWrite(LED_R,r);analogWrite(LED_G,g);analogWrite(LED_B,b);}
void updateLEDAnimation(){int val=min(255,(int)accelMag*5);setLED(val,255-val,val/2);}

// Functions
void initAll(){mpu.begin();bmp.begin(0x76);dht.begin();initServo();initLEDs();lastAltitude=bmp.readAltitude(1013.25);}
void calibrateAccel(){Serial.println("Accelerometer calibration triggered");}
void handleBTCommands(){if(SerialBT.available()){String cmd=SerialBT.readStringUntil('\n');cmd.trim();if(cmd=="LEFT")servoLeft();else if(cmd=="RIGHT")servoRight();else if(cmd=="CENTER")servoCenter();else if(cmd.startsWith("LED")){int r=cmd.substring(3,6).toInt();int g=cmd.substring(6,9).toInt();int b=cmd.substring(9,12).toInt();setLED(r,g,b);} else if(cmd=="CALIB")calibrateAccel();addLog("BT CMD -> "+cmd);}}
void updateSensorCalculations(){sensors_event_t a,g,tempEvt; mpu.getEvent(&a,&g,&tempEvt);accelMag=sqrt(a.acceleration.x*a.acceleration.x+a.acceleration.y*a.acceleration.y+a.acceleration.z*a.acceleration.z);float currentAltitude=bmp.readAltitude(1013.25);verticalVelocity=currentAltitude-lastAltitude;lastAltitude=currentAltitude;temperature=bmp.readTemperature();humidity=dht.readHumidity();pressure=bmp.readPressure();}
void updateFlightTimer(){sensors_event_t a,g,tempEvt; mpu.getEvent(&a,&g,&tempEvt);float accelChange=sqrt(a.acceleration.x*a.acceleration.x+a.acceleration.y*a.acceleration.y+a.acceleration.z*a.acceleration.z);if(timerArmed&&!flightStarted){if(accelChange>launchThreshold){flightStarted=true;launchTime=millis();addLog("Flight timer started");}}if(flightStarted){flightDuration=millis()-launchTime;if(accelChange<0.2){flightStarted=false;timerArmed=false;addLog("Flight timer stopped");}}}

#endif