Add preliminary test for PID controller

This commit is contained in:
Mario Hüttel 2020-04-20 21:12:40 +02:00
parent d0fa0cf39c
commit 8125fc4ffb
1 changed files with 18 additions and 2 deletions

View File

@ -32,7 +32,9 @@
#include <reflow-controller/systick.h>
#include <reflow-controller/adc-meas.h>
#include <reflow-controller/shell.h>
#include <reflow-controller/pid-controller.h>
#include <reflow-controller/digio.h>
#include <reflow-controller/temp-converter.h>
#include <reflow-controller/rotary-encoder.h>
#include <stm-periph/stm32-gpio-macros.h>
#include <stm-periph/clock-enable-manager.h>
@ -55,8 +57,8 @@ static void setup_nvic_priorities()
static float pt1000_value;
static volatile int pt1000_value_status;
static uint32_t rot;
static volatile float pid_out;
static volatile float current_temperature;
static inline void uart_gpio_config()
{
@ -113,6 +115,9 @@ int main()
shellmatta_handle_t shell_handle;
int uart_receive_status;
static struct pid_controller pid;
uint64_t pid_timestamp = 0;
setup_nvic_priorities();
systick_setup();
@ -134,9 +139,20 @@ int main()
f_close(&test_file);
}
pid_init(&pid, 0.1, 0.1, 4.0, 0.0, 100.0, 40.0);
pid_zero(&pid);
while (1) {
pt1000_value_status = adc_pt1000_get_current_resistance(&pt1000_value);
if (pt1000_value_status >= 0) {
(void)temp_converter_convert_resistance_to_temp(pt1000_value, (float *)&current_temperature);
if ((systick_get_global_tick() - pid_timestamp) >= 250) {
pid_out = pid_sample(&pid, 100.0 - current_temperature);
pid_timestamp = systick_get_global_tick();
}
}
rot = rotary_encoder_get_abs_val();
uart_receive_status = uart_receive_data_with_dma(&shell_uart, &uart_input, &uart_input_len);
if (uart_receive_status >= 1)