Subversion Repositories Projects

Rev

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 <string.h>

#include "main.h"
//#include "menu.h"
#include "lcd.h"
#include "usart.h"
#include "debug.h"
#include "timer.h"
#include "messages.h"

#include "mk-data-structs.h"


#ifdef HWVERSION3_9


#define TIMEOUT 200             // 2 sec
#define ANALOGTIME 20   // 200 ms

// WARNING: this work for NC & FC only
//          if current_hardware == MK3MAG or MKGPS the access is outside of the array...
uint8_t AnalogNames[2][32][16 + 1];     // 32 names, 16 characters + 1 0x00
uint8_t AnalogNamesRead[2] = {0,0};

//--------------------------------------------------------------
//
void GetAnalogNames (void)
{
        uint8_t i = AnalogNamesRead[current_hardware - 1];
        uint8_t t = 0;

        lcd_cls ();
        lcd_printp_at (0, 3, PSTR("Reading"), 0);
        lcd_printp_at (0, 4, PSTR("Analog Names: "), 0);

        mode = 'A';     // read Names
        _delay_ms(200);
        rxd_buffer_locked = FALSE;

        timer = ANALOGTIME;

        while (i < 32)
        {
                SendOutData ('a', ADDRESS_ANY, 1, &i, 1);
                while (!rxd_buffer_locked && timer);
                if (timer)
                {
                        Decode64 ();
                        if (i == *pRxData)
                        {
                                write_ndigit_number_u(14, 4, i, 2, 0,0);
                                memcpy (AnalogNames[current_hardware - 1][*pRxData], (uint8_t *) pRxData + 1, 16);
                                AnalogNames[current_hardware - 1][*pRxData][16] = 0;
                                i++;
                                t = 0;
                        }
                        else
                        {
                                _delay_ms (100);
                        }

                        timer = ANALOGTIME;
                        rxd_buffer_locked = FALSE;
                }
                else
                {       // timeout occured
                        t++;
                        timer = ANALOGTIME;

                        if (t >= 50)
                        {
                                lcd_printp_at (0, 2, PSTR("ERROR: no data"), 0);

                                timer = 100;
                                while (timer > 0);
                                break;
                        }
                }
        }

        AnalogNamesRead[current_hardware - 1] = i;

#if 0
        if (timer)
        {
                for (page = 0; page < 5; page++)
                {
                        for (i = 0; i < 7; i++)
                        {
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 7], 0);
                        }
                        while (!get_key_press (1 << KEY_ESC));  // ESC
                                get_key_press(KEY_ALL);
                }
        }
        //return;
#endif
}


