leddie/firmware/app.c

148 lines
2.3 KiB
C

#include "lib/system.h"
#include "lib/hal.h"
#include <stdlib.h>
#define TIMER_INMENU TIMER_APP0
#define TIMER_AUX TIMER_APP1
void axl_test()
{
int ret;
struct axl_result measurements;
int dir_x;
int dir_y;
int ledno;
int intens;
if (block_for(TIMER_AUX, timer_ms(50))) {
display_clear(0);
#define THRES 10
ret = mma8653_get_measurements(&measurements);
dir_x = 0;
if (measurements.x > THRES)
dir_x = -1;
else if (measurements.x < -THRES)
dir_x = 1;
dir_y = 0;
if (measurements.y > THRES)
dir_y = 1;
else if (measurements.y < -THRES)
dir_y = -1;
if (dir_y == -1)
ledno = dir_x + 1;
else if (dir_y == 0)
ledno = 3 + 1 -dir_x;
else if (dir_y == 1)
ledno = dir_x + 6 + 1;
intens = abs(measurements.x + measurements.y);
intens = intens >> 2;
if (intens < 1)
intens = 1;
if (measurements.z > 0)
led[ledno].b = intens;
else
led[ledno].r = intens;
if (ret)
led[ret].r = 0x10;
display_update();
}
}
void led_test(int first_launch)
{
static int i;
if (first_launch) {
i = 0;
led[0].r = 1;
}
if (block_for(TIMER_AUX, timer_ms(30))) {
led[i].g = 0x0;
i = (i + 1) % STRIPLEN;
led[i].g = 0x10;
if (led[i].r && led[i].b) {
led[i].r = 0;
led[i].b = 1;
} else if (led[i].r) {
led[i].b = 1;
} else {
led[i].r = 1;
led[i].b = 0;
}
display_update();
}
}
void system_test()
{
// Display power states on first face
if (HAL_ASSERTED_N(VLED_EN_N))
led[0].b = 1;
else
led[0].b = 0;
if (HAL_ASSERTED_N(CHG_ACTIVE_N))
led[1].r = 1;
else
led[1].r = 0;
if (block_for(TIMER_AUX, timer_ms(50)))
display_update();
}
void app_init()
{
return;
}
#define APP_COUNT 3
enum app_return app_mainloop()
{
static int app_sel = 0;
static int clr = 1;
if (button_event(EV_PRESS)) {
app_sel = (app_sel + 1) % APP_COUNT;
display_clear();
for (int i = 0; i < STRIPLEN; i += 9) {
led[app_sel + i].g = 4;
}
display_update();
timer_set(TIMER_INMENU, timer_ms(750));
clr = 1;
} else if (button_event(EV_LONGPRESS)) {
return SUSPEND;
}
if (timer_expired(TIMER_INMENU)) {
if (clr) {
display_clear();
}
switch (app_sel) {
case 0:
led_test(clr);
break;
case 1:
axl_test();
break;
case 2:
system_test();
break;
default:
app_sel = 0;
break;
}
clr = 0;
}
return RUN;
}