eddy/stm32samples
1
0
Fork 0
mirror of https://github.com/eddyem/stm32samples.git synced 2026-02-28 11:54:30 +03:00
Code Issues Packages Projects Releases Wiki Activity

It works!

Browse Source
This commit is contained in:
Edward Emelianov
2025-09-21 21:32:01 +03:00
parent 9b0ee87891
commit dc2897e783
13 changed files with 185 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files

74
F3:F303/MLX90640/mlxproc.c
View File

@@ -21,6 +21,10 @@
#include "i2c.h"
#include "mlxproc.h"
#include "mlx90640_regs.h"
//#include "usb_dev.h"
//#include "strfunc.h"
extern volatile uint32_t Tms;
// current state and state before `stop` called
static mlx_state_t MLX_state = MLX_NOTINIT, MLX_oldstate = MLX_NOTINIT;
@@ -29,6 +33,8 @@ static int parsrdy = 0;
static fp_t *ready_image = NULL; // will be pointer to `mlx_image` after both subpages process
static uint8_t MLX_address = 0x33 << 1;
static int errctr = 0; // errors counter - cleared by mlx_continue
static uint32_t Tlastimage = 0;
static uint8_t resolution = 2; // default: 18bit
// get current state
mlx_state_t mlx_state(){ return MLX_state; }
@@ -36,6 +42,7 @@ mlx_state_t mlx_state(){ return MLX_state; }
int mlx_setaddr(uint8_t addr){
if(addr > 0x7f) return 0;
MLX_address = addr << 1;
Tlastimage = Tms; // refresh counter for autoreset I2C in case of error
return 1;
}
// temporary stop
@@ -60,12 +67,14 @@ void mlx_continue(){
}
void mlx_process(){
//static int subpageno = 0; // wait for given subpage
static int subpageno = 0; // wait for given subpage
// static uint32_t Tlast = 0;
switch(MLX_state){
case MLX_NOTINIT: // start reading parameters
if(i2c_read_reg16(MLX_address, REG_CALIDATA, MLX_DMA_MAXLEN, 1))
if(i2c_read_reg16(MLX_address, REG_CALIDATA, MLX_DMA_MAXLEN, 1)){
errctr = 0;
MLX_state = MLX_WAITPARAMS;
else ++errctr;
}else ++errctr;
break;
case MLX_WAITPARAMS: // check DMA ends and calculate parameters
if(i2c_dma_haderr()) MLX_state = MLX_NOTINIT;
@@ -74,6 +83,7 @@ void mlx_process(){
if(buf){
if(len != MLX_DMA_MAXLEN) MLX_state = MLX_NOTINIT;
else if(get_parameters(buf, &p)){
errctr = 0;
MLX_state = MLX_WAITSUBPAGE; // fine! we could wait subpage
parsrdy = 1;
}
@@ -81,14 +91,40 @@ void mlx_process(){
}
break;
case MLX_WAITSUBPAGE: // wait for subpage N ready
;
{uint16_t *got = i2c_read_reg16(MLX_address, REG_STATUS, 1, 0);
if(got && *got & REG_STATUS_NEWDATA){
if(subpageno == (*got & REG_STATUS_SPNO)){
if(i2c_read_reg16(MLX_address, REG_IMAGEDATA, MLX_DMA_MAXLEN, 1)){
errctr = 0;
MLX_state = MLX_READSUBPAGE;
//U("spstart="); USND(u2str(Tms - Tlast));
}else ++errctr;
}
}}
break;
case MLX_READSUBPAGE: // wait ends of DMA read and calculate subpage
;
if(i2c_dma_haderr()) MLX_state = MLX_NOTINIT;
else{
uint16_t len, *buf = i2c_dma_getbuf(&len);
if(buf){
//U("spread="); USND(u2str(Tms - Tlast));
if(len != MLX_DMA_MAXLEN) MLX_state = MLX_WAITSUBPAGE;
else if((ready_image = process_subpage(&p, (int16_t*)buf, subpageno, 2))){
errctr = 0;
MLX_state = MLX_WAITSUBPAGE; // fine! we could wait subpage
//U("spgot="); USND(u2str(Tms - Tlast));
if(subpageno){ Tlastimage = Tms;
/*U("imgot="); USND(u2str(Tms - Tlast)); Tlast = Tms; */
}
subpageno = !subpageno;
}
}
}
break;
default:
return;
}
if(MLX_state != MLX_RELAX && Tms - Tlastimage > MLX_I2CERR_TMOUT){ i2c_setup(i2c_curspeed); Tlastimage = Tms; }
if(errctr > MLX_MAX_ERRORS) mlx_stop();
}
@@ -99,6 +135,32 @@ int mlx_getparams(MLX90640_params *pars){
return 1;
}
fp_t *mlx_getimage(){
fp_t *mlx_getimage(uint32_t *Tgot){
if(Tgot) *Tgot = Tlastimage;
return ready_image;
}
uint8_t mlx_getresolution(){
return resolution;
}
int mlx_sethwaddr(uint8_t addr){
if(addr > 0x7f) return 0;
uint16_t data[2], *ptr;
if(!(ptr = i2c_read_reg16(MLX_address, REG_MLXADDR, 1, 0))) return 0;
data[0] = REG_MLXADDR;
data[1] = (*ptr & ~REG_MLXADDR_MASK) | addr;
if(!i2c_write(MLX_address, data, 2)) return 0;
return 1;
}
int mlx_setresolution(uint8_t newresol){
if(newresol > 3) return 0;
uint16_t data[2], *ptr;
if(!(ptr = i2c_read_reg16(MLX_address, REG_CONTROL, 1, 0))) return 0;
data[0] = REG_CONTROL;
data[1] = (*ptr & ~REG_CONTROL_RESMASK) | (newresol << 10);
if(!i2c_write(MLX_address, data, 2)) return 0;
resolution = newresol;
return 1;
}