Blame |
Last modification |
View Log
| RSS feed
/*****************************************************************************
* Copyright (C) 2008 Thomas Kaiser, thomas@ft-fanpage.de *
* Copyright (C) 2009 Peter "woggle" Mack, mac@denich.net *
* Copyright (C) 2011 Christian "Cebra" Brandtner, brandtner@brandtner.net *
* Copyright (C) 2011 Harald Bongartz *
* *
* This program is free software; you can redistribute it and/or modify *
* it under the terms of the GNU General Public License as published by *
* the Free Software Foundation; either version 2 of the License. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, write to the *
* Free Software Foundation, Inc., *
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
* *
* *
* Credits to: *
* Holger Buss & Ingo Busker from mikrokopter.de for the MK project + SVN *
* http://www.mikrokopter.de *
* Gregor "killagreg" Stobrawa for his version of the MK code *
* Thomas Kaiser "thkais" for the original project. See *
* http://www.ft-fanpage.de/mikrokopter/ *
* http://forum.mikrokopter.de/topic-4061-1.html *
* Claas Anders "CaScAdE" Rathje for providing the font and his C-OSD code *
* http://www.mylifesucks.de/oss/c-osd/ *
* Harald Bongartz "HaraldB" for providing his Ideas and Code for usibility*
*****************************************************************************/
#include "cpu.h"
#include <avr/io.h>
#include <avr/pgmspace.h>
#include <util/delay.h>
#include <stdlib.h>
#include <string.h>
#include <avr/eeprom.h>
#include <stdbool.h>
#include <avr/wdt.h>
#include "lcd.h"
#include "main.h"
#include "timer.h"
#include "eeprom.h"
#include "Wi232.h"
#include "mk-data-structs.h"
#include "connect.h"
//--------------------------------------------------------------
//
uint8_t EE_LowBat EEMEM = 137; // 13,7V
uint8_t EE_DisplayTimeout EEMEM = 0; // Display immer an
uint8_t EE_DisplayLanguage EEMEM = 254; // Default ungesetzt
uint8_t EE_WiTXRXChannel EEMEM = 1; // Kanal 1 MK Standard
uint8_t EE_WiNetworkGroup EEMEM = 66; // Gruppe 66 MK Standard
uint8_t EE_WiNetworkMode EEMEM = NetMode_Normal; // MK Standard;
uint8_t EE_WiTXTO EEMEM = TWaitTime16; // MK Standard
uint8_t EE_WiUartMTU EEMEM = UartMTU64; // MK Standard
uint8_t EE_LCD_Orientation EEMEM = 0; // normale Ansicht
uint8_t EE_LCD_DisplayMode EEMEM = 0; // Normal
uint8_t EE_LCD_Kontrast EEMEM = 27; // Kontrast normal
uint8_t EE_LCD_Helligkeit EEMEM = 100; // Helligkeit in %gkeit in %
uint8_t EE_USBBT EEMEM = 0; // USB Betrieb
uint8_t EE_U02SV2 EEMEM = 1; // SV2 (Kabel) Standard
uint8_t EE_Debug EEMEM = 0; // kein Debug
uint8_t EE_UseWi EEMEM = true; // Wi.232 eingebaut?
uint8_t EE_UseBT EEMEM = true; // BT-222 eingebaut?
uint8_t EE_BTIsSlave EEMEM = true; // BT-222 Slave gesetzt?
uint8_t EE_WiIsSet EEMEM = false; // Flag für die Initialisierung Wi232
uint8_t EE_BTIsSet EEMEM = false; // Flag für die Initialisierung Bluetooth
uint8_t EE_PKT_IdleBeep EEMEM = 0; // kein Piepsen bei Inaktivität
uint8_t EE_PKT_StartInfo EEMEM = true; // Startinformationen anzeigen
uint16_t EE_Lipo_UOffset EEMEM = 0; // Offset für die Lipospannugsmessung
uint8_t EE_PKT_Accutyp EEMEM = true; // True = Lipo, False = LiON
uint8_t EE_OSD_RCErrorbeep EEMEM = true; //Empfangsausffallwarnung im OSD Screen
uint8_t EE_OSD_InvertOut EEMEM = false; // Invertierte Anzeige Out1 und Out2
uint8_t EE_OSD_LEDform EEMEM = 1; // Form der Anzeige ( + oder schwarz)
uint8_t EE_OSD_SendOSD EEMEM = false; // Sende OSD-Daten an SV2
uint8_t EE_OSD_Fallspeed EEMEM = 0; // Maximal Sinkrate, für Warnmeldung
uint8_t EE_OSD_VarioBeep EEMEM = 1; // Vario Beep im OSD Screen
uint8_t EE_OSD_HomeMKView EEMEM = true; // Home Circle from MK-View
uint16_t EE_OSD_mAh_Warning EEMEM = 10000; //Warnschwelle für mAh
uint8_t EE_OSD_ScreenMode EEMEM = 0; //Variante des OSD-Screen
uint8_t EE_OSD_LipoBar EEMEM = 0; //Bargraphanzeige für MK Lipo
uint8_t EE_PKT_Baudrate EEMEM = Wi232_57600; // Baudrate für BT und Wi232, siehe Wi223.h
uint16_t EE_FM_Refresh EEMEM = 500; // FollowMe interval
uint16_t EE_FM_Speed EEMEM = 30; // FollowMe Speed in m/s *0.1
uint16_t EE_FM_Radius EEMEM = 5; // Waypoint Tolerance Radius in meter
uint8_t EEMEM EE_BTPin[bt_pin_length + 1];
uint8_t EEMEM EE_BTName[bt_name_length + 1];
uint8_t EEMEM EE_gps_UsedDevName[20]; // benutztes GPS Device Name
uint8_t EEMEM EE_gps_UsedMac[14]; // benutztes GPS Device Mac Adresse
uint8_t EEMEM EE_gps_UseGPS; // ist GPS aktiv?
uint8_t EEMEM EE_gps_UsedGPSMouse; // GPS Maustyp
uint32_t EE_LastLongitude EEMEM = 0;
uint32_t EE_LastLatitude EEMEM = 0;
WPListDirectory EEWPDirectory[NumberOfWPLists] EEMEM;
WayPoints EEWayPointList[NumberOfWaypoints] EEMEM;
uint8_t EE_PKTVersion EEMEM = EEpromVersion;
volatile uint8_t DisplayTimeout;
volatile uint8_t DisplayLanguage;
volatile uint8_t WiTXRXChannel;
volatile uint8_t WiNetworkGroup;
volatile uint8_t WiNetworkMode;
volatile uint8_t WiTXTO;
volatile uint8_t WiUartMTU;
volatile uint8_t LCD_ORIENTATION;
volatile uint8_t LCD_DisplayMode;
volatile uint8_t LCD_Kontrast;
volatile uint8_t LCD_Helligkeit;
volatile uint8_t USBBT;
volatile uint8_t U02SV2;
volatile uint8_t Debug;
volatile uint8_t UseWi; // Wi232 wird genutzt
volatile uint8_t UseBT; // BT wird genutzt
volatile uint8_t WiIsSet; // Wi232 ist initialisiert
volatile uint8_t BTIsSet; // BT ist initialisiert
volatile uint8_t BTIsSlave; // Slave Flag
char bt_pin[bt_pin_length + 1]; // BT Pinnummer
char bt_name[bt_name_length + 1]; // BT Name
char gps_UsedDevName[20]; // benutztes GPS Device Name
char gps_UsedMac[14]; // benutztes GPS Device Mac Adresse
volatile uint8_t gps_UseGPS; // ist GPS aktiv?
volatile uint8_t gps_UsedGPSMouse; // GPS Maustyp
volatile uint32_t LastLongitude; // Letzte Position
volatile uint32_t LastLatitude;
volatile uint8_t PKT_IdleBeep;
volatile uint8_t PKT_StartInfo;
volatile uint16_t Lipo_UOffset; // Offset für die Lipospannugsmessung
volatile uint8_t PKT_Accutyp; // verwendeter Akkutyp
volatile uint8_t OSD_RCErrorbeep; //Empfangsausffallwarnung im OSD Screen
volatile uint8_t OSD_InvertOut; // Out1/2 invertiert anzeigen
volatile uint8_t OSD_LEDform; // Form der Anzeige ( + oder schwarz)
volatile uint8_t OSD_SendOSD; // OSD Daten an SV2 senden
volatile uint8_t OSD_Fallspeed; // maximale Sinkrate
volatile uint8_t OSD_VarioBeep; // Vario Beep im OSD Screen
volatile uint8_t OSD_HomeMKView; // Home Circle from MK-View
volatile uint16_t OSD_mAh_Warning; // mAh Warnschwelle
volatile uint8_t OSD_ScreenMode; //Variante des OSD-Screen
volatile uint8_t OSD_LipoBar; //Bargraphanzeige für MK Lipo
volatile uint8_t PKT_Baudrate; // Baudrate für BT und Wi232
volatile uint16_t FM_Refresh; // FollowMe interval
volatile uint16_t FM_Speed; // FollowMe Speed in m/s *0.1
volatile uint16_t FM_Radius; // Waypoint Tolerance Radius in meter
volatile WayPoints PKTWayPoint; // Waypointdaten für einen Waypoint
volatile WPListDirectory PKTWayPointDirectory; // Inhaltsverzeichnis der Listen
//--------------------------------------------------------------
//
void WriteWiInitFlag(void)
{
WiIsSet = true;
eeprom_write_byte(&EE_WiIsSet, WiIsSet);
}
//--------------------------------------------------------------
//
void WriteBTInitFlag(void)
{
BTIsSet = true;
eeprom_write_byte(&EE_BTIsSet, BTIsSet);
}
//--------------------------------------------------------------
//
void WriteBTSlaveFlag(void)
{
BTIsSlave = true;
eeprom_write_byte(&EE_BTIsSlave, BTIsSlave);
}
//--------------------------------------------------------------
//
void WriteBTMasterFlag(void)
{
BTIsSlave = false;
eeprom_write_byte(&EE_BTIsSlave, BTIsSlave);
}
//--------------------------------------------------------------
//
void ReadLastPosition(void)
{
LastLongitude = eeprom_read_dword(&EE_LastLongitude);
LastLatitude = eeprom_read_dword(&EE_LastLatitude);
}
//--------------------------------------------------------------
//
void WriteLastPosition(uint32_t ELongitude,uint32_t ELatitude)
{
eeprom_write_dword(&EE_LastLongitude,ELongitude);
eeprom_write_dword(&EE_LastLatitude,ELatitude);
}
//--------------------------------------------------------------
//
void ReadParameter (void)
{
if (eeprom_read_byte(&EE_PKTVersion) == EEpromVersion)
{
MK_LowBat = eeprom_read_byte (&EE_LowBat);
DisplayTimeout = eeprom_read_byte (&EE_DisplayTimeout);
DisplayLanguage = eeprom_read_byte (&EE_DisplayLanguage);
WiTXRXChannel = eeprom_read_byte (&EE_WiTXRXChannel);
WiNetworkGroup = eeprom_read_byte (&EE_WiNetworkGroup);
WiNetworkMode = eeprom_read_byte (&EE_WiNetworkMode);
WiTXTO = eeprom_read_byte (&EE_WiTXTO);
WiUartMTU = eeprom_read_byte (&EE_WiUartMTU);
LCD_ORIENTATION = eeprom_read_byte (&EE_LCD_Orientation);
LCD_DisplayMode = eeprom_read_byte (&EE_LCD_DisplayMode);
LCD_Kontrast = eeprom_read_byte (&EE_LCD_Kontrast);
LCD_Helligkeit = eeprom_read_byte (&EE_LCD_Helligkeit);
USBBT = eeprom_read_byte (&EE_USBBT);
U02SV2 = eeprom_read_byte (&EE_U02SV2);
Debug = eeprom_read_byte (&EE_Debug);
UseWi = eeprom_read_byte (&EE_UseWi);
UseBT = eeprom_read_byte (&EE_UseBT);
WiIsSet = eeprom_read_byte (&EE_WiIsSet);
BTIsSet = eeprom_read_byte (&EE_BTIsSet);
BTIsSlave = eeprom_read_byte (&EE_BTIsSlave);
PKT_IdleBeep = eeprom_read_byte (&EE_PKT_IdleBeep);
PKT_StartInfo = eeprom_read_byte (&EE_PKT_StartInfo);
Lipo_UOffset = eeprom_read_word (&EE_Lipo_UOffset);
PKT_Accutyp = eeprom_read_byte (&EE_PKT_Accutyp);
OSD_RCErrorbeep = eeprom_read_byte (&EE_OSD_RCErrorbeep);
OSD_InvertOut = eeprom_read_byte (&EE_OSD_InvertOut);
OSD_LEDform = eeprom_read_byte (&EE_OSD_LEDform);
OSD_SendOSD = eeprom_read_byte (&EE_OSD_SendOSD);
OSD_Fallspeed = eeprom_read_byte (&EE_OSD_Fallspeed);
OSD_VarioBeep = eeprom_read_byte (&EE_OSD_VarioBeep);
OSD_HomeMKView = eeprom_read_byte (&EE_OSD_HomeMKView);
OSD_mAh_Warning = eeprom_read_word (&EE_OSD_mAh_Warning);
OSD_ScreenMode = eeprom_read_byte (&EE_OSD_ScreenMode);
OSD_LipoBar = eeprom_read_byte (&EE_OSD_LipoBar);
PKT_Baudrate = eeprom_read_byte (&EE_PKT_Baudrate);
FM_Refresh = eeprom_read_word (&EE_FM_Refresh);
FM_Speed = eeprom_read_word (&EE_FM_Speed);
FM_Radius = eeprom_read_word (&EE_FM_Radius);
New_Baudrate = PKT_Baudrate; // Merkzellen setzen
Old_Baudrate = PKT_Baudrate;
eeprom_read_block ((void*)&bt_pin, (const void*)&EE_BTPin, bt_pin_length);
eeprom_read_block ((void*)&bt_name, (const void*)&EE_BTName, bt_name_length);
eeprom_read_block ((void*)&gps_UsedDevName, (const void*)&EE_gps_UsedDevName, 20);
eeprom_read_block ((void*)&gps_UsedMac, (const void*)&EE_gps_UsedMac, 14);
gps_UseGPS = eeprom_read_byte (&EE_gps_UseGPS);
gps_UsedGPSMouse = eeprom_read_byte (&EE_gps_UsedGPSMouse);
LastLongitude = eeprom_read_dword (&EE_LastLongitude);
LastLatitude = eeprom_read_dword (&EE_LastLatitude);
}
else
Delete_EEPROM();
}
//--------------------------------------------------------------
void Delete_EEPROM(void)
{
// EEPROM auf Default setzen
lcd_cls();
lcd_printp_at (0, 0, PSTR(" EEPROM Parameter "), 2);
lcd_printp_at (0, 1, PSTR("werden auf"), 0);
lcd_printp_at (0, 2, PSTR("Standardwerte gesetzt"), 0);
MK_LowBat = 137; // 13,7V
DisplayTimeout = 0; // Display immer an
DisplayLanguage = 1; // default englisch
WiTXRXChannel = 1; // Kanal 1 MK Standard
WiNetworkGroup = 66; // Gruppe 66 MK Standard
WiNetworkMode = NetMode_Normal; // MK Standard
WiTXTO = TWaitTime16; // MK Standard
WiUartMTU = UartMTU64; // MK Standard
LCD_ORIENTATION = 0; // normale Ansicht
LCD_DisplayMode = 0; // Normal
LCD_Kontrast = 20; // Kontrast normal
LCD_Helligkeit = 100; // Helligkeit in %
USBBT = 0; // USB Betrieb
U02SV2 = 0; // SV2 (Kabel) Standard
Debug = 0; // kein Debug
UseWi = true; // Wi.232 eingebaut?
UseBT = true; // BT-222 eingebaut?
WiIsSet = false; // Flag für die Initialisierung Wi232
BTIsSet = false; // Flag für die Initialisierung Bluetooth
BTIsSlave = true; // Slave Flag setzen
PKT_IdleBeep = 0; // kein Piepsen bei Inaktivität
PKT_StartInfo = true; // Startnformationen anzeigen
PKT_Accutyp = true; // True = Lipo, False= LiON
OSD_RCErrorbeep = true; // OSD Receiveerrorbeep
OSD_InvertOut = false; // LED Anzeige invertiren
OSD_LEDform = 1; // Form der Anzeige ( + oder schwarz)
OSD_SendOSD = false; // OSD Daten an SV2
OSD_Fallspeed = 40; // maximale Sinkrate
OSD_VarioBeep = 1; // Vario Beep ein
OSD_HomeMKView = true; // Home Circle from MK View
OSD_mAh_Warning = 10000; //mAh Warnschwelle
OSD_ScreenMode = 0; // Variante des OSD Screen
OSD_LipoBar = 0; //Bargraphanzeige für MK Lipo
PKT_Baudrate = Wi232_57600; //Baudrate für BT und Wi232
Lipo_UOffset = 6000; // Offset für PKT-Lipomessung
FM_Refresh = 500; // FollowMe interval
FM_Speed = 30; // FollowMe Speed in m/s *0.1
FM_Radius = 5; // Waypoint Tolerance Radius in meter
LastLongitude = 88199720;
LastLatitude = 522039630;
eeprom_write_dword(&EE_LastLongitude,LastLongitude);
eeprom_write_dword(&EE_LastLatitude,LastLatitude);
strcpy_P(bt_pin, PSTR("0000"));
eeprom_write_block ((const void*)&bt_pin, (void*)&EE_BTPin, bt_pin_length);
strcpy_P(bt_name, PSTR("PKT Cebra ")); // Wenn Name kürzer als "bt_name_length" mit Leerzeichen auffüllen
eeprom_write_block ((const void*)&bt_name, (void*)&EE_BTName, bt_name_length);
for(uint8_t i = 0; i < 20; i++)
{
gps_UsedDevName[i] = 0; // benutztes GPS Device Name
}
for(uint8_t i = 0; i < 14; i++)
{
gps_UsedMac[i] = '0'; // benutztes GPS Device Mac Adresse
}
gps_UseGPS = false; // ist GPS aktiv?
gps_UsedGPSMouse = 0;
eeprom_write_byte(&EE_WiIsSet,WiIsSet);
eeprom_write_byte(&EE_BTIsSet,BTIsSet);
eeprom_write_byte(&EE_PKTVersion,EEpromVersion);
WriteParameter();
// lcd_printp_at (0, 4, PSTR("Waypoints loeschen"), 0);
// EEWayPointList_Clear();
lcd_printp_at (0, 6, PSTR("!!Check Parameter!! "), 0);
lcd_printp_at (18, 7, PSTR("OK"), 0);
set_beep ( 200, 0x0080, BeepNormal);
do{}
while (!(get_key_short (1 << KEY_ENTER)));
// _delay_ms(500);
//#if defined HWVERSION3_9
// clr_V_On();
//#else
//
// wdt_enable( WDTO_250MS );
// while (1)
// {;}
//#endif
}
//--------------------------------------------------------------
//
void WriteParameter (void)
{
eeprom_write_byte (&EE_LowBat, MK_LowBat);
eeprom_write_byte (&EE_DisplayTimeout, DisplayTimeout);
eeprom_write_byte (&EE_DisplayLanguage, DisplayLanguage);
eeprom_write_byte (&EE_WiTXRXChannel, WiTXRXChannel);
eeprom_write_byte (&EE_WiNetworkGroup, WiNetworkGroup);
eeprom_write_byte (&EE_WiNetworkMode, WiNetworkMode);
eeprom_write_byte (&EE_WiTXTO, WiTXTO);
eeprom_write_byte (&EE_WiUartMTU, WiUartMTU);
eeprom_write_byte (&EE_LCD_Orientation, LCD_ORIENTATION);
eeprom_write_byte (&EE_LCD_DisplayMode, LCD_DisplayMode);
eeprom_write_byte (&EE_LCD_Kontrast, LCD_Kontrast);
eeprom_write_byte (&EE_LCD_Helligkeit, LCD_Helligkeit);
eeprom_write_byte (&EE_USBBT, USBBT);
eeprom_write_byte (&EE_U02SV2, U02SV2);
eeprom_write_byte (&EE_Debug, Debug);
eeprom_write_byte (&EE_UseWi, UseWi);
eeprom_write_byte (&EE_UseBT, UseBT);
eeprom_write_byte (&EE_WiIsSet, WiIsSet);
eeprom_write_byte (&EE_BTIsSet, BTIsSet);
eeprom_write_byte (&EE_BTIsSlave, BTIsSlave);
eeprom_write_byte (&EE_PKT_IdleBeep, PKT_IdleBeep);
eeprom_write_byte (&EE_PKT_StartInfo, PKT_StartInfo);
eeprom_write_word (&EE_Lipo_UOffset,Lipo_UOffset);
eeprom_write_byte (&EE_PKT_Accutyp, PKT_Accutyp);
eeprom_write_byte (&EE_OSD_RCErrorbeep, OSD_RCErrorbeep);
eeprom_write_byte (&EE_OSD_InvertOut, OSD_InvertOut);
eeprom_write_byte (&EE_OSD_LEDform, OSD_LEDform);
eeprom_write_byte (&EE_OSD_SendOSD, OSD_SendOSD);
eeprom_write_byte (&EE_OSD_Fallspeed, OSD_Fallspeed);
eeprom_write_byte (&EE_OSD_VarioBeep, OSD_VarioBeep);
eeprom_write_byte (&EE_OSD_HomeMKView, OSD_HomeMKView);
eeprom_write_word (&EE_OSD_mAh_Warning, OSD_mAh_Warning);
eeprom_write_byte (&EE_OSD_ScreenMode, OSD_ScreenMode);
eeprom_write_byte (&EE_OSD_LipoBar, OSD_LipoBar);
eeprom_write_byte (&EE_PKT_Baudrate, PKT_Baudrate);
eeprom_write_word (&EE_FM_Refresh,FM_Refresh);
eeprom_write_word (&EE_FM_Speed,FM_Speed);
eeprom_write_word (&EE_FM_Radius,FM_Radius);
eeprom_write_block ((const void*)&bt_pin, (void*)&EE_BTPin, bt_pin_length);
eeprom_write_block ((const void*)&bt_name, (void*)&EE_BTName, bt_name_length);
eeprom_write_block ((const void*)&gps_UsedDevName, (void*)&EE_gps_UsedDevName, 20);
eeprom_write_block ((const void*)&gps_UsedMac, (void*)&EE_gps_UsedMac, 14);
eeprom_write_byte (&EE_gps_UseGPS,gps_UseGPS);
eeprom_write_byte (&EE_gps_UsedGPSMouse,gps_UsedGPSMouse);
}
//--------------------------------------------------------------
//
void EEWayPointList_Clear(void) // löschen der Waypointliste im EEProm
{
uint8_t i;
PKTWayPoint.Waypoint.Position.Latitude = 0;
PKTWayPoint.Waypoint.Position.Longitude = 0;
PKTWayPoint.Waypoint.Position.Altitude = 0;
PKTWayPoint.Waypoint.Heading = 361;
for(i = 0; i < MAX_WPLIST_LEN; i++)
{
PKTWayPointDirectory.WPList.WPDirectory[i] = 0;
}
for(i = 0; i < NumberOfWaypoints; i++)
{
lcd_printp (PSTR("."), 0);
eeprom_write_byte (&EEWayPointList[i].WPIndex, i);
eeprom_write_byte (&EEWayPointList[i].Waypoint.Position.Status, INVALID);
eeprom_write_block ((const void*)&PKTWayPoint.Waypoint.Position.Latitude, (void*)&EEWayPointList[i].Waypoint.Position.Latitude, sizeof(EEWayPointList[i].Waypoint.Position.Latitude));
eeprom_write_block ((const void*)&PKTWayPoint.Waypoint.Position.Longitude, (void*)&EEWayPointList[i].Waypoint.Position.Longitude, sizeof(EEWayPointList[i].Waypoint.Position.Longitude));
eeprom_write_block ((const void*)&PKTWayPoint.Waypoint.Position.Altitude, (void*)&EEWayPointList[i].Waypoint.Position.Altitude, sizeof(EEWayPointList[i].Waypoint.Position.Altitude));
eeprom_write_block ((const void*)&PKTWayPoint.Waypoint.Heading, (void*)&EEWayPointList[i].Waypoint.Heading, sizeof(EEWayPointList[i].Waypoint.Heading));
eeprom_write_byte (&EEWayPointList[i].Waypoint.ToleranceRadius, 0); // in meters, if the MK is within that range around the target, then the next target is triggered
eeprom_write_byte (&EEWayPointList[i].Waypoint.HoldTime, 0); // in seconds, if the was once in the tolerance area around a WP, this time defines the delay before the next WP is triggered
eeprom_write_byte (&EEWayPointList[i].Waypoint.Type, POINT_TYPE_INVALID);
eeprom_write_byte (&EEWayPointList[i].Waypoint.Event_Flag, 0); // future implementation
eeprom_write_byte (&EEWayPointList[i].Waypoint.AltitudeRate, 0); // no change of setpoint
}
for(i = 0; i < NumberOfWPLists; i++)
{
lcd_printp (PSTR("."), 0);
eeprom_write_byte (&EEWPDirectory[i].WPList.WPListnumber, i);
eeprom_write_byte (&EEWPDirectory[i].WPList.WPListAktiv, false);
eeprom_write_byte (&EEWPDirectory[i].WPList.POI_CAM_NICK_CTR, 0);
eeprom_write_byte (&EEWPDirectory[i].WPList.UsePOI, 0);
eeprom_write_block ((const void*)&PKTWayPointDirectory.WPList.WPDirectory, (void*)&EEWPDirectory[i].WPList.WPDirectory, sizeof(EEWPDirectory[i].WPList.WPDirectory));
}
lcd_printp (PSTR("\r\n"), 0);
}