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                  *
 *                                                                           *
 *   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.               *
 *                                                                           *
 *****************************************************************************/


// @TODO: maybe choose a smaler font for the debug data. 6x6 or 6x7 would be nice and gives some additional space for status lines

#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 "mk-data-structs.h"

#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...
#if defined (__AVR_ATmega32__)
uint8_t AnalogNames[32][16 + 1];        // 32 names, 16 characters + 1 0x00
uint8_t AnalogNamesRead = 0;
// um noch mehr Speicherplatz zu sparen, könnte man auch nur die jeweils benötigten Labels anfordern...
#else
uint8_t AnalogNames[2][32][16 + 1];     // 32 names, 16 characters + 1 0x00
uint8_t AnalogNamesRead[2] = {0,0};
#endif

//*****************************************************************************
//
void GetAnalogNames (void)
{
#if defined (__AVR_ATmega32__)
        uint8_t i = AnalogNamesRead;
#else
        uint8_t i = AnalogNamesRead[current_hardware - 1];
#endif
        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);
#if defined (__AVR_ATmega32__)
                                memcpy (AnalogNames[*pRxData], (uint8_t *) pRxData + 1, 16);
                                AnalogNames[*pRxData][16] = 0;
#else
                                memcpy (AnalogNames[current_hardware - 1][*pRxData], (uint8_t *) pRxData + 1, 16);
                                AnalogNames[current_hardware - 1][*pRxData][16] = 0;
#endif
                                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;
                        }
                }
        }
       
#if defined (__AVR_ATmega32__)
        AnalogNamesRead = i;
#else
        AnalogNamesRead[current_hardware - 1] = i;
#endif
       
#if 0
        if (timer)
        {
                for (page = 0; page < 4; page++)
                {
                        for (i = 0; i < 7; i++)
                        {
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 8], 0);
                        }
                        while (!get_key_press (1 << KEY_ESC));  // ESC
                }
        }
        //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 defined (__AVR_ATmega32__)
        if (AnalogNamesRead < 32) {
#else
        if (AnalogNamesRead[current_hardware - 1] < 32) {
#endif
                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 < 8; i++)
        {
#if defined (__AVR_ATmega32__)
                lcd_print_at (0, i, AnalogNames[i + page * 8], 0);
#else
                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 8], 0);
#endif
        }

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

                        //lcd_printp_at (0,6,PSTR("Page"),0);
                        lcd_write_number_u_at (20, 0, page);
                        switch (current_hardware)
                        {
                                case FC:
                                        lcd_printp_at (20, 1, PSTR("F"), 0);
                                        break;

                                case NC:
                                        lcd_printp_at (20, 1, PSTR("N"), 0);
                                        break;
                                       
                                default:
                                        lcd_printp_at (20, 1, PSTR("?"), 0);
                                        break;
                        }
                       

                        for (i = 0; i < 8; i++)
                        {
                                //lcd_print_at (0, i, AnalogNames[i + page * 8], 0);
                                if (current_hardware == NC)
                                {
                                        write_ndigit_number_u (14, i, DebugData->Analog[i + page * 8], 5, 0);
                                }
                                else
                                {
                                        write_ndigit_number_s (14, i, DebugData->Analog[i + page * 8], 5, 0);
                                }
                        }
                        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--;
                        page &= 0x03;
                        lcd_cls ();
                        for (i = 0; i < 8; i++)
                        {
#if defined (__AVR_ATmega32__)
                                lcd_print_at (0, i, AnalogNames[i + page * 8], 0);
#else
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 8], 0);
#endif
                        }
                }
                else if (get_key_press (1 << KEY_PLUS))
                {
                        page++;
                        page &= 0x03;
                        lcd_cls ();
                        for (i = 0; i < 8; i++)
                        {
#if defined (__AVR_ATmega32__)
                                lcd_print_at (0, i, AnalogNames[i + page * 8], 0);
#else
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 8], 0);
#endif
                        }
                }

                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;
                                //lcd_printpns_at (0, 7, PSTR(" \x1c    \x1d     Exit  NC"), 0);
                        }
                        else
                        {
                                SwitchToNC();

                                timer = TIMEOUT;
                                //lcd_printpns_at (0, 7, PSTR(" \x1c    \x1d     Exit  FC"), 0);
                        }
                       
                        _delay_ms (200);
                       
#if defined (__AVR_ATmega32__)
                        AnalogNamesRead = 0;
                        GetAnalogNames ();
#else
                        if (AnalogNamesRead[current_hardware - 1] < 32) {
                                GetAnalogNames ();
                        }
#endif
                       
                        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 < 8; i++)
                        {
#if defined (__AVR_ATmega32__)
                                lcd_print_at (0, i, AnalogNames[i + page * 8], 0);
#else
                                lcd_print_at (0, i, AnalogNames[current_hardware - 1][i + page * 8], 0);
#endif
                        }
                }
        }
        while (!get_key_press (1 << KEY_ESC) && timer); // ESC

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