110 lines
3.0 KiB
C
110 lines
3.0 KiB
C
|
#include <fcntl.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <stdint.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include <sys/stat.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
#include "main.h"
|
||
|
|
|
||
|
|
#define RPMSG_PATH "/dev/ttyRPMSG0"
|
||
|
|
|
||
|
|
static int update = 0;
|
||
|
|
static int reset = 0;
|
||
|
|
static int32_t data[13] = {0,};
|
||
|
|
static int32_t data_min = 0;
|
||
|
|
static int32_t data_max = 0;
|
||
|
|
static int32_t data_avg = 0;
|
||
|
|
static int32_t data_cur = 0;
|
||
|
|
|
||
|
|
void rpmsg_reset(void)
|
||
|
|
{
|
||
|
|
reset = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
int rpmsg_read(int32_t *y, int32_t *min, int32_t *max, int32_t *avg,
|
||
|
|
int32_t *cur)
|
||
|
|
{
|
||
|
|
if (!update)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
memcpy(y, data, sizeof(data));
|
||
|
|
update = 0;
|
||
|
|
*min = data_min;
|
||
|
|
*max = data_max;
|
||
|
|
*avg = data_avg;
|
||
|
|
*cur = data_cur;
|
||
|
|
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
void *rpmsg_thread(void *argv)
|
||
|
|
{
|
||
|
|
int32_t d[13] = {0,};
|
||
|
|
float min, max, avg, cur;
|
||
|
|
char *avg_str;
|
||
|
|
char *data_str;
|
||
|
|
int fd;
|
||
|
|
char buf[256] = {0};
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
fd = open(RPMSG_PATH, O_RDWR);
|
||
|
|
ret = write(fd, buf, 1);
|
||
|
|
|
||
|
|
while (1)
|
||
|
|
{
|
||
|
|
ret = read(fd, buf, sizeof(buf));
|
||
|
|
if (ret > 0)
|
||
|
|
{
|
||
|
|
//printf("%s %d [%.*s]\n", __func__, ret, ret, buf);
|
||
|
|
avg_str = strstr(buf, "avg =");
|
||
|
|
data_str = strstr(buf, "0.5 =");
|
||
|
|
if (avg_str)
|
||
|
|
{
|
||
|
|
sscanf(avg_str, "avg = %f us, max = %f us, min = %f us, cur = %f us", &avg,
|
||
|
|
&max, &min, &cur);
|
||
|
|
data_min = min * 1000;
|
||
|
|
data_max = max * 1000;
|
||
|
|
data_avg = avg * 1000;
|
||
|
|
data_cur = cur * 1000;
|
||
|
|
printf("<avg = %f us, max = %f us, min = %f us, cur = %f us>\n", avg, max, min,
|
||
|
|
cur);
|
||
|
|
update = 1;
|
||
|
|
}
|
||
|
|
if (data_str)
|
||
|
|
{
|
||
|
|
sscanf(data_str,
|
||
|
|
"0.5 = %d times, 1 = %d times, 1.5 = %d times, "
|
||
|
|
"2 = %d times, 2.5 = %d times, 3 = %d times, "
|
||
|
|
"3.5 = %d times, 4 = %d times, 4.5 = %d times, "
|
||
|
|
"5 = %d times, 5.5 = %d times, 6 = %d times",
|
||
|
|
&d[1], &d[2], &d[3], &d[4], &d[5], &d[6],
|
||
|
|
&d[7], &d[8], &d[9], &d[10], &d[11], &d[12]);
|
||
|
|
printf(data_str,
|
||
|
|
"<0.5 = %d times, 1 = %d times, 1.5 = %d times, "
|
||
|
|
"2 = %d times, 2.5 = %d times, 3 = %d times, "
|
||
|
|
"3.5 = %d times, 4 = %d times, 4.5 = %d times, "
|
||
|
|
"5 = %d times, 5.5 = %d times, 6 = %d times>\n",
|
||
|
|
d[1], d[2], d[3], d[4], d[5], d[6],
|
||
|
|
d[7], d[8], d[9], d[10], d[11], d[12]);
|
||
|
|
if (reset)
|
||
|
|
{
|
||
|
|
reset = 0;
|
||
|
|
for (int i = 0; i < ARRAY_SIZE(d); i++)
|
||
|
|
data[i] = d[i];
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
for (int i = 0; i < ARRAY_SIZE(d); i++)
|
||
|
|
data[i] += d[i];
|
||
|
|
}
|
||
|
|
update = 1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
usleep(10 * 1000);
|
||
|
|
}
|
||
|
|
|
||
|
|
close(fd);
|
||
|
|
}
|
||
|
|
|