//--------------------------------------------------------------
//
void display_debug (void)
{
        uint8_t i = 0;
        uint8_t tmp_dat;
        uint8_t page = 0;

        DebugData_t *DebugData;

        lcd_cls ();

        timer = TIMEOUT;

        if (AnalogNamesRead[current_hardware - 1] < 32)
        {
                GetAnalogNames ();
        }

        if (!timer)
        {
                return;
        }

        mode = 'D';     // Debug Data
        rxd_buffer_locked = FALSE;
        timer = TIMEOUT;

        tmp_dat = 10;
        SendOutData ('d', ADDRESS_ANY, 1, &tmp_dat, 1);
        abo_timer = ABO_TIMEOUT;

        for (i = 0; i < 7; i++)
        {
                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 7], 0);
                                if (page == 4 && i > 3)
                                {
                                        for (i = 4; i < 7; i++)   // Linie 4, 5, 6 loeschen
                                        {
                                                lcd_cls_line (0, i, 21);
                                        }
                                        i = 7;
                                }
        }

        do
        {
                if (rxd_buffer_locked)
                {
                        Decode64 ();
                        DebugData = (DebugData_t *) pRxData;

//                      lcd_printp_at (0, 7, PSTR(KEY_LINE_3), 0);
                        lcd_puts_at(0, 7, strGet(KEYLINE3), 0);
                        lcd_write_number_u_at (5, 7, page + 1);
                        switch (current_hardware)
                        {
                                case FC:
                                        lcd_printp_at (3, 7, PSTR("FC"), 0);
                                        lcd_printp_at (19, 7, PSTR("NC"), 0);
                                        break;

                                case NC:
                                        lcd_printp_at (3, 7, PSTR("NC"), 0);
                                        lcd_printp_at (19, 7, PSTR("FC"), 0);
                                        break;

                                default:
                                        lcd_printp_at (19, 7, PSTR("?"), 0);
                                        break;
                        }

                        for (i = 0; i < 7; i++)
                        {
                                //lcd_print_at (0, i, AnalogNames[i + page * 7], 0);
                                uint8_t size =0;
                                if( DebugData->Analog[i + page * 7] < -9999)
                                {
                                        size = 6;
                                }
                                else if ( DebugData->Analog[i + page * 7] < -999)
                                {
                                        size = 5;
                                }
                                else if ( DebugData->Analog[i + page * 7] < -99)
                                {
                                        size = 4;
                                }
                                else if ( DebugData->Analog[i + page * 7] < 999)
                                {
                                        size = 3;
                                }
                                else if ( DebugData->Analog[i + page * 7] < 9999)
                                {
                                        size = 4;
                                }
                                else
                                {
                                        size = 5;
                                }
                                        write_ndigit_number_s (21-size, i, DebugData->Analog[i + page * 7], size, 0,0);
                                if (page == 4 && i > 3)
                                {
                                        for (i = 4; i < 7; i++)   // Linie 4, 5, 6 loeschen
                                        {
                                                lcd_cls_line (0, i, 21);
                                        }
                                        i = 7;
                                }
                        }
                        timer = TIMEOUT;
                        rxd_buffer_locked = FALSE;
                }

                if (!abo_timer)
                {       // renew abo every 3 sec
                        // request OSD Data from NC every 100ms
                        //      RS232_request_mk_data (1, 'o', 100);
                        tmp_dat = 10;
                        SendOutData ('d', ADDRESS_ANY, 1, &tmp_dat, 1);

                        abo_timer = ABO_TIMEOUT;
                }

                if (get_key_press (1 << KEY_MINUS))
                {
                        page--;
                        if (page > 4)
                        {
                                page = 4;
                        }
                        lcd_cls ();
                        for (i = 0; i < 7; i++)
                        {
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 7], 0);
                                if (page == 4 && i > 3)
                                {
                                        for (i = 4; i < 7; i++)   // Linie 4, 5, 6 loeschen
                                        {
                                                lcd_cls_line (0, i, 21);
                                        }
                                        i = 7;
                                }
                        }
                }
                else if (get_key_press (1 << KEY_PLUS))
                {
                        page++;
                        if (page > 4)
                        {
                                page = 0;
                        }
                        lcd_cls ();
                        for (i = 0; i < 7; i++)
                        {
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 7], 0);
                                if (page == 4 && i > 3)
                                {
                                        for (i = 4; i < 7; i++)   // Linie 4, 5, 6 loeschen
                                        {
                                                lcd_cls_line (0, i, 21);
                                        }
                                        i = 7;
                                }
                        }
                }
                if ((hardware == NC) && get_key_press (1 << KEY_ENTER))
                {
                        tmp_dat = 0;
                        SendOutData ('d', ADDRESS_ANY, 1, &tmp_dat, 1);

                        _delay_ms (200);

                        if (current_hardware == NC)
                        {
                                SwitchToFC();

                                timer = TIMEOUT;
                        }
                        else
                        {
                                SwitchToNC();

                                timer = TIMEOUT;
                        }

                        _delay_ms (200);

                        if (AnalogNamesRead[current_hardware - 1] < 32)
                        {
                                GetAnalogNames ();
                        }

                        mode = 'D';     // Debug Data
                        rxd_buffer_locked = FALSE;
                        timer = TIMEOUT;

                        tmp_dat = 10;
                        SendOutData ('d', ADDRESS_ANY, 1, &tmp_dat, 1);

                        lcd_cls ();
                        page = 0;

                        for (i = 0; i < 7; i++)
                        {
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 7], 0);
                                if (page == 4 && i > 3)
                                {
                                        for (i = 4; i < 7; i++)   // Linie 4, 5, 6 loeschen
                                        {
                                                lcd_cls_line (0, i, 21);
                                        }
                                        i = 7;
                                }
                        }
                }
        }
        while (!get_key_press (1 << KEY_ESC) && timer); // ESC
                get_key_press(KEY_ALL);

        tmp_dat = 0;
        SendOutData ('d', ADDRESS_ANY, 1, &tmp_dat, 1);

        mode = 0;
        rxd_buffer_locked = FALSE;

        if (!timer)
        {       // timeout occured
                lcd_cls ();
                lcd_printp_at (0, 2, PSTR("ERROR: no data"), 0);

                timer = 100;
                while (timer > 0);
        }
        SwitchToNC();
}
#endif