Fix GPS load/save ephems

See Libelium/waspmoteapi#25
spectraphilic · May 8, 2020 · a7bbdc1 · a7bbdc1
1 parent 4ded379
commit a7bbdc1
Showing 1 changed file with 10 additions and 3 deletions.
diff --git a/libraries/GPS/WaspGPS.cpp b/libraries/GPS/WaspGPS.cpp
@@ -2457,9 +2457,13 @@ int8_t WaspGPS::saveEphems(const char* filename)
 	uint8_t endFile[7] ={0xAA,0xBB,0xCC,0xCC,0xBB,0xAA,0xAA};
 
 	// First of all, prepare SD card.
-	SD.ON();
+	bool _SD_ON = (WaspRegister & REG_SD);
+	if (! _SD_ON)
+	{
+		SD.ON();
+	}
 
-	// check if the card is there or not
+        // check if the card is there or not
 	if (!SD.isSD())
 	{
 		#ifdef DEBUG_MODE
@@ -2588,7 +2592,10 @@ int8_t WaspGPS::saveEphems(const char* filename)
 	SD.append(filename, endFile, 7);
 
 	// Turn OFF SD card
-	SD.OFF();
+	if (! _SD_ON)
+	{
+		SD.OFF();
+	}
 
 	// Now change to NMEA mode
 	setCommMode(NMEA_MODE);