From 76c05f94b48a593a5a75ae362133bf722130cb0f Mon Sep 17 00:00:00 2001
From: Marvin Harms <harmsm@ethz.ch>
Date: Tue, 21 Jun 2022 17:27:32 +0200
Subject: [PATCH] added error catch on trajectory read

---
 .../FixedwingPositionINDIControl.cpp                   | 10 ++++++++--
 1 file changed, 8 insertions(+), 2 deletions(-)

diff --git a/src/modules/fw_dyn_soar_control/FixedwingPositionINDIControl.cpp b/src/modules/fw_dyn_soar_control/FixedwingPositionINDIControl.cpp
index d2b8850b51..5a2067322f 100644
--- a/src/modules/fw_dyn_soar_control/FixedwingPositionINDIControl.cpp
+++ b/src/modules/fw_dyn_soar_control/FixedwingPositionINDIControl.cpp
@@ -438,7 +438,10 @@ FixedwingPositionINDIControl::_read_trajectory_coeffs_csv(char *filename)
             
             // loop over columns
             while (value) {
-
+                if (*value=='\0'||*value==' ') {
+                    // simply skip extra characters
+                    continue;
+                }
                 switch(row){
                     case 0:
                         _basis_coeffs_x(column) = (float)atof(value);
@@ -460,7 +463,10 @@ FixedwingPositionINDIControl::_read_trajectory_coeffs_csv(char *filename)
             }
             row++;
         }
-        fclose(fp);
+        int failure = fclose(fp);
+        if (failure==-1) {
+            PX4_ERR("Can't close file");
+        }
     }
     // =======================================================================