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

Pre-test 1

Browse Source
This commit is contained in:
Aditya Pulipaka
2025-11-20 15:22:53 -06:00
parent f3293609f0
commit 6865306d9c
2 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
lib/PseudoSensorControl.cpp
View File

@@ -39,10 +39,10 @@ void PseudoSensorController::sendOutputs() {
void PseudoSensorController::control() {
float avg = (Left.mmVal + Right.mmVal + Front.mmVal + Back.mmVal) * 0.25f;
float pseudos[4] = {Front.mmVal + Left.mmVal - avg,
Front.mmVal + Right.mmVal - avg,
Back.mmVal + Left.mmVal - avg,
Back.mmVal + Right.mmVal - avg};
float pseudos[4] = {Front.mmVal + Left.mmVal - avg, // FL
Front.mmVal + Right.mmVal - avg, // FR
Back.mmVal + Left.mmVal - avg, // BL
Back.mmVal + Right.mmVal - avg}; // BR
for (uint8_t i = 0; i < 4; i++) {
float eCurr = Refs[i] - pseudos[i]; // Above reference is positive error.