int cb_display_type(int cmd, void *data)
{
int key = (int)data;
switch (cmd)
{
case CMD_FORMAT:
pp_sprintf((char *)data, "%s", current_config.display_type);
return 1;
case CMD_KEY:
{
int idx = cfg_find_panel_index(current_config.display_type);
struct dsi_panel_config *panel;
if ((key == KEY_LEFT) && (idx > 0)) idx--;
else if ((key == KEY_RIGHT) && (idx < panel_count() - 1)) idx++;
panel = panel_get_config(idx);
strcpy(current_config.display_type, panel->name);
}
return 0;
case CMD_ENTER:
return 0;
}
}
/* syslog: a tx-only socket: no queue is there */
static struct wrpc_socket __static_syslog_socket = {
.queue.buff = NULL,
.queue.size = 0,
};
static struct wrpc_socket *syslog_socket;
static struct wr_udp_addr syslog_addr;
unsigned char syslog_mac[6];
static uint32_t tics, tics_zero;
void syslog_init(void)
{
syslog_socket = ptpd_netif_create_socket(&__static_syslog_socket, NULL,
PTPD_SOCK_UDP, 514 /* time */);
syslog_addr.sport = syslog_addr.dport = htons(514);
tics_zero = timer_get_tics();
}
static int cmd_syslog(const char *args[])
{
char b1[32], b2[32];
if (args[0] && !strcmp(args[0], "off")) {
syslog_addr.daddr = 0;
return 0;
}
if (!args[1]) {
pp_printf("use: syslog <ipaddr> <macaddr> (or just \"off\"\n");
return -1;
}
decode_ip(args[0], (void *)&syslog_addr.daddr);
decode_mac(args[1], syslog_mac);
pp_printf("Syslog parameters: %s, %s\n",
format_ip(b1, (void *)&syslog_addr.daddr),
format_mac(b2, syslog_mac));
tics = 0; /* send the first frame immediately to the new host */
return 0;
}
DEFINE_WRC_COMMAND(syslog) = {
.name = "syslog",
.exec = cmd_syslog,
};
#define SYSLOG_DEFAULT_LEVEL 14 /* 8 == user + 6 ==info */
static int syslog_header(char *buf, int level, unsigned char ip[4])
{
uint64_t secs;
char b[32];
int len;
shw_pps_gen_get_time(&secs, NULL);
getIP(ip);
len = pp_sprintf(buf + UDP_END, "<%i> %s %s ", level,
format_time(secs, TIME_FORMAT_SYSLOG),
format_ip(b, ip));
return len + UDP_END;
}
int cb_display_brightness(int cmd, void *data)
{
int i, b;
char *buf = (char *)data;
switch (cmd)
{
case CMD_FORMAT:
{
*buf++ = '[';
b = current_config.brightness * 32 / 100;
for (i = 0; i < 32; i++) *buf++ = (i < b ? '#' : ' ');
*buf++ = ']';
pp_sprintf(buf, " %d%%", current_config.brightness);
return 1;
}
case CMD_KEY:
{
int key = (int)data;
if (key == KEY_LEFT) current_config.brightness -= 5;
else if (key == KEY_RIGHT) current_config.brightness += 5;
if (current_config.brightness < 0) current_config.brightness = 0;
if (current_config.brightness > 100) current_config.brightness =
100;
panel_set_brightness(current_config.brightness);
break;
case CMD_ENTER:
return 0;
}
}
return 0;
}
int syslog_poll(void)
{
struct wr_sockaddr addr;
char buf[256];
char b[32];
unsigned char mac[6];
unsigned char ip[4];
static uint32_t down_tics;
int len = 0;
uint32_t now;
/* for temperature state */
static uint32_t next_temp_report, next_temp_check;
/* for servo-state (accesses ppsi internal variables */
extern struct pp_instance *ppi;
struct wr_servo_state *s;
static uint32_t prev_tics;
static int track_ok_count, prev_servo_state = -1;
if (IS_HOST_PROCESS)
s = NULL;
else
s = &((struct wr_data *)ppi->ext_data)->servo_state;
if (ip_status == IP_TRAINING)
return 0;
if (!syslog_addr.daddr)
return 0;
now = timer_get_tics();
if (!tics) {
/* first time ever, or new syslog server */
tics = now - 1;
get_mac_addr(mac);
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len, "(%s) Node up "
"since %i seconds", format_mac(b, mac),
(tics - tics_zero) / 1000);
goto send;
}
if (link_status == LINK_WENT_DOWN)
down_tics = now;
if (link_status == LINK_UP && down_tics) {
down_tics = now - down_tics;
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len, "Link up after %i.%03i s",
down_tics / 1000, down_tics % 1000);
down_tics = 0;
goto send;
}
if (!prev_tics)
prev_tics = now;
if (s && s->state == WR_TRACK_PHASE &&
prev_servo_state != WR_TRACK_PHASE) {
/* we reached sync: log it */
track_ok_count++;
prev_servo_state = s->state;
prev_tics = now - prev_tics;
if (track_ok_count == 1) {
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len,
"Tracking after %i.%03i s",
prev_tics / 1000, prev_tics % 1000);
goto send;
}
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len,
"%i-th re-rtrack after %i.%03i s",
track_ok_count,
prev_tics / 1000, prev_tics % 1000);
goto send;
}
if (s && s->state != WR_TRACK_PHASE &&
prev_servo_state == WR_TRACK_PHASE) {
prev_servo_state = s->state;
prev_tics = now;
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len, "Lost track");
goto send;
}
if (!next_temp_check) {
next_temp_check = now + 1000;
next_temp_report = 0;
}
if (time_after_eq(now, next_temp_check)) {
struct wrc_onetemp *t = NULL;
int over_t = 0;
next_temp_check += 1000;
while ( (t = wrc_temp_getnext(t)) )
over_t += (t->t > (CONFIG_TEMP_HIGH_THRESHOLD << 16));
/* report if over temp, and first report or rappel time */
if (over_t && (!next_temp_report
|| time_after_eq(now, next_temp_report))) {
next_temp_report = now + 1000 * CONFIG_TEMP_HIGH_RAPPEL;
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len, "Temperature high: ");
len += wrc_temp_format(buf + len, sizeof(buf) - len);
goto send;
}
if (!over_t && next_temp_report) {
next_temp_report = 0;
len = syslog_header(buf, SYSLOG_DEFAULT_LEVEL, ip);
len += pp_sprintf(buf + len, "Temperature ok: ");
len += wrc_temp_format(buf + len, sizeof(buf) - len);
goto send;
}
}
return 0;
send:
memcpy(&syslog_addr.saddr, ip, 4);
fill_udp((void *)buf, len, &syslog_addr);
memcpy(&addr.mac, syslog_mac, 6);
ptpd_netif_sendto(syslog_socket, &addr, buf, len, 0);
return 1;
}
