Racelogic / Mbed 2 deprecated VIPS_LTC_RAW_IMU

I messed up the merge, so pushing it over to another repo so I don't lose it. Will tidy up and remove later

Dependencies:   BufferedSerial FatFileSystemCpp mbed

Files at this revision

API Documentation at this revision

Revision 28:7600b18ccb7a, committed 2021-07-20

Comitter:
JamieB
Date:
Tue Jul 20 11:37:51 2021 +0000
Parent:
27:498cce52fe5f
Child:
29:b0eaeefa4e63
Commit message:
Fix Hypersmooth Filter Seeding

Changed in this revision

VIPSSerialProtocol.cpp Show annotated file Show diff for this revision Revisions of this file 
--- a/VIPSSerialProtocol.cpp	Fri Jul 09 16:00:55 2021 +0000
+++ b/VIPSSerialProtocol.cpp	Tue Jul 20 11:37:51 2021 +0000
@@ -25,7 +25,7 @@
 
     enableAllUpdates = false;
     newFormatMsg = false;
-    
+
     queueLen = 0;
 
     SmoothBy = 500;
@@ -271,7 +271,7 @@
         return;
     }
 
- //   led1=!led1;
+//   led1=!led1;
 
     lastPositions[nextPosition].time = TimeSinceLastFrame.read_us();
     uint32_t mask = *(uint32_t*)(messageInBuffer+4);
@@ -406,8 +406,9 @@
         if (!SmoothRunning) {
             XSmoothTotal = posPtr->X * (SmoothBy - 1);
             YSmoothTotal = posPtr->Y * (SmoothBy - 1);
-            YSmoothTotal = posPtr->Height * (SmoothBy - 1);
+            ZSmoothTotal = posPtr->Height * (SmoothBy - 1);
             SmoothRunning = true;
+            pc.write("Seeded Filter\r\n",11);            
         }
         //smooth the KF_X and KF_Y positions
         XSmoothTotal += posPtr->X;