Making an ESP32-based quadcopter from scratch
Python arduinoautopilotcontrol-theorydroneesp32flight-controlflight-controllermavlinkquadcopterquadcopter-firmwareuav
Apply LPF to Gazebo's accel data to remove collision detector glitches, minor cleanups
Oleg Kalachevfcd695fdd7ff
diff --git a/gazebo/flix.cpp b/gazebo/flix.cppindex acb27ff..773c1ab 100644--- a/gazebo/flix.cpp+++ b/gazebo/flix.cpp@@ -43,6 +43,8 @@#include "control.ino"#include "log.ino"#include "cli.ino"+#include "debug.ino"+#include "lpf.h"using ignition::math::Vector3d;using ignition::math::Pose3d;@@ -69,7 +71,7 @@ private:event::ConnectionPtr updateConnection, resetConnection;transport::NodePtr nodeHandle;transport::PublisherPtr motorPub[4];- ofstream log;+ LowPassFilter<Vector> accFilter = LowPassFilter<Vector>(0.1);public:void Load(physics::ModelPtr _parent, sdf::ElementPtr /*_sdf*/)@@ -112,7 +114,7 @@ public:// read imurates = flu2frd(imu->AngularVelocity());- acc = flu2frd(imu->LinearAcceleration());+ acc = this->accFilter.update(flu2frd(imu->LinearAcceleration()));// read rcjoystickGet();@@ -220,11 +222,6 @@ public:motorPub[i]->Publish(msg);}}-- void logData() {- if (!log.is_open()) return;- log << this->model->GetWorld()->SimTime() << "\t" << rollRatePID.derivative << "\t" << pitchRatePID.derivative << "\n";- }};GZ_REGISTER_MODEL_PLUGIN(ModelFlix)