crashtest-r0ket/firmware/applications/initial.c

147 lines
2.5 KiB
C

#include <sysinit.h>
#include "basic/basic.h"
#include "lcd/print.h"
#include "filesystem/ff.h"
#include "usb/usbmsc.h"
#include "funk/nrf24l01p.h"
FATFS FatFs;
/**************************************************************************/
#define BEACON_CHANNEL 81
#define BEACON_MAC "\x1\x2\x3\x2\1"
uint32_t const testkey[4] = {
0xB4595344,0xD3E119B6,0xA814D0EC,0xEFF5A24E
};
void f_init(void){
nrf_init();
struct NRF_CFG config = {
.channel= BEACON_CHANNEL,
.txmac= BEACON_MAC,
.nrmacs=1,
.mac0= BEACON_MAC,
.maclen ="\x10",
};
nrf_config_set(&config);
};
void f_recv(void){
__attribute__ ((aligned (4))) uint8_t buf[32];
int len;
static int foo = 0;
len=nrf_rcv_pkt_time_encr(100,sizeof(buf),buf,testkey);
if(len==0){
return;
};
if( foo )
foo = 0;
else
foo = 1;
gpioSetValue (RB_LED0, foo);
gpioSetValue (RB_LED1, foo);
gpioSetValue (RB_LED2, foo);
gpioSetValue (RB_LED3, foo);
};
void init(void)
{
systickInit(SYSTICKSPEED);
gpioSetValue (RB_LED0, 0);
gpioSetValue (RB_LED1, 0);
gpioSetValue (RB_LED2, 0);
gpioSetValue (RB_LED3, 0);
IOCON_PIO1_11 = 0x0;
gpioSetDir(RB_LED3, gpioDirection_Output);
f_init();
}
void mount(void)
{
int res;
lcdPrintln("Mount DF:");
res=f_mount(0, &FatFs);
lcdPrintln(f_get_rc_string(res));
lcdRefresh();
}
void format(void)
{
int res;
lcdPrintln("Formatting DF...");
res=f_mkfs(0,1,0);
lcdPrintln(f_get_rc_string(res));
lcdRefresh();
}
int check(void)
{
FIL file;
int res = 1;
res=f_open(&file, "flashed.cfg", FA_OPEN_EXISTING|FA_READ);
lcdPrint("open:");
lcdPrintln(f_get_rc_string(res));
lcdRefresh();
return res;
}
void msc(int timeout)
{
lcdPrintln("MSC Enabled.");
lcdRefresh();
delayms_power(300);
usbMSCInit();
while(check()){
mount();
delayms(100);
f_recv();
}
while(timeout--){
//f_recv();
delayms(100);
}
lcdPrintln("MSC Disabled.");
usbMSCOff();
lcdRefresh();
}
void isp(void)
{
lcdPrintln("Enter ISP!");
lcdRefresh();
ISPandReset();
}
void main_initial(void) {
init();
mount();
//if( check() )
format();
msc(5);
isp();
}
void tick_initial(void){
static int foo=0;
static int toggle=0;
incTimer();
if(foo++>80){
toggle=1-toggle;
foo=0;
gpioSetValue (RB_LED0, toggle);
};
};