0,0 → 1,329 |
/***************************************************************************** |
* Copyright (C) 2008 Thomas Kaiser, thomas@ft-fanpage.de * |
* Copyright (C) 2009 Peter "woggle" Mack, mac@denich.net * |
* Copyright (C) 2013 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/interrupt.h> |
#include <avr/eeprom.h> |
#include <stdbool.h> |
#include <avr/wdt.h> |
#include "../lcd/lcd.h" |
#include "../main.h" |
#include "../timer/timer.h" |
#include "eeprom.h" |
#include "../wi232/Wi232.h" |
#include "../setup/setup.h" |
#include "../bluetooth/bluetooth.h" |
#include "../mk-data-structs.h" |
#include "../connect.h" |
#include "../tracking/ng_servo.h" |
#include "../tracking/tracking.h" |
//------------------------------------------------------------------------------------------ |
|
ST EEMEM EEStruct; |
|
ST Config; |
|
//------------------------------------------------------------------------------------------ |
void WriteWiInitFlag(void) |
{ |
Config.WiIsSet = true; |
// WriteParameter(); |
} |
|
|
//-------------------------------------------------------------- |
// |
void WriteBTInitFlag(void) |
{ |
Config.BTIsSet = true; |
// WriteParameter(); |
} |
//-------------------------------------------------------------- |
// |
void WriteBTSlaveFlag(void) |
{ |
Config.BTIsSlave = true; |
// WriteParameter(); |
} |
//-------------------------------------------------------------- |
// |
void WriteBTMasterFlag(void) |
{ |
Config.BTIsSlave = false; |
// WriteParameter(); |
|
} |
|
|
|
//-------------------------------------------------------------- |
// |
void WriteLastPosition(uint32_t ELongitude,uint32_t ELatitude) |
|
{ |
Config.LastLongitude = ELongitude; |
Config.LastLatitude = ELatitude; |
// WriteParameter(); |
|
} |
|
|
//-------------------------------------------------------------- |
// |
void ReadParameter (void) |
{ |
uint8_t update=false; |
|
eeprom_read_block((void*)&Config, (const void*)&EEStruct, sizeof(ST)); |
|
if (Config.Version != EEpromVersion) |
{ |
|
switch (Config.Version) |
{ |
case 0x77: // PKT Version 3.6.6a |
|
PointList_Clear(); |
update = true; |
break; |
|
case 0x78: // PKT Version 3.6.6b |
/* Do necessary steps to perform upgrade */ |
update = true; |
break; |
|
default:Delete_EEPROM(); //wenn kein Update möglich alles auf Default setzen |
break; |
} |
|
if (update) |
{ |
Config.Version = EEpromVersion; /* Update the EEPROM version number */ |
sei(); |
lcd_cls(); |
lcd_printp_at (0, 2, PSTR("EEPromUpdate to new"), 0); |
lcd_printp_at (0, 3, PSTR(" Version "), 0); |
lcd_printp_at (0, 5, PSTR("check the settings!"), 0); |
lcd_printp_at (18, 7, PSTR("OK"), 0); |
|
while (!get_key_press (1 << KEY_ENTER)); |
WriteParameter(); |
cli(); |
} |
} |
} |
|
|
void WriteParameter (void) |
{ |
copy_line(7); |
lcd_printp_at (0, 7, PSTR(" Write EEPROM "), 0); |
eeprom_update_block((const void*)&Config, (void*)&EEStruct, sizeof(ST)); |
paste_line(7); |
|
} |
|
|
|
//-------------------------------------------------------------- |
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); |
|
Config.MK_LowBat = 137; // 13,7V |
Config.DisplayTimeout = 0; // Display immer an |
Config.DisplayLanguage = 5; // default undefined |
Config.WiTXRXChannel = 1; // Kanal 1 MK Standard |
Config.WiNetworkGroup = 66; // Gruppe 66 MK Standard |
Config.WiNetworkMode = NetMode_Normal; // MK Standard |
Config.WiTXTO = TWaitTime16; // MK Standard |
Config.WiUartMTU = UartMTU64; // MK Standard |
Config.LCD_ORIENTATION = 0; // normale Ansicht |
Config.LCD_DisplayMode = 0; // Normal |
Config.LCD_Kontrast = 20; // Kontrast normal |
Config.LCD_Helligkeit = 100; // Helligkeit in % |
Config.USBBT = 0; // USB Betrieb |
Config.U02SV2 = 0; // SV2 (Kabel) Standard |
Config.Debug = 0; // kein Debug |
Config.UseWi = false; // Wi.232 eingebaut? |
Config.UseBT = false; // BT-222 eingebaut? |
Config.WiIsSet = true; // Flag für die Initialisierung Wi232 |
Config.BTIsSet = true; // Flag für die Initialisierung Bluetooth |
Config.BTIsSlave = true; // Slave Flag setzen |
Config.PKT_IdleBeep = 0; // kein Piepsen bei Inaktivität |
Config.PKT_StartInfo = false; // Startinformationen anzeigen |
Config.PKT_Accutyp = true; // True = Lipo, False= LiON |
Config.OSD_RCErrorbeep = true; // OSD Receiveerrorbeep |
Config.OSD_InvertOut = false; // LED Anzeige invertiren |
Config.OSD_LEDform = 1; // Form der Anzeige ( + oder schwarz) |
Config.OSD_SendOSD = false; // OSD Daten an SV2 |
Config.OSD_Fallspeed = 40; // maximale Sinkrate |
Config.OSD_VarioBeep = 1; // Vario Beep ein |
Config.OSD_HomeMKView = true; // Home Circle from MK View |
Config.OSD_mAh_Warning = 10000; //mAh Warnschwelle |
Config.OSD_ScreenMode = 0; // Variante des OSD Screen |
Config.OSD_LipoBar = 0; //Bargraphanzeige für MK Lipo |
Config.PKT_Baudrate = Baud_57600; //Baudrate für BT und Wi232 |
Config.Lipo_UOffset = 6000; // Offset für PKT-Lipomessung |
Config.FM_Refresh = 500; // FollowMe interval |
Config.FM_Speed = 30; // FollowMe Speed in m/s *0.1 |
Config.FM_Radius = 5; // Waypoint Tolerance Radius in meter |
Config.HWSound = 0; // Hardware Sounderweiterung an PD7 |
Config.HWBeeper = 1; // Hardware Beeper an PC7 |
Config.Volume = 0; //Lautstärke |
Config.LastLongitude = 88199720; |
Config.LastLatitude = 522039630; |
|
strcpy_P(Config.bt_pin, PSTR("0000")); |
strcpy_P(Config.bt_name, PSTR("PKT Cebra ")); // Wenn Name kürzer als "bt_name_length" mit Leerzeichen auffüllen |
strcpy_P(Config.bt_Mac, PSTR("0000-00-000000")); |
strcpy_P(Config.RE_ID, PSTR("0000")); |
for(uint8_t i = 0; i < 20; i++) |
{ |
Config.gps_UsedDevName[i] = 0; // benutztes GPS Device Name |
} |
for(uint8_t i = 0; i < 14; i++) |
{ |
Config.gps_UsedMac[i] = '0'; // benutztes GPS Device Mac Adresse |
} |
Config.gps_UseGPS = false; // ist GPS aktiv? |
Config.gps_UsedGPSMouse = GPS_Bluetoothmouse1; |
Config.WiIsSet = false; |
Config.BTIsSet = false; |
Config.Version = EEpromVersion; |
Config.sIdxSteps= STEPS_255; |
Config.servo[0].rev = SERVO_REV; |
Config.servo[0].min = SERVO_I0_RIGHT; |
Config.servo[0].max = SERVO_I0_LEFT; |
Config.servo[0].mid = SERVO_I0_MIDDLE; |
Config.servo[1].rev = SERVO_REV; |
Config.servo[1].min = SERVO_I0_RIGHT; |
Config.servo[1].max = SERVO_I0_LEFT; |
Config.servo[1].mid = SERVO_I0_MIDDLE; |
Config.servo_frame = SERVO_PERIODE; |
Config.single_step= SINGLE_STEP; // nur bei Test-Servo |
Config.repeat= REPEAT; // nur bei Test-Servo |
Config.pause = PAUSE; // nur bei Test-Servo |
Config.pause_step= PAUSE_STEP; // nur bei Test-Servo |
Config.tracking = TRACKING_MIN; |
Config.track_hyst = TRACKING_HYSTERESE; |
Config.track_tx = 0; |
|
for (uint8_t i = 0; i < 5; i++) { |
Config.stick_min[i] = 30+i; |
Config.stick_max[i] = 270+i; |
Config.stick_typ[i] = 0; |
Config.stick_dir[i] = 0; |
Config.stick_neutral[i] = 0; |
} |
Config.Lipomessung = true; |
PointList_Clear(); |
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); |
sei (); |
set_beep ( 200, 0x0080, BeepNormal); |
do{} |
while (!(get_key_press (1 << KEY_ENTER))); |
|
#if defined HWVERSION3_9 |
clr_V_On(); |
#else |
|
wdt_enable( WDTO_250MS ); |
while (1) |
{;} |
#endif |
} |
|
|
//-------------------------------------------------------------- |
// |
//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); |
|
//} |
Property changes: |
Added: svn:mime-type |
+text/plain |
\ No newline at end of property |