Compare commits
No commits in common. 'master' and 'calib-gui' have entirely different histories.
@ -1,217 +0,0 @@ |
|||||||
//
|
|
||||||
// Created by MightyPork on 2023/05/06
|
|
||||||
//
|
|
||||||
|
|
||||||
#include <string.h> |
|
||||||
#include "app_gui.h" |
|
||||||
#include "app_heater.h" |
|
||||||
#include "ufb/fb_text.h" |
|
||||||
#include "snprintf.h" |
|
||||||
#include "app_temp.h" |
|
||||||
|
|
||||||
static void apply_calib(bool temporary); |
|
||||||
|
|
||||||
static struct calib_tuning_state { |
|
||||||
uint8_t digits[6 * 4]; // a b l r
|
|
||||||
|
|
||||||
int cursor; // the digit under cursor (range 0-17)
|
|
||||||
bool digit_editing; // true if we are editing a digit
|
|
||||||
} s_tuning; |
|
||||||
|
|
||||||
static void draw_digit_row(int row) { |
|
||||||
fbpos_t x = (FBW - (6 * 7 - 1)) / 2; |
|
||||||
fbpos_t y = 30 + row * 10; |
|
||||||
|
|
||||||
char buf2[2] = {}; |
|
||||||
|
|
||||||
int numofs = row * 6; |
|
||||||
|
|
||||||
const char * labels[4] = {"a","b","L", "R"}; |
|
||||||
const int decimal_pos[4] = {2, 0, 3, 3}; |
|
||||||
fb_text(FBW - 4, y + 2, labels[row], FONT_3X5, 1); |
|
||||||
|
|
||||||
bool significant = row == 1; |
|
||||||
for (int i = 0; i < 6; i++) { |
|
||||||
if (i >= decimal_pos[row]) significant = 1; |
|
||||||
|
|
||||||
int val = s_tuning.digits[numofs + i]; |
|
||||||
if (val != 0) { |
|
||||||
significant = true; |
|
||||||
} |
|
||||||
|
|
||||||
buf2[0] = '0' + val; |
|
||||||
|
|
||||||
if (s_tuning.cursor == numofs + i) { |
|
||||||
if (s_tuning.digit_editing) { |
|
||||||
fb_rect(x-1, y-1, 5+2, 7+2, 1); |
|
||||||
fb_text(x, y, buf2, 0, 0); |
|
||||||
} else { |
|
||||||
fb_hline(x, y + 8, 5, 1); |
|
||||||
if (significant) fb_text(x, y, buf2, 0, 1); |
|
||||||
} |
|
||||||
} else { |
|
||||||
if (significant) fb_text(x, y, buf2, 0, 1); |
|
||||||
} |
|
||||||
|
|
||||||
x += 6; |
|
||||||
if (i == decimal_pos[row]) { |
|
||||||
fb_text(x, y, ".", 0, 1); |
|
||||||
x += 6; |
|
||||||
} |
|
||||||
} |
|
||||||
} |
|
||||||
|
|
||||||
void screen_calib_edit(GuiEvent event) |
|
||||||
{ |
|
||||||
float A, B, L, R; |
|
||||||
uint32_t Ai, Bi, Li, Ri; |
|
||||||
|
|
||||||
if (event == GUI_EVENT_SCREEN_INIT) { |
|
||||||
memset(&s_tuning, 0, sizeof(s_tuning)); |
|
||||||
|
|
||||||
app_temp_get_calib(&A, &B, &L, &R); |
|
||||||
app_temp_backup_calib(); |
|
||||||
|
|
||||||
Ai = (uint32_t)(A * 1000.f); |
|
||||||
Bi = (uint32_t)(B * 100000.f); |
|
||||||
Li = (uint32_t)(L * 100.f); |
|
||||||
Ri = (uint32_t)(R * 100.f); |
|
||||||
|
|
||||||
char buf[25]; |
|
||||||
SNPRINTF(buf, 25, "%06lu%06lu%06lu%06lu", Ai, Bi, Li, Ri); |
|
||||||
for(int i = 0; i < 6*4; i++) { |
|
||||||
s_tuning.digits[i] = buf[i] - '0'; |
|
||||||
} |
|
||||||
} |
|
||||||
|
|
||||||
switch (event) { |
|
||||||
case GUI_EVENT_PAINT: { |
|
||||||
fb_text(FBW / 2, 16, "Kalibrace", TEXT_CENTER, 1); |
|
||||||
|
|
||||||
draw_digit_row(0); |
|
||||||
draw_digit_row(1); |
|
||||||
draw_digit_row(2); |
|
||||||
draw_digit_row(3); |
|
||||||
|
|
||||||
//68
|
|
||||||
#define BTNS_TOP 72 |
|
||||||
|
|
||||||
if (s_tuning.cursor == 24) { |
|
||||||
fb_rect(0, BTNS_TOP, FBW, 9, 1); |
|
||||||
} |
|
||||||
fb_text(FBW / 2, BTNS_TOP + 1, "Zrušit", TEXT_CENTER, s_tuning.cursor != 24); |
|
||||||
|
|
||||||
if (s_tuning.cursor == 25) { |
|
||||||
fb_rect(0, BTNS_TOP + 9, FBW, 9, 1); |
|
||||||
} |
|
||||||
fb_text(FBW / 2, BTNS_TOP + 1 + 9, "Uložit", TEXT_CENTER, s_tuning.cursor != 25); |
|
||||||
|
|
||||||
fb_text(2, FBH - 8 * (1 + (s_tuning.cursor < 24)), s_tuning.digit_editing ? "←→Hodnota" : "←→Kurzor", 0, 1); |
|
||||||
if (s_tuning.cursor < 24) { |
|
||||||
fb_text(2, FBH - 8 * 1, s_tuning.digit_editing ? "> Potvrdit" : "> Změnit", 0, 1); |
|
||||||
} |
|
||||||
return; |
|
||||||
} |
|
||||||
|
|
||||||
case GUI_EVENT_KNOB_PLUS: { |
|
||||||
input_sound_effect(); |
|
||||||
request_paint(); |
|
||||||
|
|
||||||
if (s_tuning.digit_editing) { |
|
||||||
if (s_tuning.digits[s_tuning.cursor] == 9) { |
|
||||||
s_tuning.digits[s_tuning.cursor] = 0; |
|
||||||
} else { |
|
||||||
s_tuning.digits[s_tuning.cursor]++; |
|
||||||
} |
|
||||||
apply_calib(false); |
|
||||||
} else { |
|
||||||
// 24 - cancel
|
|
||||||
// 25 - save
|
|
||||||
s_tuning.cursor++; |
|
||||||
if (s_tuning.cursor >= 24) { |
|
||||||
s_tuning.digit_editing = false; |
|
||||||
} |
|
||||||
if (s_tuning.cursor > 25) { |
|
||||||
s_tuning.cursor = 0; |
|
||||||
} |
|
||||||
} |
|
||||||
break; |
|
||||||
} |
|
||||||
|
|
||||||
case GUI_EVENT_KNOB_MINUS: { |
|
||||||
input_sound_effect(); |
|
||||||
request_paint(); |
|
||||||
|
|
||||||
if (s_tuning.digit_editing) { |
|
||||||
if (s_tuning.digits[s_tuning.cursor] == 0) { |
|
||||||
s_tuning.digits[s_tuning.cursor] = 9; |
|
||||||
} else { |
|
||||||
s_tuning.digits[s_tuning.cursor]--; |
|
||||||
} |
|
||||||
apply_calib(false); |
|
||||||
} else { |
|
||||||
// 24 - cancel
|
|
||||||
// 25 - save
|
|
||||||
if (s_tuning.cursor == 0) { |
|
||||||
s_tuning.cursor = 25; |
|
||||||
s_tuning.digit_editing = false; |
|
||||||
} else { |
|
||||||
s_tuning.cursor--; |
|
||||||
} |
|
||||||
} |
|
||||||
break; |
|
||||||
} |
|
||||||
|
|
||||||
case GUI_EVENT_KNOB_RELEASE: { |
|
||||||
if (s_tuning.cursor < 24) { |
|
||||||
s_tuning.digit_editing = !s_tuning.digit_editing; |
|
||||||
} else if (s_tuning.cursor == 24) { |
|
||||||
// cancel
|
|
||||||
app_temp_restore_calib(); |
|
||||||
switch_screen(screen_home, true); |
|
||||||
} else if (s_tuning.cursor == 25) { |
|
||||||
// save
|
|
||||||
apply_calib(true); |
|
||||||
switch_screen(screen_home, true); |
|
||||||
} |
|
||||||
break; |
|
||||||
} |
|
||||||
} |
|
||||||
} |
|
||||||
|
|
||||||
static void apply_calib(bool temporary) { |
|
||||||
float A, B, L, R; |
|
||||||
uint32_t Ai, Bi, Li, Ri; |
|
||||||
|
|
||||||
Ai = Bi = Li = Ri = 0; |
|
||||||
|
|
||||||
for(int i = 0; i < 6; i++) { |
|
||||||
Ai *= 10; |
|
||||||
Ai += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
for(int i = 6; i < 12; i++) { |
|
||||||
Bi *= 10; |
|
||||||
Bi += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
for(int i = 12; i < 18; i++) { |
|
||||||
Li *= 10; |
|
||||||
Li += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
for(int i = 18; i < 24; i++) { |
|
||||||
Ri *= 10; |
|
||||||
Ri += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
|
|
||||||
A = ((float) Ai) / 1000.f; |
|
||||||
B = ((float) Bi) / 100000.f; |
|
||||||
L = ((float) Li) / 100.f; |
|
||||||
R = ((float) Ri) / 100.f; |
|
||||||
|
|
||||||
if (temporary) { |
|
||||||
app_temp_set_calib_temporary(A, B); |
|
||||||
app_temp_set_calib_temporary_r(L, R); |
|
||||||
} else { |
|
||||||
app_temp_set_calib_persistent(A, B); |
|
||||||
app_temp_set_calib_persistent_r(L, R); |
|
||||||
} |
|
||||||
} |
|
||||||
@ -1,194 +0,0 @@ |
|||||||
//
|
|
||||||
// Created by MightyPork on 2023/04/09.
|
|
||||||
//
|
|
||||||
|
|
||||||
#include <string.h> |
|
||||||
#include "app_gui.h" |
|
||||||
#include "app_heater.h" |
|
||||||
#include "ufb/fb_text.h" |
|
||||||
#include "snprintf.h" |
|
||||||
|
|
||||||
static struct calib_tuning_state { |
|
||||||
uint8_t digits[6 * 3]; |
|
||||||
|
|
||||||
// uint32_t Kp, Ki, Kd; // these are the float x 1000
|
|
||||||
|
|
||||||
int cursor; // the digit under cursor (range 0-17)
|
|
||||||
bool digit_editing; // true if we are editing a digit
|
|
||||||
} s_tuning; |
|
||||||
|
|
||||||
static void draw_digit_row(int row) { |
|
||||||
fbpos_t x = (FBW - (6 * 7 - 1)) / 2; |
|
||||||
fbpos_t y = 30 + row * 10; |
|
||||||
|
|
||||||
char buf2[2] = {}; |
|
||||||
|
|
||||||
int numofs = row * 6; |
|
||||||
|
|
||||||
const char * labels[3] = {"P","I","D"}; |
|
||||||
fb_text(FBW - 4, y + 2, labels[row], FONT_3X5, 1); |
|
||||||
|
|
||||||
bool significant = false; |
|
||||||
for (int i = 0; i < 6; i++) { |
|
||||||
if (i >= 2) significant = 1; |
|
||||||
|
|
||||||
int val = s_tuning.digits[numofs + i]; |
|
||||||
if (val != 0) { |
|
||||||
significant = true; |
|
||||||
} |
|
||||||
|
|
||||||
buf2[0] = '0' + val; |
|
||||||
|
|
||||||
if (s_tuning.cursor == numofs + i) { |
|
||||||
if (s_tuning.digit_editing) { |
|
||||||
fb_rect(x-1, y-1, 5+2, 7+2, 1); |
|
||||||
fb_text(x, y, buf2, 0, 0); |
|
||||||
} else { |
|
||||||
fb_hline(x, y + 8, 5, 1); |
|
||||||
if (significant) fb_text(x, y, buf2, 0, 1); |
|
||||||
} |
|
||||||
} else { |
|
||||||
if (significant) fb_text(x, y, buf2, 0, 1); |
|
||||||
} |
|
||||||
|
|
||||||
x += 6; |
|
||||||
if ( i == 2) { |
|
||||||
fb_text(x, y, ".", 0, 1); |
|
||||||
x += 6; |
|
||||||
} |
|
||||||
} |
|
||||||
} |
|
||||||
|
|
||||||
void screen_pid_tuning(GuiEvent event) |
|
||||||
{ |
|
||||||
float Kp; |
|
||||||
float Ki; |
|
||||||
float Kd; |
|
||||||
uint32_t Kp_i; |
|
||||||
uint32_t Ki_i; |
|
||||||
uint32_t Kd_i; |
|
||||||
|
|
||||||
if (event == GUI_EVENT_SCREEN_INIT) { |
|
||||||
memset(&s_tuning, 0, sizeof(s_tuning)); |
|
||||||
app_heater_get_tuning(&Kp, &Ki, &Kd); |
|
||||||
|
|
||||||
Kp_i = (uint32_t)(Kp * 1000.f); |
|
||||||
Ki_i = (uint32_t)(Ki * 1000.f); |
|
||||||
Kd_i = (uint32_t)(Kd * 1000.f); |
|
||||||
|
|
||||||
char buf[19]; |
|
||||||
SNPRINTF(buf, 19, "%06lu%06lu%06lu", Kp_i, Ki_i, Kd_i); |
|
||||||
for(int i = 0; i < 18; i++) { |
|
||||||
s_tuning.digits[i] = buf[i] - '0'; |
|
||||||
} |
|
||||||
} |
|
||||||
|
|
||||||
switch (event) { |
|
||||||
case GUI_EVENT_PAINT: { |
|
||||||
fb_text(FBW / 2, 16, "Ladění PID", TEXT_CENTER, 1); |
|
||||||
|
|
||||||
draw_digit_row(0); |
|
||||||
draw_digit_row(1); |
|
||||||
draw_digit_row(2); |
|
||||||
|
|
||||||
if (s_tuning.cursor == 18) { |
|
||||||
fb_rect(0, 68, FBW, 9, 1); |
|
||||||
} |
|
||||||
fb_text(FBW / 2, 69, "Zrušit", TEXT_CENTER, s_tuning.cursor != 18); |
|
||||||
|
|
||||||
if (s_tuning.cursor == 19) { |
|
||||||
fb_rect(0, 68 + 9, FBW, 9, 1); |
|
||||||
} |
|
||||||
fb_text(FBW / 2, 69 + 9, "Uložit", TEXT_CENTER, s_tuning.cursor != 19); |
|
||||||
|
|
||||||
fb_text(2, FBH - 8 * (1 + (s_tuning.cursor < 18)), s_tuning.digit_editing ? "←→Hodnota" : "←→Kurzor", 0, 1); |
|
||||||
if (s_tuning.cursor < 18) { |
|
||||||
fb_text(2, FBH - 8 * 1, s_tuning.digit_editing ? "> Potvrdit" : "> Změnit", 0, 1); |
|
||||||
} |
|
||||||
return; |
|
||||||
} |
|
||||||
|
|
||||||
case GUI_EVENT_KNOB_PLUS: { |
|
||||||
input_sound_effect(); |
|
||||||
request_paint(); |
|
||||||
|
|
||||||
if (s_tuning.digit_editing) { |
|
||||||
if (s_tuning.digits[s_tuning.cursor] == 9) { |
|
||||||
s_tuning.digits[s_tuning.cursor] = 0; |
|
||||||
} else { |
|
||||||
s_tuning.digits[s_tuning.cursor]++; |
|
||||||
} |
|
||||||
} else { |
|
||||||
// 18 - cancel
|
|
||||||
// 19 - save
|
|
||||||
s_tuning.cursor++; |
|
||||||
if (s_tuning.cursor > 17) { |
|
||||||
s_tuning.digit_editing = false; |
|
||||||
} |
|
||||||
if (s_tuning.cursor > 19) { |
|
||||||
s_tuning.cursor = 0; |
|
||||||
} |
|
||||||
} |
|
||||||
break; |
|
||||||
} |
|
||||||
|
|
||||||
case GUI_EVENT_KNOB_MINUS: { |
|
||||||
input_sound_effect(); |
|
||||||
request_paint(); |
|
||||||
|
|
||||||
if (s_tuning.digit_editing) { |
|
||||||
if (s_tuning.digits[s_tuning.cursor] == 0) { |
|
||||||
s_tuning.digits[s_tuning.cursor] = 9; |
|
||||||
} else { |
|
||||||
s_tuning.digits[s_tuning.cursor]--; |
|
||||||
} |
|
||||||
} else { |
|
||||||
// 18 - cancel
|
|
||||||
// 19 - save
|
|
||||||
if (s_tuning.cursor == 0) { |
|
||||||
s_tuning.cursor = 19; |
|
||||||
s_tuning.digit_editing = false; |
|
||||||
} else { |
|
||||||
s_tuning.cursor--; |
|
||||||
} |
|
||||||
} |
|
||||||
break; |
|
||||||
} |
|
||||||
|
|
||||||
case GUI_EVENT_KNOB_RELEASE: { |
|
||||||
if (s_tuning.cursor < 18) { |
|
||||||
s_tuning.digit_editing = !s_tuning.digit_editing; |
|
||||||
} else if (s_tuning.cursor == 18) { |
|
||||||
// cancel
|
|
||||||
switch_screen(screen_home, true); |
|
||||||
} else if (s_tuning.cursor == 19) { |
|
||||||
// save
|
|
||||||
|
|
||||||
Kp_i = Ki_i = Kd_i = 0; |
|
||||||
for(int i = 0; i < 6; i++) { |
|
||||||
Kp_i *= 10; |
|
||||||
Kp_i += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
for(int i = 6; i < 12; i++) { |
|
||||||
Ki_i *= 10; |
|
||||||
Ki_i += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
for(int i = 12; i < 18; i++) { |
|
||||||
Kd_i *= 10; |
|
||||||
Kd_i += s_tuning.digits[i]; |
|
||||||
} |
|
||||||
|
|
||||||
Kp = ((float) Kp_i) / 1000.f; |
|
||||||
Ki = ((float) Ki_i) / 1000.f; |
|
||||||
Kd = ((float) Kd_i) / 1000.f; |
|
||||||
|
|
||||||
app_heater_set_tuning(Kp, Ki, Kd); |
|
||||||
|
|
||||||
app_heater_save_tuning(); |
|
||||||
|
|
||||||
switch_screen(screen_home, true); |
|
||||||
} |
|
||||||
break; |
|
||||||
} |
|
||||||
} |
|
||||||
} |
|
||||||
Loading…
Reference in new issue