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
13typedef enum {
14 STARTUP_MODE,
15 PID_MODE,
16} controller_mode_t;
17
18typedef 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;
23
24typedef 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;
51
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
65
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
84
85
86
87uint8_t get_speed_step_table_index_of_speed_step(uint8_t speed_step);
88bool speed_helper(struct repeating_timer *t);
89void adjust_pwm_level(uint16_t level);
90float get_kp(const controller_parameter_t *ctrl_par);
91uint16_t get_initial_level(controller_parameter_t * ctrl_par);
92void controller_startup_mode(controller_parameter_t * ctrl_par);
93bool controller_general(struct repeating_timer * t);
94void init_controller(controller_parameter_t * ctrl_par);
Definition core1.h:52
controller_mode_t mode
Definition core1.h:56
startup_parameters_t startup
Definition core1.h:64
float measurement
Definition core1.h:74
pid_parameter_t pid
Definition core1.h:69
Definition core1.h:24
Definition core1.h:18