RP2040-Decoder
Loading...
Searching...
No Matches
core1.h
Go to the documentation of this file.
1
8
#pragma once
9
#include "
shared.h
"
10
11
#define BASE_PWM_ARR_LEN 16
12
13
typedef
enum
{
14
STARTUP_MODE,
15
PID_MODE,
16
} controller_mode_t;
17
18
typedef
struct
startup_parameters_t
{
19
uint16_t level;
20
uint16_t base_pwm_arr[BASE_PWM_ARR_LEN];
21
uint16_t base_pwm_arr_i;
22
}
startup_parameters_t
;
23
24
typedef
struct
pid_parameters_t
{
25
// PID Controller variables
26
float
k_i;
// Integral gain
27
float
k_d;
// Derivative gain
28
float
t;
// Sampling time
29
float
tau;
// Low-pass-filter time constant
30
float
ci_0;
// (k_i*t)/2
31
float
cd_0;
// (k_d*2)/(2*tau+t)
32
float
cd_1;
// (2*tau-t)/(2*tau+t)
33
float
int_lim_max;
// max limit for integrator
34
float
int_lim_min;
// min limit for integrator
35
float
max_output;
// max possible pwm output value
36
float
k_p;
// Proportional gain
37
float
e;
// Error
38
float
e_prev;
// Previous Error
39
float
i_prev;
// Previous Integral Value
40
float
d_prev;
// Previous Derivative Value
41
// Variable gain variables
42
float
k_p_x_1_shift;
43
float
k_p_x_1;
44
float
k_p_x_2;
45
float
k_p_y_0;
46
float
k_p_y_1;
47
float
k_p_y_2;
48
float
k_p_m_1;
49
float
k_p_m_2;
50
}
pid_parameter_t
;
51
52
typedef
struct
controller_parameter_t
{
56
controller_mode_t
mode
;
// Controller mode
57
float
feed_fwd;
// Feed forward value
58
uint32_t setpoint;
// Current setpoint
59
uint16_t speed_table[127];
// Array with setpoint values corresponding to every speed step
60
64
startup_parameters_t
startup
;
65
69
pid_parameter_t
pid
;
70
74
float
measurement
;
// Newest Measurement value
75
float
measurement_prev;
// Previous Measurement
76
float
measurement_corrected;
// measurement - adc_offset = measurement_corrected
77
float
adc_offset;
// ADC offset value
78
uint8_t msr_delay_in_us;
// Delay before VEMF Measurement
79
uint8_t msr_total_iterations;
// Amount of samples
80
uint8_t l_side_arr_cutoff;
// Discarded samples (left side)
81
uint8_t r_side_arr_cutoff;
// Discarded samples (right side)
82
83
}
controller_parameter_t
;
84
85
86
87
uint8_t get_speed_step_table_index_of_speed_step(uint8_t speed_step);
88
bool
speed_helper(
struct
repeating_timer *t);
89
void
adjust_pwm_level(uint16_t level);
90
float
get_kp(
const
controller_parameter_t
*ctrl_par);
91
uint16_t get_initial_level(
controller_parameter_t
* ctrl_par);
92
void
controller_startup_mode(
controller_parameter_t
* ctrl_par);
93
bool
controller_general(
struct
repeating_timer * t);
94
void
init_controller(
controller_parameter_t
* ctrl_par);
shared.h
controller_parameter_t
Definition
core1.h:52
controller_parameter_t::mode
controller_mode_t mode
Definition
core1.h:56
controller_parameter_t::startup
startup_parameters_t startup
Definition
core1.h:64
controller_parameter_t::measurement
float measurement
Definition
core1.h:74
controller_parameter_t::pid
pid_parameter_t pid
Definition
core1.h:69
pid_parameters_t
Definition
core1.h:24
startup_parameters_t
Definition
core1.h:18
Generated by
1.12.0