crashtest-r0ket/firmware/applications/mesh/mesh.c

277 lines
6.3 KiB
C
Raw Normal View History

2011-07-29 17:40:24 +00:00
#include <sysinit.h>
#include <string.h>
#include <time.h>
#include "basic/basic.h"
#include "basic/byteorder.h"
#include "lcd/lcd.h"
#include "lcd/print.h"
#include "funk/nrf24l01p.h"
2011-07-30 14:10:30 +00:00
#include "funk/mesh.h"
2011-07-29 17:40:24 +00:00
2011-07-30 14:10:30 +00:00
#include <string.h>
2011-07-29 17:40:24 +00:00
/**************************************************************************/
void m_init(void){
nrf_init();
struct NRF_CFG config = {
.channel= MESH_CHANNEL,
.txmac= MESH_MAC,
.nrmacs=1,
.mac0= MESH_MAC,
.maclen ="\x20", // XXX: MESHPKTSIZE
};
nrf_config_set(&config);
2011-07-30 14:10:30 +00:00
initMesh();
2011-07-29 17:49:24 +00:00
};
void m_tset(void){
2011-07-29 17:40:24 +00:00
_timet=1311961112;
};
void m_time(void){
struct tm* tm;
2011-07-30 14:10:30 +00:00
char c[2]={0,0};
2011-07-29 17:40:24 +00:00
getInputWaitRelease();
delayms(100);
do{
lcdClear();
tm= mygmtime(getSeconds());
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_hour,2,F_LONG));
2011-07-29 17:40:24 +00:00
lcdPrint(":");
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_min,2,F_LONG|F_ZEROS));
2011-07-29 17:40:24 +00:00
lcdPrint(":");
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_sec,2,F_LONG|F_ZEROS));
2011-07-29 17:40:24 +00:00
lcdNl();
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_mday,2,F_LONG));
2011-07-29 17:40:24 +00:00
lcdPrint(".");
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_mon+1,2,0));
2011-07-29 17:40:24 +00:00
lcdPrint(".");
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_year+YEAR0,4,F_LONG|F_ZEROS));
2011-07-29 17:40:24 +00:00
lcdNl();
2011-07-30 14:10:30 +00:00
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(">");
lcdPrint("Gen:");
lcdPrintInt(meshgen);
lcdNl();
2011-07-29 17:40:24 +00:00
lcdRefresh();
delayms_queue(50);
2011-07-29 17:40:24 +00:00
}while ((getInputRaw())==BTN_NONE);
};
2011-07-30 14:10:30 +00:00
inline void blink(char a, char b){
gpioSetValue (a,b, 1-gpioGetValue(a,b));
};
2011-07-30 17:06:12 +00:00
int choose(char * texts, int8_t menuselection){
uint8_t numentries = 0;
uint8_t visible_lines = 0;
uint8_t current_offset = 0;
char*p=texts;
do{
lcdPrintln(p);
while(*p)p++;
numentries++;p++;
}while(*p);
numentries--;
visible_lines = (RESY/font->u8Height)-1; // subtract title line
while (1) {
// Display current menu page
lcdClear();
lcdPrintln(texts);
p=texts;
while(*p++);
for(int i=0;i<current_offset;i++)
while(*p++);
for (uint8_t i = current_offset; i < (visible_lines + current_offset) && i < numentries; i++) {
if (i == menuselection)
lcdPrint("*");
lcdSetCrsrX(14);
lcdPrintln(p);
while(*p++);
}
lcdRefresh();
switch (getInputWait()) {
case BTN_UP:
menuselection--;
if (menuselection < current_offset) {
if (menuselection < 0) {
menuselection = numentries-1;
current_offset = ((numentries-1)/visible_lines) * visible_lines;
} else {
current_offset -= visible_lines;
}
}
break;
case BTN_DOWN:
menuselection++;
if (menuselection > (current_offset + visible_lines-1) || menuselection >= numentries) {
if (menuselection >= numentries) {
menuselection = 0;
current_offset = 0;
} else {
current_offset += visible_lines;
}
}
break;
case BTN_LEFT:
return -1;
case BTN_RIGHT:
case BTN_ENTER:
return menuselection;
}
getInputWaitRelease();
}
/* NOTREACHED */
}
2011-07-30 14:10:30 +00:00
/***********************************************************************/
2011-07-30 17:06:12 +00:00
char *meshmsgs(void){
static char msgtypes[MESHBUFSIZE+1];
memset(msgtypes,'_',MESHBUFSIZE);
msgtypes[MESHBUFSIZE]=0;
uint8_t lo=0;
uint8_t hi;
for(int o=0;o<MESHBUFSIZE;o++){
hi=0xff;
for(int i=0;i<MESHBUFSIZE;i++){
if(meshbuffer[i].flags&MF_USED){
if(MO_TYPE(meshbuffer[i].pkt)>lo)
if(MO_TYPE(meshbuffer[i].pkt)<hi)
hi=MO_TYPE(meshbuffer[i].pkt);
};
};
if(hi==0xff){
msgtypes[o]=0;
break;
};
msgtypes[o]=hi;
lo=hi;
};
2011-07-30 14:10:30 +00:00
2011-07-30 17:06:12 +00:00
return msgtypes;
2011-07-30 14:10:30 +00:00
};
2011-07-30 17:06:12 +00:00
extern MPKT meshbuffer[MESHBUFSIZE];
void m_choose(){
char list[99];
int i=0;
while(1){
char *p=list;
strcpy(p,"Note");
while(*p++);
char *mm=meshmsgs();
char *tmm=mm;
while(*mm){
switch(*mm){
case('A'):
strcpy(p,"Message");
break;
case('E'):
strcpy(p,"Kourou");
break;
case('F'):
strcpy(p,"Baikonur");
break;
case('T'):
strcpy(p,"Time");
break;
default:
p[0]=*mm;
p[1]=0;
};
while(*p++);
mm++;
};
p[0]=0;
i=choose(list,i);
if(i<0)
return;
lcdClear();
int j=0;
for(int z=0;z<MESHBUFSIZE;z++)
if(meshbuffer[z].flags&MF_USED)
if(MO_TYPE(meshbuffer[z].pkt)==tmm[i])
j=z;
switch(tmm[i]){
case('A'):
lcdPrintln("Message");
break;
case('E'):
lcdPrintln("Kourou");
break;
case('F'):
lcdPrintln("Baikonur");
break;
case('T'):
lcdPrintln("Time");
break;
};
struct tm *tm= mygmtime(MO_TIME(meshbuffer[j].pkt));
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_hour,2,F_LONG));
2011-07-30 17:06:12 +00:00
lcdPrint(":");
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_min,2,F_LONG|F_ZEROS));
2011-07-30 17:06:12 +00:00
lcdPrint(":");
2011-07-30 22:55:02 +00:00
lcdPrint(IntToStr(tm->tm_sec,2,F_LONG|F_ZEROS));
2011-07-30 17:06:12 +00:00
lcdNl();
char *foo=(char *)MO_BODY(meshbuffer[j].pkt);
while(strlen(foo)>13){
int q;
for(q=0;q<13;q++){
if(foo[q]==' ')
break;
};
foo[q]=0;
lcdPrintln(foo);
foo[q]=' ';
foo+=q+1;
};
lcdPrintln(foo);
lcdRefresh();
getInputWaitRelease();
};
2011-07-30 14:10:30 +00:00
};
2011-07-30 17:06:12 +00:00
2011-07-30 14:10:30 +00:00
void tick_mesh(void){
mesh_systick();
};