WebSVN - Projects - Rev 730 - /Transportables

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

Subversion Repositories Projects

(root)/Transportables_Koptertool/trunk/debug.c @ 2164 - Rev 730