PID Diagram for HefnyCopter - II Firmware

HefnyCopter2 implements full PID terms that is P, I & D. It uses the following approach.

My vision is to keep math as simple as possible and use superposition to accumulate different behaviors together based on my suggested framework.

Gyro values for balancing are in purple.

Accelerometer and accumulated Gyro are used together as a virtual angle device to get estimated Angle and implements the restoring function using a PID and are shown in green.

AccZ implements Positioning-Balancing and is shown in orange.

Sonar implements Positioning-Restoring and is shown in Red.


Please let me know how do you find this approach.


Views: 1030


You need to be a member of DIY Drones to add comments!

Join DIY Drones

© 2020   Created by Chris Anderson.   Powered by

Badges  |  Report an Issue  |  Terms of Service