crashtest-r0ket/firmware/l0dable/dbgmesh.c

188 lines
4.1 KiB
C

#include <sysinit.h>
#include <string.h>
#include "basic/basic.h"
#include "basic/config.h"
#include "lcd/render.h"
#include "lcd/print.h"
#include "funk/nrf24l01p.h"
#include "funk/mesh.h"
#include "usetable.h"
/**************************************************************************/
void m_time(void);
void ram(void) {
m_time();
};
void m_time_details(int select) {
getInputWaitRelease();
while(getInputWaitTimeout(50) == BTN_NONE){
lcdClear();
MPKT *mpkt = &meshbuffer[select];
uint8_t *pkt = mpkt->pkt;
if (!mpkt->flags & MF_USED)
lcdPrint("<unused>");
else {
lcdPrint("Type: ");
char c[2] = {0, 0};
c[0] = mpkt->pkt[0];
lcdPrint(c);
lcdNl();
lcdPrint("Gen: ");
lcdPrintInt(MO_GEN(pkt) & 0xff);
lcdNl();
lcdPrint("Time: ");
lcdPrintInt(MO_TIME(pkt) & 0xffff);
lcdNl();
lcdPrint("Body: ");
lcdNl();
int x = 0;
for(uint8_t *body = MO_BODY(pkt); body < (pkt + 30); body++) {
if (*body >= ' ' && *body < 128) {
if (x > 12) {
lcdNl();
x = 0;
}
char c[2] = {*body, 0};
lcdPrint(c);
x++;
} else {
if (x > 10) {
lcdNl();
x = 0;
}
lcdPrint("\\");
lcdPrintInt(*body & 0xff);
x += 2;
if (*body > 9)
x++;
if (*body > 99)
x++;
}
}
}
lcdRefresh();
}
}
void m_time(void){
int active=0;
struct tm* tm;
int select=0;
char c[2]={0,0};
int sp;
getInputWaitRelease();
delayms(100);
while(1) {
lcdClear();
lcdPrint(" ");
tm= mygmtime(getSeconds());
lcdPrint(IntToStr(tm->tm_hour,2,F_LONG));
lcdPrint(":");
lcdPrint(IntToStr(tm->tm_min,2,F_LONG|F_ZEROS));
lcdPrint(":");
lcdPrint(IntToStr(tm->tm_sec,2,F_LONG|F_ZEROS));
lcdNl();
lcdPrint(" ");
lcdPrint(IntToStr(tm->tm_mday,2,F_LONG));
lcdPrint(".");
lcdPrint(IntToStr(tm->tm_mon+1,2,0));
lcdPrint(".");
lcdPrint(IntToStr(tm->tm_year+YEAR0,4,F_LONG|F_ZEROS));
lcdNl();
lcdNl();
lcdPrint("<");
for(int i=0;i<MESHBUFSIZE;i++){
if(!meshbuffer[i].flags&MF_USED){
c[0]='_';
}else{
c[0]=meshbuffer[i].pkt[0];
};
lcdPrint(c);
};
lcdPrintln(">");
if(active){
lcdPrint(" ");
for(int i=0; i<MESHBUFSIZE; i++) {
lcdPrint(i == select ? "^" : " ");
}
lcdNl();
}else{
lcdPrintln(" up to select");
};
lcdPrint("Gen:");
lcdPrint(IntToStrX(meshgen,2));
lcdPrint(" ");
lcdPrint(GLOBAL(nickname));
lcdNl();
lcdPrint("Inc:");
lcdPrintInt(meshincctr);
lcdPrint(" SP:");
__asm( "mov %0, sp\n" : "=r" (sp) :);
lcdPrint(IntToStrX(sp,4));
lcdNl();
lcdPrint("Nice:");
lcdPrintInt(meshnice);
lcdPrint(" R:");
lcdPrint(IntToStrX(getrelease()%0xfff,3));
lcdNl();
lcdRefresh();
uint8_t key = getInputWaitTimeout(100);
if(active==1){
switch(key) {
case BTN_LEFT:
select--;
if (select < 0)
select = MESHBUFSIZE - 1;
break;
case BTN_RIGHT:
select++;
if (select >= MESHBUFSIZE)
select = 0;
break;
case BTN_ENTER:
m_time_details(select);
break;
case BTN_UP:
active=0;
break;
case BTN_DOWN:
// Exit
return;
}
}else{
switch(key) {
case BTN_UP:
active=1;
break;
case BTN_NONE:
break;
default:
return;
};
};
if (key != BTN_NONE)
getInputWaitRelease();
}
};