From 625474dbe895b9428a40275fa9b4b85ab71c5de2 Mon Sep 17 00:00:00 2001 From: Jan Benicek Date: Wed, 15 Jan 2025 09:54:47 +0100 Subject: [PATCH] debug speed control algorithm #7 --- scripts/speed_controller.py | 12 ++++++------ 1 file changed, 6 insertions(+), 6 deletions(-) diff --git a/scripts/speed_controller.py b/scripts/speed_controller.py index b36550e..7b6c8eb 100644 --- a/scripts/speed_controller.py +++ b/scripts/speed_controller.py @@ -84,32 +84,32 @@ def rpm_control(): #algorithm for RPM control if (requested_rpm - float(get_variable(variable_control_step_rpm))) > actual_rpm: - set_output(actual_set_U + float(variable_control_step_U)) + set_output(actual_set_U + float(get_variable(variable_control_step_U))) printer("(requested_rpm - float(get_variable(variable_control_step_rpm))) > actual_rpm") return elif (requested_rpm + float(get_variable(variable_control_step_rpm))) < actual_rpm: - set_output(actual_set_U - float(variable_control_step_U)) + set_output(actual_set_U - float(get_variable(variable_control_step_U))) printer("(requested_rpm + float(get_variable(variable_control_step_rpm))) < actual_rpm") return if (requested_rpm - float(get_variable(variable_control_step_rpm_1))) > actual_rpm: - set_output(actual_set_U + float(variable_control_step_U_1)) + set_output(actual_set_U + float(get_variable(variable_control_step_U_1))) printer("(requested_rpm - float(get_variable(variable_control_step_rpm_1))) > actual_rpm") return elif (requested_rpm + float(get_variable(variable_control_step_rpm_1))) < actual_rpm: - set_output(actual_set_U - float(variable_control_step_U_1)) + set_output(actual_set_U - float(get_variable(variable_control_step_U_1))) printer("(requested_rpm + float(get_variable(variable_control_step_rpm_1))) < actual_rpm") return if (requested_rpm - float(get_variable(variable_control_step_rpm_2))) > actual_rpm: - set_output(actual_set_U + float(variable_control_step_U_2)) + set_output(actual_set_U + float(get_variable(variable_control_step_U_2))) printer("(requested_rpm - float(get_variable(variable_control_step_rpm_2))) > actual_rpm") return elif (requested_rpm + float(get_variable(variable_control_step_rpm_2))) < actual_rpm: - set_output(actual_set_U - float(variable_control_step_U_2)) + set_output(actual_set_U - float(get_variable(variable_control_step_U_2))) printer("(requested_rpm + float(get_variable(variable_control_step_rpm_2))) < actual_rpm") return