Remove toml. Write calibration to dat files. Implement first draft for reading function
This commit is contained in:
parent
a5402d3f04
commit
e06c9f7ddc
@ -49,8 +49,6 @@ CFILES += settings/settings.c settings/settings-sd-card.c
|
||||
|
||||
CFILES += safety/safety-adc.c safety/safety-controller.c safety/watchdog.c
|
||||
|
||||
CFILES += toml/toml.c
|
||||
|
||||
DEBUG_DEFINES = -DDEBUGBUILD
|
||||
RELEASE_DEFINES =
|
||||
|
||||
|
@ -710,21 +710,16 @@ DRESULT sdio_disk_write(const BYTE *buff, DWORD sector, UINT count)
|
||||
addr = (card_info.type == SD_V2_HC ? (sector) : (sector * 512));
|
||||
|
||||
while (count) {
|
||||
do {
|
||||
ret = sdio_check_status_register_cmd13(card_info.rca, &status.value);
|
||||
} while (status.statusstruct.CURRENT_STATE == CURRENT_STATE_PRG ||
|
||||
status.statusstruct.CURRENT_STATE == CURRENT_STATE_RCV ||
|
||||
ret);
|
||||
ret = sdio_check_status_register_cmd13(card_info.rca, &status.value);
|
||||
|
||||
if (ret)
|
||||
return RES_ERROR;
|
||||
|
||||
if (status.statusstruct.CURRENT_STATE == CURRENT_STATE_STBY) {
|
||||
if (sdio_send_select_card_cmd7(card_info.rca))
|
||||
return RES_ERROR;
|
||||
}
|
||||
|
||||
do {
|
||||
sdio_check_status_register_cmd13(card_info.rca, &status.value);
|
||||
} while (status.statusstruct.READY_FOR_DATA != 1);
|
||||
|
||||
ret = sdio_send_write_block_cmd24(addr);
|
||||
if (ret) {
|
||||
return RES_ERROR;
|
||||
|
@ -12,9 +12,9 @@
|
||||
//4 bit: 4
|
||||
#define BUSWIDTH 4 //4
|
||||
//Initial Transfer CLK (ca. 400kHz)
|
||||
#define INITCLK 130 //120
|
||||
#define INITCLK 140 //120
|
||||
//Working CLK (Maximum)
|
||||
#define WORKCLK 50 //0
|
||||
#define WORKCLK 45 //0
|
||||
//Data Timeout in CLK Cycles
|
||||
#define DTIMEOUT 0x3000 //150
|
||||
//DMA Stream used for TX and RX DMA2 Stream 3 or 6 possible
|
||||
|
@ -23,8 +23,16 @@
|
||||
|
||||
#include <stdbool.h>
|
||||
|
||||
#define CALIBRATION_FILE_NAME "cal.toml"
|
||||
#define CALIBRATION_FILE_NAME "settings.ini"
|
||||
|
||||
int sd_card_settings_save_calibration(float sens_deviation, float offset, bool active);
|
||||
|
||||
/**
|
||||
* @brief Try and load calibration from SD card
|
||||
* @param sens_deviation
|
||||
* @param offset
|
||||
* @return 0 if files found -1 if files errorneous, -2 if no files found
|
||||
*/
|
||||
int sd_card_settings_try_load_calibration(float *sens_deviation, float *offset);
|
||||
|
||||
#endif /* __SETTINGS_SETTINGS_SD_CARD_H__ */
|
||||
|
@ -32,4 +32,6 @@
|
||||
*/
|
||||
int settings_save_calibration(float sens_deviation, float offset, bool active);
|
||||
|
||||
int settings_load_calibration(float *sens_dev, float *offset);
|
||||
|
||||
#endif /* __SETTINGS_SETTINGS_H__ */
|
||||
|
@ -1,150 +0,0 @@
|
||||
/*
|
||||
MIT License
|
||||
|
||||
Copyright (c) 2017 - 2019 CK Tan
|
||||
https://github.com/cktan/tomlc99
|
||||
|
||||
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||
of this software and associated documentation files (the "Software"), to deal
|
||||
in the Software without restriction, including without limitation the rights
|
||||
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||
copies of the Software, and to permit persons to whom the Software is
|
||||
furnished to do so, subject to the following conditions:
|
||||
|
||||
The above copyright notice and this permission notice shall be included in all
|
||||
copies or substantial portions of the Software.
|
||||
|
||||
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||||
SOFTWARE.
|
||||
*/
|
||||
#ifndef TOML_H
|
||||
#define TOML_H
|
||||
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
|
||||
|
||||
#ifdef __cplusplus
|
||||
#define TOML_EXTERN extern "C"
|
||||
#else
|
||||
#define TOML_EXTERN extern
|
||||
#endif
|
||||
|
||||
typedef struct toml_table_t toml_table_t;
|
||||
typedef struct toml_array_t toml_array_t;
|
||||
|
||||
/* A raw value, must be processed by toml_rto* before using. */
|
||||
typedef const char* toml_raw_t;
|
||||
|
||||
/* Parse a file. Return a table on success, or 0 otherwise.
|
||||
* Caller must toml_free(the-return-value) after use.
|
||||
*/
|
||||
TOML_EXTERN toml_table_t* toml_parse_file(FILE* fp,
|
||||
char* errbuf,
|
||||
int errbufsz);
|
||||
|
||||
/* Parse a string containing the full config.
|
||||
* Return a table on success, or 0 otherwise.
|
||||
* Caller must toml_free(the-return-value) after use.
|
||||
*/
|
||||
TOML_EXTERN toml_table_t* toml_parse(char* conf, /* NUL terminated, please. */
|
||||
char* errbuf,
|
||||
int errbufsz);
|
||||
|
||||
/* Free the table returned by toml_parse() or toml_parse_file(). */
|
||||
TOML_EXTERN void toml_free(toml_table_t* tab);
|
||||
|
||||
/* Retrieve the key in table at keyidx. Return 0 if out of range. */
|
||||
TOML_EXTERN const char* toml_key_in(const toml_table_t* tab, int keyidx);
|
||||
|
||||
/* Lookup table by key. Return the element or 0 if not found. */
|
||||
TOML_EXTERN toml_raw_t toml_raw_in(const toml_table_t* tab, const char* key);
|
||||
TOML_EXTERN toml_array_t* toml_array_in(const toml_table_t* tab,
|
||||
const char* key);
|
||||
TOML_EXTERN toml_table_t* toml_table_in(const toml_table_t* tab,
|
||||
const char* key);
|
||||
|
||||
/* Return the array kind: 't'able, 'a'rray, 'v'alue */
|
||||
TOML_EXTERN char toml_array_kind(const toml_array_t* arr);
|
||||
|
||||
/* For array kind 'v'alue, return the type of values
|
||||
i:int, d:double, b:bool, s:string, t:time, D:date, T:timestamp
|
||||
0 if unknown
|
||||
*/
|
||||
TOML_EXTERN char toml_array_type(const toml_array_t* arr);
|
||||
|
||||
|
||||
/* Return the number of elements in the array */
|
||||
TOML_EXTERN int toml_array_nelem(const toml_array_t* arr);
|
||||
|
||||
/* Return the key of an array */
|
||||
TOML_EXTERN const char* toml_array_key(const toml_array_t* arr);
|
||||
|
||||
/* Return the number of key-values in a table */
|
||||
TOML_EXTERN int toml_table_nkval(const toml_table_t* tab);
|
||||
|
||||
/* Return the number of arrays in a table */
|
||||
TOML_EXTERN int toml_table_narr(const toml_table_t* tab);
|
||||
|
||||
/* Return the number of sub-tables in a table */
|
||||
TOML_EXTERN int toml_table_ntab(const toml_table_t* tab);
|
||||
|
||||
/* Return the key of a table*/
|
||||
TOML_EXTERN const char* toml_table_key(const toml_table_t* tab);
|
||||
|
||||
/* Deref array by index. Return the element at idx or 0 if out of range. */
|
||||
TOML_EXTERN toml_raw_t toml_raw_at(const toml_array_t* arr, int idx);
|
||||
TOML_EXTERN toml_array_t* toml_array_at(const toml_array_t* arr, int idx);
|
||||
TOML_EXTERN toml_table_t* toml_table_at(const toml_array_t* arr, int idx);
|
||||
|
||||
/* Raw to String. Caller must call free(ret) after use.
|
||||
* Return 0 on success, -1 otherwise.
|
||||
*/
|
||||
TOML_EXTERN int toml_rtos(toml_raw_t s, char** ret);
|
||||
|
||||
/* Raw to Boolean. Return 0 on success, -1 otherwise. */
|
||||
TOML_EXTERN int toml_rtob(toml_raw_t s, int* ret);
|
||||
|
||||
/* Raw to Integer. Return 0 on success, -1 otherwise. */
|
||||
TOML_EXTERN int toml_rtoi(toml_raw_t s, int64_t* ret);
|
||||
|
||||
/* Raw to Double. Return 0 on success, -1 otherwise. */
|
||||
TOML_EXTERN int toml_rtod(toml_raw_t s, double* ret);
|
||||
|
||||
/* Same as toml_rtod, but return the sanitized double in string form as well */
|
||||
TOML_EXTERN int toml_rtod_ex(toml_raw_t s, double* ret, char* buf, int buflen);
|
||||
|
||||
/* Timestamp types. The year, month, day, hour, minute, second, z
|
||||
* fields may be NULL if they are not relevant. e.g. In a DATE
|
||||
* type, the hour, minute, second and z fields will be NULLs.
|
||||
*/
|
||||
typedef struct toml_timestamp_t toml_timestamp_t;
|
||||
struct toml_timestamp_t {
|
||||
struct { /* internal. do not use. */
|
||||
int year, month, day;
|
||||
int hour, minute, second, millisec;
|
||||
char z[10];
|
||||
} __buffer;
|
||||
int *year, *month, *day;
|
||||
int *hour, *minute, *second, *millisec;
|
||||
char* z;
|
||||
};
|
||||
|
||||
/* Raw to Timestamp. Return 0 on success, -1 otherwise. */
|
||||
TOML_EXTERN int toml_rtots(toml_raw_t s, toml_timestamp_t* ret);
|
||||
|
||||
/* misc */
|
||||
TOML_EXTERN int toml_utf8_to_ucs(const char* orig, int len, int64_t* ret);
|
||||
TOML_EXTERN int toml_ucs_to_utf8(int64_t code, char buf[6]);
|
||||
TOML_EXTERN void toml_set_memutil(void* (*xxmalloc)(size_t),
|
||||
void (*xxfree)(void*),
|
||||
void* (*xxcalloc)(size_t, size_t),
|
||||
void* (*xxrealloc)(void*, size_t));
|
||||
|
||||
#endif /* TOML_H */
|
@ -20,8 +20,11 @@
|
||||
|
||||
#include <reflow-controller/settings/settings-sd-card.h>
|
||||
#include <stm-periph/unique-id.h>
|
||||
#include <toml/toml.h>
|
||||
#include <fatfs/ff.h>
|
||||
#include <stddef.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
static void get_controller_folder_path(char *path, size_t size)
|
||||
{
|
||||
@ -38,6 +41,14 @@ static void get_controller_folder_path(char *path, size_t size)
|
||||
(unsigned int)high, (unsigned int)mid, (unsigned int)low);
|
||||
}
|
||||
|
||||
static void get_controller_settings_path(char *path, size_t size, const char *setting)
|
||||
{
|
||||
char folder[48];
|
||||
|
||||
get_controller_folder_path(folder, sizeof(folder));
|
||||
snprintf(path, size, "%s/%s.dat", folder, setting);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Open or create the controller folder on the SD Card.
|
||||
* @param[in,out] controller_folder
|
||||
@ -67,50 +78,108 @@ static int create_controller_folder(void)
|
||||
}
|
||||
}
|
||||
|
||||
if (ret >= 0)
|
||||
f_chdir(foldername);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int read_settings_file_float(const char *path, float *value)
|
||||
{
|
||||
FRESULT res;
|
||||
FIL file;
|
||||
int ret = 0;
|
||||
char buff[32];
|
||||
UINT read_count;
|
||||
|
||||
if (!value)
|
||||
return -1002;
|
||||
|
||||
res = f_open(&file, path, FA_READ);
|
||||
if (res == FR_OK) {
|
||||
memset(buff, 0, sizeof(buff));
|
||||
res = f_read(&file, buff, sizeof(buff)-1, &read_count);
|
||||
if (res != FR_OK) {
|
||||
ret = -1;
|
||||
goto close_file;
|
||||
}
|
||||
*value = strtof(buff, NULL);
|
||||
close_file:
|
||||
f_close(&file);
|
||||
} else {
|
||||
ret = -2;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int sd_card_settings_save_calibration(float sens_deviation, float offset, bool active)
|
||||
{
|
||||
FIL cal_file;
|
||||
int status;
|
||||
FRESULT res;
|
||||
char path[128];
|
||||
char buff[64];
|
||||
UINT bw;
|
||||
FIL file;
|
||||
FRESULT res;
|
||||
int ret = 0;
|
||||
char buff[256];
|
||||
|
||||
status = create_controller_folder();
|
||||
|
||||
|
||||
if (status < 0)
|
||||
if (status)
|
||||
return -2;
|
||||
|
||||
/* Create new calibration file */
|
||||
res = f_open(&cal_file, CALIBRATION_FILE_NAME, FA_CREATE_ALWAYS | FA_WRITE);
|
||||
if (res == FR_OK) {
|
||||
status = snprintf(buff, sizeof(buff), "[cal]\noffset = %f\nsensdev = %f\nactive = %s\n",
|
||||
offset, sens_deviation, (active ? "true" : "false"));
|
||||
|
||||
if ((unsigned int)status < sizeof(buff) && status >= 0) {
|
||||
f_write(&cal_file, buff, status, &bw);
|
||||
if (bw == (unsigned int)status)
|
||||
ret = 0;
|
||||
else
|
||||
ret = -3;
|
||||
} else {
|
||||
ret = -4;
|
||||
get_controller_settings_path(path, sizeof(path), "offset");
|
||||
if (active) {
|
||||
res = f_open(&file, path, FA_CREATE_ALWAYS | FA_WRITE);
|
||||
if (res != FR_OK) {
|
||||
ret = -2;
|
||||
goto exit_offset;
|
||||
}
|
||||
|
||||
f_close(&cal_file);
|
||||
|
||||
status = snprintf(buff, sizeof(buff), "%f\n", offset);
|
||||
f_write(&file, buff, status, &bw);
|
||||
f_close(&file);
|
||||
} else {
|
||||
ret = -1;
|
||||
f_unlink(path);
|
||||
}
|
||||
exit_offset:
|
||||
get_controller_settings_path(path, sizeof(path), "sens");
|
||||
if (active) {
|
||||
res = f_open(&file, path, FA_CREATE_ALWAYS | FA_WRITE);
|
||||
if (res != FR_OK) {
|
||||
ret = -2;
|
||||
goto exit_sens;
|
||||
}
|
||||
|
||||
f_chdir("/");
|
||||
|
||||
status = snprintf(buff, sizeof(buff), "%f\n", sens_deviation);
|
||||
f_write(&file, buff, status, &bw);
|
||||
f_close(&file);
|
||||
} else {
|
||||
f_unlink(path);
|
||||
}
|
||||
exit_sens:
|
||||
return ret;
|
||||
}
|
||||
|
||||
int sd_card_settings_try_load_calibration(float *sens_deviation, float *offset)
|
||||
{
|
||||
char path[128];
|
||||
int status;
|
||||
int ret = -2;
|
||||
|
||||
if (!sens_deviation || !offset)
|
||||
return -1000;
|
||||
|
||||
get_controller_settings_path(path, sizeof(path), "offset");
|
||||
status = read_settings_file_float(path, offset);
|
||||
if (status) {
|
||||
ret = status;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
get_controller_settings_path(path, sizeof(path), "sens");
|
||||
status = read_settings_file_float(path, sens_deviation);
|
||||
if (status) {
|
||||
ret = status;
|
||||
goto exit;
|
||||
}
|
||||
exit:
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
@ -21,8 +21,13 @@
|
||||
#include <reflow-controller/settings/settings.h>
|
||||
#include <reflow-controller/settings/settings-sd-card.h>
|
||||
|
||||
settings_save_calibration(float sens_deviation, float offset, bool active)
|
||||
int settings_save_calibration(float sens_deviation, float offset, bool active)
|
||||
{
|
||||
/* There is no other configuration location besides the SD card (yet) */
|
||||
return sd_card_settings_save_calibration(sens_deviation, offset, active);
|
||||
}
|
||||
|
||||
int settings_load_calibration(float *sens_dev, float *offset)
|
||||
{
|
||||
return sd_card_settings_try_load_calibration(sens_dev, offset);
|
||||
}
|
||||
|
File diff suppressed because it is too large
Load Diff
Loading…
Reference in New Issue
Block a user