Mirrors_Framework/ODrive
1
0
Fork 0
mirror of https://github.com/odriverobotics/ODrive.git synced 2026-08-18 09:29:03 +08:00
Code Issues Actions Packages Projects Releases Wiki Activity

Add input_xxx to the setpoints for autotuning

Browse Source
This commit is contained in:
Paul Guenette
2021-12-01 17:41:00 -05:00
parent fbb9dd4a9a
commit f04f02aff7
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Firmware/MotorControl/controller.cpp
+3 -3
View File
@@ -226,9 +226,9 @@ bool Controller::update() {
autotuning_phase_ = wrap_pm_pi(autotuning_phase_ + (2.0f * M_PI * autotuning_.frequency * current_meas_period));
float c = our_arm_cos_f32(autotuning_phase_);
float s = our_arm_sin_f32(autotuning_phase_);
pos_setpoint_ = autotuning_.pos_amplitude * s; // + pos_amp_c * c
vel_setpoint_ = autotuning_.vel_amplitude * c;
torque_setpoint_ = autotuning_.torque_amplitude * -s;
pos_setpoint_ = input_pos_ + autotuning_.pos_amplitude * s; // + pos_amp_c * c
vel_setpoint_ = input_vel_ + autotuning_.vel_amplitude * c;
torque_setpoint_ = input_torque_ + autotuning_.torque_amplitude * -s;
} break;
default: {
set_error(ERROR_INVALID_INPUT_MODE);