adipu/guadaloop_lev_control
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

integral shi

Browse Source
This commit is contained in:
kellharpole
2025-11-16 12:11:03 -06:00
parent fcce2c179d
commit fb475f2ecf
1 changed files with 5 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

5
DualYokeControl (Previous Version).ino
View File

@@ -131,6 +131,11 @@ void loop() {
ecurr2 = ref2 - dist2;
derror2 = ecurr2 - eprior2;
ecum += ecurr * (telapsed / 1e6);
ecum = constrain(ecum, -MAX_INTEGRAL_TERM, MAX_INTEGRAL_TERM);
ecum2 += ecurr2 * (telapsed / 1e6);
ecum2 = constrain(ecum2, -MAX_INTEGRAL_TERM, MAX_INTEGRAL_TERM);
if (ON) {
int collective1 = levitate(ecurr, derror, ecum, oor);