mirror of
https://github.com/eddyem/ARMsingleboard.git
synced 2025-12-06 02:35:12 +03:00
98 lines
3.1 KiB
C
98 lines
3.1 KiB
C
/*
|
|
* This file is part of the mxl90640wPi project.
|
|
* Copyright 2022 Edward V. Emelianov <edward.emelianoff@gmail.com>.
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <math.h>
|
|
#include <signal.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <usefull_macros.h>
|
|
|
|
#include "cmdlnopts.h"
|
|
#include "mlx90640.h"
|
|
|
|
static glob_pars *GP = NULL;
|
|
|
|
void signals(int sig){
|
|
if(sig){
|
|
signal(sig, SIG_IGN);
|
|
DBG("Get signal %d, quit.\n", sig);
|
|
}
|
|
LOGERR("Exit with status %d", sig);
|
|
if(GP && GP->pidfile) // remove unnesessary PID file
|
|
unlink(GP->pidfile);
|
|
exit(sig);
|
|
}
|
|
|
|
static double image[MLX_PIXNO];
|
|
static double image2[MLX_PIXNO];
|
|
static void pushima(const double *img){
|
|
for(int i = 0; i < MLX_PIXNO; ++i){
|
|
register double val = *img++;
|
|
image[i] += val;
|
|
image2[i] += val*val;
|
|
}
|
|
}
|
|
|
|
int main (int argc, char **argv){
|
|
initial_setup();
|
|
char *self = strdup(argv[0]);
|
|
GP = parse_args(argc, argv);
|
|
check4running(self, GP->pidfile);
|
|
FREE(self);
|
|
if(GP->addr < 0 || GP->addr > 0xff) ERRX("Wrong I2C address");
|
|
if(GP->logfile) OPENLOG(GP->logfile, LOGLEVEL_ANY, 1);
|
|
if(GP->simple < 0 || GP->simple > 2) ERRX("simple = 0..2");
|
|
if(!mlx90640_init(GP->device, (uint8_t)GP->addr)) ERR("Can't open device");
|
|
//mlx90640_dump_parameters();
|
|
double *ima = NULL;
|
|
if(!mlx90640_take_image(GP->simple, &ima) || !ima) ERRX("Can't take image"); // take trash image
|
|
#define N 10
|
|
double T0 = dtime();
|
|
//for(uint8_t simple = 0; simple < 3; ++simple){
|
|
memset(image, 0, sizeof(image));
|
|
memset(image2, 0, sizeof(image));
|
|
for(int i = 0; i < N; ++i){
|
|
if(!mlx90640_take_image(GP->simple, &ima) || !ima) ERRX("Can't take image");
|
|
printf("Got image %d, T=%g; val[0]=%g, val[1]=%g\n", i, dtime() - T0, ima[0], ima[1]);
|
|
pushima(ima);
|
|
T0 = dtime();
|
|
}
|
|
double *im = image, *im2 = image2;
|
|
green("\nImage (simple=%d):\n", GP->simple);
|
|
for(int row = 0; row < MLX_H; ++row){
|
|
for(int col = 0; col < MLX_W; ++col){
|
|
double v = *im++, v2 = *im2;
|
|
v /= N; v2 /= N;
|
|
printf("%6.1f ", v);
|
|
*im2++ = v2 - v*v; // now it is std
|
|
}
|
|
printf("\n");
|
|
}
|
|
|
|
green("\nRMS:\n");
|
|
im2 = image2;
|
|
for(int row = 0; row < MLX_H; ++row){
|
|
for(int col = 0; col < MLX_W; ++col){
|
|
printf("%6.2f ", sqrt(*im2++));
|
|
}
|
|
printf("\n");
|
|
}
|
|
//}
|
|
return 0;
|
|
}
|