mirror of
https://github.com/eddyem/stm32samples.git
synced 2025-12-06 10:45:11 +03:00
125 lines
4.3 KiB
C
125 lines
4.3 KiB
C
/*
|
|
* This file is part of the MLX90640 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 "i2c.h"
|
|
#include "mlx90640.h"
|
|
#include "proto.h"
|
|
#include "strfunct.h"
|
|
#include "usb.h"
|
|
#include "version.inc"
|
|
|
|
#define D16LEN (256)
|
|
|
|
const char *parse_cmd(char *buf){
|
|
int32_t Num = 0;
|
|
uint16_t r, d;
|
|
uint16_t data[D16LEN];
|
|
char *ptr;
|
|
switch(*buf++){
|
|
case 'a':
|
|
if(buf != getnum(buf, &Num)){
|
|
if(Num & 0x80) return "Enter 7bit address";
|
|
i2c_set_addr7(Num);
|
|
return "Changed";
|
|
}else return "Wrong address";
|
|
break;
|
|
case 'd':
|
|
if(buf != (ptr = getnum(buf, &Num))){
|
|
r = Num;
|
|
if(ptr != getnum(ptr, &Num)){
|
|
if(Num < 1) return "N>0";
|
|
if(!read_data_dma(r, Num)) return("Can't read");
|
|
else return "OK";
|
|
}else return "Need amount";
|
|
}else return "Need reg";
|
|
break;
|
|
case 'g':
|
|
if(buf != (ptr = getnum(buf, &Num))){
|
|
r = Num;
|
|
if(ptr != getnum(ptr, &Num)){
|
|
if(Num < 1 || Num > 256) return "N from 0 to 256";
|
|
d = read_data(r, data, Num);
|
|
if(d < Num){
|
|
addtobuf("Got only ");
|
|
printu(d);
|
|
addtobuf(" values\n");
|
|
}
|
|
for(uint16_t i = 0; i < d; ++i){
|
|
printuhex(r + i);
|
|
addtobuf(" ");
|
|
printuhex(data[i]);
|
|
newline();
|
|
}
|
|
sendbuf();
|
|
return NULL;
|
|
}else return "Need amount";
|
|
}else return "Need reg";
|
|
break;
|
|
case 'I':
|
|
i2c_setup(TRUE);
|
|
return "I2C restarted";
|
|
break;
|
|
case 'r':
|
|
if(buf != (ptr = getnum(buf, &Num))){
|
|
if(read_reg(Num, &d)){
|
|
printuhex(d); NL();
|
|
return NULL;
|
|
}else return "Can't read";
|
|
}else return "Need register address";
|
|
break;
|
|
case 'R':
|
|
USB_sendstr("Soft reset\n");
|
|
NVIC_SystemReset();
|
|
break;
|
|
case 'w':
|
|
if(buf == (ptr = getnum(buf, &Num))) return "Need register";
|
|
r = Num;
|
|
if(ptr == getnum(ptr, &Num)) return "Need data";
|
|
if(write_reg(r, Num)) return "OK";
|
|
else return "Failed";
|
|
break;
|
|
case 'W':
|
|
r = 0;
|
|
while(r < D16LEN){
|
|
if(buf == (ptr = getnum(buf, &Num))) break;
|
|
data[r++] = ((Num & 0xff) << 8) | (Num >> 8);
|
|
buf = ptr + 1;
|
|
}
|
|
if(r == 0) return "Need at least one uint8_t";
|
|
if(I2C_OK == i2c_7bit_send((uint8_t*)data, r*2, 1)) return "Sent\n";
|
|
else return "Error\n";
|
|
break;
|
|
default: // help
|
|
addtobuf(
|
|
"MLX90640 build #" BUILD_NUMBER " @" BUILD_DATE "\n\n"
|
|
"'a addr' - change MLX I2C address to `addr`\n"
|
|
"'d reg N' - read registers starting from `reg` using DMA\n"
|
|
"'g reg N' - read N (<256) registers starting from `reg`\n"
|
|
"'I' - restart I2C\n"
|
|
"'r reg' - read `reg`\n"
|
|
"'R' - software reset\n"
|
|
"'w reg dword' - write `dword` to `reg`\n"
|
|
"'W d0 d1 ...' - write N (<256) 16-bit words directly to I2C\n"
|
|
);
|
|
NL();
|
|
return NULL;
|
|
break;
|
|
}
|
|
return NULL;
|
|
}
|