Subversion Repositories Projects

/*****************************************************************************

 *   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);

//}