Skip to content

Current PI Autotuning #426

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Draft
wants to merge 1 commit into
base: dev
Choose a base branch
from
+26 −0
Draft

Current PI Autotuning #426

Changes from all commits
Commits
Show all changes
1 commit
Select commit
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
9 changes: 9 additions & 0 deletions src/BLDCMotor.cpp
View file
Original file line number Diff line number Diff line change
@@ -82,7 +82,16 @@ int BLDCMotor::init() {
// current control loop controls voltage
PID_current_q.limit = voltage_limit;
PID_current_d.limit = voltage_limit;

if (_isset(phase_resistance) && _isset(phase_inductance)){
PID_current_d.P = phase_inductance * DEF_CURR_BANDWIDTH * _2PI;
PID_current_d.I = PID_current_d.P * phase_resistance / phase_inductance;

PID_current_q.P = phase_inductance * DEF_CURR_BANDWIDTH * _2PI;
PID_current_q.I = PID_current_q.P * phase_resistance /phase_inductance;
}
}

if(_isset(phase_resistance) || torque_controller != TorqueControlType::voltage){
// velocity control loop controls current
PID_velocity.limit = current_limit;
15 changes: 15 additions & 0 deletions src/StepperMotor.cpp
View file
Original file line number Diff line number Diff line change
@@ -47,6 +47,21 @@ int StepperMotor::init() {
// constrain voltage for sensor alignment
if(voltage_sensor_align > voltage_limit) voltage_sensor_align = voltage_limit;

// update the controller limits
if(current_sense){
// current control loop controls voltage
PID_current_q.limit = voltage_limit;
PID_current_d.limit = voltage_limit;

if (_isset(phase_resistance) && _isset(phase_inductance)){
PID_current_d.P = phase_inductance * DEF_CURR_BANDWIDTH * _2PI;
PID_current_d.I = PID_current_d.P * phase_resistance / phase_inductance;

PID_current_q.P = phase_inductance * DEF_CURR_BANDWIDTH * _2PI;
PID_current_q.I = PID_current_q.P * phase_resistance /phase_inductance;
}
}

// update the controller limits
if(_isset(phase_resistance)){
// velocity control loop controls current
2 changes: 2 additions & 0 deletions src/common/defaults.h
View file
Original file line number Diff line number Diff line change
@@ -18,6 +18,7 @@
#define DEF_PID_CURR_RAMP 1000.0f //!< default PID controller voltage ramp value
#define DEF_PID_CURR_LIMIT (DEF_POWER_SUPPLY) //!< default PID controller voltage limit
#define DEF_CURR_FILTER_Tf 0.01f //!< default velocity filter time constant
#define DEF_CURR_BANDWIDTH 300.0f //!< current bandwidth
#else
// for stm32, due, teensy, esp32 and similar
#define DEF_PID_CURR_P 3 //!< default PID controller P value
@@ -26,6 +27,7 @@
#define DEF_PID_CURR_RAMP 0 //!< default PID controller voltage ramp value
#define DEF_PID_CURR_LIMIT (DEF_POWER_SUPPLY) //!< default PID controller voltage limit
#define DEF_CURR_FILTER_Tf 0.005f //!< default currnet filter time constant
#define DEF_CURR_BANDWIDTH 300.0f //!< current bandwidth
#endif
// default current limit values
#define DEF_CURRENT_LIM 2.0f //!< 2Amps current limit by default