please just work

Author: mpkarpov-ui

MIDAS/src/hilsim/kal.cpp

@@ -119,7 +119,7 @@ DECLARE_THREAD(hilsim, void*arg) {
 
 // ---- ENTRY FUNCS ----
 void k_run() {
-    Serial.begin(115200);
+    Serial.begin(921600);
     // while(!Serial);
 
     k_push_event(K_START_E);

MIDAS/src/hilsim/stream/main.cpp

@@ -438,6 +438,10 @@ int main(int argc, char** argv) {
                                 printf(".r %i\n", latency);
                                 fflush(stdout);
 
+                                if (latency > (int)(skip_threshold*1000)) {
+                                    continue;
+                                }
+
                                 // check filter
                                 if(!ignore_disc[entry.disc]) {
                                     float randm = static_cast<float>(rand())/static_cast<float>(RAND_MAX);