WebSVN - NaviCtrl - Diff - Rev 496 and 497

 #include <string.h>
 #include "91x_lib.h"
 #include "waypoints.h"
 #include "uart1.h"
 #include "fat16.h"
-#include "spi_slave.h"
+{
         File_t *fp;
         s8 wpline[LINE_MAX];
         u8 retval = WPL_ERROR;
         if(PointCount == 0) return(WPL_NO_WAYPOINTS);
         // user absolute path, i.e. leading /
         if(pWPL_Store->Index == 0)
+        {
                 sprintf(wpline, "/default.wpl");
+                }
                 // Create general section and key entries
                 fputs_("[General]\r\n", fp);
                 sprintf(wpline, "Name=%s\r\n",  pWPL_Store->Name);
                 fputs_(wpline, fp);
-                sprintf(wpline, "PositionType=%d\r\n",  pWPL_Store->Type);
-                fputs_(wpline, fp);
                 sprintf(wpline, "FileVersion=%d\r\n", WP_FILE_VERSION_COMPATIBLE);
                 fputs_(wpline, fp);
                 sprintf(wpline, "NumberOfWaypoints=%d\r\n", PointCount);
                 fputs_(wpline, fp);
                 // dump all points if existent
                                 fputs_(wpline, fp);
                                 // write point type
                                 sprintf(wpline, "Type=%d\r\n", PointList[i].Type + 1);
                                 fputs_(wpline, fp);
                                 // write prefix
-                                //if(PointList[i].Type == POINT_TYPE_WP) u8_1 = 'P';
-                                //else u8_1 = '0';
                                 sprintf(wpline, "Prefix=%s\r\n", PointList[i].Name);
                                 fputs_(wpline, fp);
                         } // EOF loop over all points
                 } // EOF if(PointCount)
                 if(EOF == fclose_(fp))
+                {
                         UART1_PutString("ok\r\n");
                         retval = WPL_OK;
+                }
         } // EOF if(Fat16_IsValid())
+        else
+        {
-        else UART1_PutString("no file system found!\r\n");
+                UART1_PutString("no file system found!\r\n");
+                retval = WPL_NO_SDCARD_FOUND;
+        }
         return(retval);
+}
 // load actual point list from SD card
         u8 i;
         u8 IsGeneralSection = 0;
         u8 IsPointSection  = 0;
         u8 WPNumber = 0;
         // user absolute path, i.e. leading /
         if(pWPL_Store->Index == 0) // index 0 looks for a default WPL file in the root
+        {
                 sprintf(wpline, "/default.wpl");
                                                         if(strcmp(name, "NUMBEROFWAYPOINTS") == 0)
+                                                        {
                                                                 WPNumber = (u8)atoi(value);
                                                                 if(!WPNumber) // no waypoints in file
+                                                                {
-                                                                        return(1); // we are done here
+                                                                        return(WPL_NO_WAYPOINTS); // we are done here
+                                                                }
                                                                 else if(WPNumber > MAX_LIST_LEN) // number o points larger than ram list
+                                                                {
                                                                         UART1_PutString("To much points!");
-                                                                        return(0);
+                                                                        return(WPL_ERROR);
+                                                                }
+                                                        }
                                                         else if (strcmp(name, "FILEVERSION") == 0)
+                                                        {
                                                                 if((u8)atoi(value) != WP_FILE_VERSION_COMPATIBLE)
                                                                 u8 len = strlen(value);
                                                                 if(len > 11)
                                                                 value[11] = 0;
                                                                 memcpy(pWPL_Store->Name, value, 12);
+                                                        }
-                                                        else if (strcmp(name, "POSITIONTYPE") == 0)
-                                                        {
-                                                                pWPL_Store->Type = (u8)atoi(value);
-                                                        }
                                                         else
+                                                        {
                                                                 UART1_PutString("Unknown key: ");
                                                                 UART1_PutString(name);
                                                                 UART1_PutString("\r\n");
                                 } // EOF key entry line
                         } // valid line
                 } // EOF loop over all lines
                 fclose_(fp);
                 NaviData.WaypointNumber = WPCount;
-                // if the WPS data are relative to home position
-                if(pWPL_Store->Type == WPL_STORE_TYPE_REL)
-                {       // try to shift the wp list
-                        if(PointList_Move(1, &(NaviData.HomePosition))) retval = WPL_OK;
-                        else
-                        {
-                                PointList_Clear(); // to avoid wrong absolute positions
-                                UART1_PutString("no reference position!\r\n");
-                        }
-                }
-                else
-                {       // nothing to do
-                        retval = WPL_OK;
+                retval = WPL_OK;
-                }
-                if(retval == WPL_OK) UART1_PutString("ok\r\n");
+                UART1_PutString("ok\r\n");
         } // EOF if(Fat16_IsValid())
+        else
+        {
-        else UART1_PutString("no file system found!\r\n");
+                UART1_PutString("no file system found!\r\n");
+                retval = WPL_NO_SDCARD_FOUND;
+        }
         return(retval);
+}
 // move actual point list to ref pos., the point in the list marked by index gets the RefPos afterwards

Subversion Repositories NaviCtrl

(root)/tags/V2.06f/waypoints.c @ 634 - Rev 496 → 497