Power displaying

This commit is contained in:
Clément Grennerat 2025-09-15 18:47:41 +02:00
parent 38d8a6eaa1
commit 88c00aacbd

View File

@ -14,7 +14,9 @@ void run_dashboard_loop() {
draw_battery(654, i * 100 / 4, 1321, 343); draw_battery(654, i * 100 / 4, 1321, 343);
draw_speed(i * 1000 / 4); draw_speed(i * 1000 / 4);
draw_power_bars(1000 - (int16_t) i * 1000 / 200); int16_t duty = 1000 - (int16_t) i * 1000 / 200;
draw_power_bars(duty);
draw_power(100 * i / 20 * (duty < 0 ? -1 : 1), duty, 60 * 10);
HAL_Delay(50); HAL_Delay(50);
if (i == 400) { if (i == 400) {
@ -52,6 +54,9 @@ void LCD_DrawHollowRoundRect(
uint16_t fill_color, uint16_t fill_color,
uint8_t do_fill); uint8_t do_fill);
#define LEFT_CENTER_COL1 38
#define LEFT_CENTER_COL2 116
#define RIGHT_CENTER 400
void draw_init() { void draw_init() {
LCD_Fill_Screen(COLOR_OFF, 1); LCD_Fill_Screen(COLOR_OFF, 1);
LCD_Fill_Screen(COLOR_BG, 0); LCD_Fill_Screen(COLOR_BG, 0);
@ -97,8 +102,8 @@ void draw_battery(
int32_t trip_dist, int32_t trip_dist,
uint32_t life_dist) { uint32_t life_dist) {
if (voltage == last_voltage && percent/100 == last_percent/100 if (voltage == last_voltage && percent / 100 == last_percent / 100
&& trip_dist/10 == last_trip_dist/10) { && trip_dist / 10 == last_trip_dist / 10) {
return; return;
} }
last_voltage = voltage; last_voltage = voltage;
@ -112,7 +117,7 @@ void draw_battery(
filled_bar_width = 6;// Must be at least the size of the border radius. filled_bar_width = 6;// Must be at least the size of the border radius.
} }
uint16_t filled_bar_end_x = 4 + 2 + filled_bar_width; uint16_t filled_bar_end_x = 4 + 2 + filled_bar_width;
uint16_t text_y_12 = LCD_HEIGHT - 6 - (22 - 16) / 2; //uint16_t text_y_12 = LCD_HEIGHT - 6 - (22 - 16) / 2;
uint16_t text_y_14 = LCD_HEIGHT - 6 - (22 - 18) / 2; uint16_t text_y_14 = LCD_HEIGHT - 6 - (22 - 18) / 2;
char voltage_text[8]; char voltage_text[8];
@ -180,30 +185,31 @@ void draw_power_bars(int16_t dutyy) {
uint16_t max_width = LCD_WIDTH / 2; uint16_t max_width = LCD_WIDTH / 2;
uint8_t regen = dutyy < 0; uint8_t regen = dutyy < 0;
uint16_t duty = regen ? -dutyy : dutyy; uint16_t duty = regen ? -dutyy : dutyy;
duty *= 1/0.8; // 80% duty means the bar is at 100% duty *= 1 / 0.8;// 80% duty means the bar is at 100%
uint16_t width = ((float) duty / 1000.0) * max_width; uint16_t width = ((float) duty / 1000.0) * max_width;
uint16_t last_origin = last_regen ? offset - last_width : offset; uint16_t last_origin = last_regen ? offset - last_width : offset;
uint16_t origin = regen ? offset - width : offset; uint16_t origin = regen ? offset - width : offset;
uint16_t color = regen ? COLOR_ERROR : COLOR_SUCCESS; uint16_t color = regen ? COLOR_ERROR : COLOR_SUCCESS;
if(regen != last_regen) { if (regen != last_regen) {
LCD_Draw_Rectangle(last_origin, 0, last_width, 20, COLOR_BG); LCD_Draw_Rectangle(last_origin, 0, last_width, 20, COLOR_BG);
LCD_Draw_Rectangle(origin, 0, width, 20, color); LCD_Draw_Rectangle(origin, 0, width, 20, color);
last_regen = regen; last_regen = regen;
last_width = width; last_width = width;
}else if (width != last_width){ } else if (width != last_width) {
if(regen) { if (regen) {
if (last_origin < origin) { if (last_origin < origin) {
LCD_Draw_Rectangle(last_origin, 0, origin - last_origin, 20, COLOR_BG); LCD_Draw_Rectangle(last_origin, 0, origin - last_origin, 20, COLOR_BG);
}else { } else {
LCD_Draw_Rectangle(origin, 0, last_origin - origin, 20, color); LCD_Draw_Rectangle(origin, 0, last_origin - origin, 20, color);
} }
}else { } else {
if (last_width < width) { if (last_width < width) {
LCD_Draw_Rectangle(origin + last_width, 0, width - last_width, 20, color); LCD_Draw_Rectangle(origin + last_width, 0, width - last_width, 20,
}else { color);
} else {
LCD_Draw_Rectangle(origin + width, 0, last_width - width, 20, COLOR_BG); LCD_Draw_Rectangle(origin + width, 0, last_width - width, 20, COLOR_BG);
} }
} }
@ -214,14 +220,14 @@ void draw_power_bars(int16_t dutyy) {
// Displays the huge speed counter with avg and max values. // Displays the huge speed counter with avg and max values.
// Speed from COMM_GET_VALUES_SETUP, scale 1000 // Speed from COMM_GET_VALUES_SETUP, scale 1000
uint32_t last_speed = 0; uint32_t last_speed = 30;
uint32_t max_speed = 0; uint32_t max_speed = 0;
uint32_t last_avg_speed = 0; uint32_t last_avg_speed = 30;
uint32_t avg_speed_tot = 0;// You need to ride super fast for a super long time for it to overflow ;) uint32_t avg_speed_tot = 0;// You need to ride super fast for a super long time for it to overflow ;)
uint32_t avg_speed_count = 0; uint32_t avg_speed_count = 0;
void draw_speed(int32_t speedd) { void draw_speed(int32_t speedd) {
uint16_t erase_width = 90;// width to erase from center
uint32_t speed = speedd < 0 ? -speedd/1000 : speedd/1000; uint32_t speed = speedd < 0 ? -speedd / 1000 : speedd / 1000;
if (speed >= 100) { if (speed >= 100) {
speed = 99; speed = 99;
} }
@ -244,6 +250,7 @@ void draw_speed(int32_t speedd) {
// Draw // Draw
if (last_speed != speed) { if (last_speed != speed) {
last_speed = speed; last_speed = speed;
uint16_t erase_width = 85;// width to erase from center
char speed_text[4]; char speed_text[4];
sprintf(speed_text, "%lu", speed); sprintf(speed_text, "%lu", speed);
LCD_Draw_Rectangle(LCD_WIDTH / 2 - erase_width, 22, 2 * erase_width, 110, LCD_Draw_Rectangle(LCD_WIDTH / 2 - erase_width, 22, 2 * erase_width, 110,
@ -254,6 +261,7 @@ void draw_speed(int32_t speedd) {
if (update_stats) { if (update_stats) {
char stats_text[20]; char stats_text[20];
uint16_t erase_width = 90;// width to erase from center
sprintf(stats_text, "avg: %lu max: %lu", avg_speed, max_speed); sprintf(stats_text, "avg: %lu max: %lu", avg_speed, max_speed);
LCD_Draw_Rectangle(LCD_WIDTH / 2 - erase_width, 140, 2 * erase_width, 25, LCD_Draw_Rectangle(LCD_WIDTH / 2 - erase_width, 140, 2 * erase_width, 25,
COLOR_BG); COLOR_BG);
@ -262,11 +270,59 @@ void draw_speed(int32_t speedd) {
} }
} }
int16_t last_current = 99;
uint16_t last_duty = 99;
int32_t last_power = 1000;
// Displays Current, Duty, Watts // Displays Current, Duty, Watts
// Current from COMM_GET_VALUES, scale 100 // Current from COMM_GET_VALUES, scale 100
// Duty from COMM_GET_VALUES, scale 1000 // Duty from COMM_GET_VALUES, scale 1000
// Input voltage from COMM_GET_VALUES, scale 10 // Input voltage from COMM_GET_VALUES, scale 10
void draw_power(int32_t amps, int16_t duty, int16_t voltage) { void draw_power(int32_t current_i, int16_t duty_i, int16_t voltage_i) {
int16_t current = current_i / 100;
uint16_t duty = duty_i < 0 ? -duty_i / 10 : duty_i / 10;
int32_t power = ((int32_t) voltage_i) * ((int32_t) current_i) / 10000 * 10;
if (current != last_current) {
last_current = current;
if(current >= 100) {
current = 99;
}else if(current <= -100){
current = -99;
}
char text[8];
sprintf(text, "%dA", current);
LCD_Draw_Rectangle(LEFT_CENTER_COL1 - 38, 30, 2 * 39, 35, COLOR_BG);
GFX_DrawText(LEFT_CENTER_COL1, 60, text, &monomaniacone20pt,
COLOR_PRIMARY, COLOR_BG, 1, -2);
}
if (duty != last_duty) {
last_duty = duty;
if (duty >= 100) {
duty = 99;
}
char text[8];
sprintf(text, "%u%%", duty);
LCD_Draw_Rectangle(LEFT_CENTER_COL2 - 39, 30, 2 * 39, 35, COLOR_BG);
GFX_DrawText(LEFT_CENTER_COL2, 60, text, &monomaniacone20pt,
COLOR_PRIMARY, COLOR_BG, 1, -2);
}
if (power != last_power) {
last_power = power;
if (power >= 10000) {
power = 9999;
}else if(power <= -10000) {
power = -9999;
}
char text[10];
sprintf(text, "%dW", power);
LCD_Draw_Rectangle(RIGHT_CENTER - 70, 30, 2 * 70, 35, COLOR_BG);
GFX_DrawText(RIGHT_CENTER, 60, text, &monomaniacone20pt,
COLOR_PRIMARY, COLOR_BG, 1, -2);
}
} }