diff --git a/lib/systems/include/DrivetrainSystem.tpp b/lib/systems/include/DrivetrainSystem.tpp index de01cc70..5c2b5235 100644 --- a/lib/systems/include/DrivetrainSystem.tpp +++ b/lib/systems/include/DrivetrainSystem.tpp @@ -148,7 +148,7 @@ void DrivetrainSystem::command_drivetrain(const DrivetrainCommand_ int index = 0; for (auto inv_pointer : inverters_) { - inv_pointer->handle_command({data.torqueSetpoints[index], data.speeds_rpm[index]}); + inv_pointer->handle_command({data.inverter_torque_limit[index], data.speeds_rpm[index]}); index++; } // last_general_cmd_time_ = curr_system_millis_; diff --git a/lib/systems/src/Controllers/LoadCellVectoringController.cpp b/lib/systems/src/Controllers/LoadCellVectoringController.cpp index e85502e8..5643df32 100644 --- a/lib/systems/src/Controllers/LoadCellVectoringController.cpp +++ b/lib/systems/src/Controllers/LoadCellVectoringController.cpp @@ -64,10 +64,10 @@ void TorqueControllerLoadCellVectoring::tick( writeout_.command.speeds_rpm[RL] = PhysicalParameters::AMK_MAX_RPM; writeout_.command.speeds_rpm[RR] = PhysicalParameters::AMK_MAX_RPM; - writeout_.command.torqueSetpoints[FL] = torquePool * frontTorqueScale_ * loadCellForcesFiltered_[0] / sumNormalForce; - writeout_.command.torqueSetpoints[FR] = torquePool * frontTorqueScale_ * loadCellForcesFiltered_[1] / sumNormalForce; - writeout_.command.torqueSetpoints[RL] = torquePool * rearTorqueScale_ * loadCellForcesFiltered_[2] / sumNormalForce; - writeout_.command.torqueSetpoints[RR] = torquePool * rearTorqueScale_ * loadCellForcesFiltered_[3] / sumNormalForce; + writeout_.command.inverter_torque_limit[FL] = torquePool * frontTorqueScale_ * loadCellForcesFiltered_[0] / sumNormalForce; + writeout_.command.inverter_torque_limit[FR] = torquePool * frontTorqueScale_ * loadCellForcesFiltered_[1] / sumNormalForce; + writeout_.command.inverter_torque_limit[RL] = torquePool * rearTorqueScale_ * loadCellForcesFiltered_[2] / sumNormalForce; + writeout_.command.inverter_torque_limit[RR] = torquePool * rearTorqueScale_ * loadCellForcesFiltered_[3] / sumNormalForce; } else { @@ -80,10 +80,10 @@ void TorqueControllerLoadCellVectoring::tick( writeout_.command.speeds_rpm[RL] = 0.0; writeout_.command.speeds_rpm[RR] = 0.0; - writeout_.command.torqueSetpoints[FL] = torqueRequest * frontRegenTorqueScale_; - writeout_.command.torqueSetpoints[FR] = torqueRequest * frontRegenTorqueScale_; - writeout_.command.torqueSetpoints[RL] = torqueRequest * rearRegenTorqueScale_; - writeout_.command.torqueSetpoints[RR] = torqueRequest * rearRegenTorqueScale_; + writeout_.command.inverter_torque_limit[FL] = torqueRequest * frontRegenTorqueScale_; + writeout_.command.inverter_torque_limit[FR] = torqueRequest * frontRegenTorqueScale_; + writeout_.command.inverter_torque_limit[RL] = torqueRequest * rearRegenTorqueScale_; + writeout_.command.inverter_torque_limit[RR] = torqueRequest * rearRegenTorqueScale_; } } else diff --git a/test/test_systems/tc_mux_v2_testing.h b/test/test_systems/tc_mux_v2_testing.h index 529b6df9..5347a674 100644 --- a/test/test_systems/tc_mux_v2_testing.h +++ b/test/test_systems/tc_mux_v2_testing.h @@ -4,6 +4,7 @@ #include "TorqueControllerMux.h" #include "TorqueControllers.h" #include "fake_controller_type.h" +#include "gtest/gtest.h" @@ -55,7 +56,7 @@ TEST(TorqueControllerMuxTesting, test_invalid_controller_request_error) SharedCarState_s state({}, {}, {}, {}, {}, {}); auto res = test.getDrivetrainCommand(ControllerMode_e::MODE_2, TorqueLimit_e::TCMUX_FULL_TORQUE, state); - ASSERT_EQ(test.get_tc_mux_status().current_error, TorqueControllerMuxError::ERROR_CONTROLLER_INDEX_OUT_OF_BOUNDS); + ASSERT_EQ(test.get_tc_mux_status().active_error, TorqueControllerMuxError::ERROR_CONTROLLER_INDEX_OUT_OF_BOUNDS); for (int i =0; i< 4; i++) { @@ -85,7 +86,7 @@ TEST(TorqueControllerMuxTesting, test_controller_output_swap_logic) out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_1, TorqueLimit_e::TCMUX_FULL_TORQUE, state); ASSERT_EQ(test.get_tc_mux_status().active_controller_mode, ControllerMode_e::MODE_0); - ASSERT_EQ(test.get_tc_mux_status().current_error, TorqueControllerMuxError::ERROR_SPEED_DIFF_TOO_HIGH); + ASSERT_EQ(test.get_tc_mux_status().active_error, TorqueControllerMuxError::ERROR_SPEED_DIFF_TOO_HIGH); set_outputs(inst1, 0, 1); set_outputs(inst2, 0, 1); @@ -94,7 +95,7 @@ TEST(TorqueControllerMuxTesting, test_controller_output_swap_logic) out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_1, TorqueLimit_e::TCMUX_FULL_TORQUE, state); ASSERT_EQ(test.get_tc_mux_status().active_controller_mode, ControllerMode_e::MODE_1); - ASSERT_EQ(test.get_tc_mux_status().current_error, TorqueControllerMuxError::NO_ERROR); + ASSERT_EQ(test.get_tc_mux_status().active_error, TorqueControllerMuxError::NO_ERROR); } TEST(TorqueControllerMuxTesting, test_torque_diff_swap_limit) @@ -108,7 +109,7 @@ TEST(TorqueControllerMuxTesting, test_torque_diff_swap_limit) auto out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_0, TorqueLimit_e::TCMUX_FULL_TORQUE, state); out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_1, TorqueLimit_e::TCMUX_FULL_TORQUE, state); ASSERT_EQ(test.get_tc_mux_status().active_controller_mode, ControllerMode_e::MODE_0); - ASSERT_EQ(test.get_tc_mux_status().current_error, TorqueControllerMuxError::ERROR_TORQUE_DIFF_TOO_HIGH); + ASSERT_EQ(test.get_tc_mux_status().active_error, TorqueControllerMuxError::ERROR_TORQUE_DIFF_TOO_HIGH); // tick it a bunch of times out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_1, TorqueLimit_e::TCMUX_FULL_TORQUE, state); @@ -118,7 +119,7 @@ TEST(TorqueControllerMuxTesting, test_torque_diff_swap_limit) out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_1, TorqueLimit_e::TCMUX_FULL_TORQUE, state); out1 = test.getDrivetrainCommand(ControllerMode_e::MODE_1, TorqueLimit_e::TCMUX_FULL_TORQUE, state); - ASSERT_EQ(test.get_tc_mux_status().current_error, TorqueControllerMuxError::ERROR_TORQUE_DIFF_TOO_HIGH); + ASSERT_EQ(test.get_tc_mux_status().active_error, TorqueControllerMuxError::ERROR_TORQUE_DIFF_TOO_HIGH); ASSERT_EQ(test.get_tc_mux_status().active_controller_mode, ControllerMode_e::MODE_0); @@ -278,6 +279,6 @@ TEST(TorqueControllerMuxTesting, test_null_pointer_error_state) ASSERT_EQ(res.inverter_torque_limit[i], 0.0f); ASSERT_EQ(res.speeds_rpm[i], 0.0f); } - ASSERT_EQ(test.get_tc_mux_status().current_error, TorqueControllerMuxError::ERROR_CONTROLLER_NULL_POINTER); + ASSERT_EQ(test.get_tc_mux_status().active_error, TorqueControllerMuxError::ERROR_CONTROLLER_NULL_POINTER); } #endif // __TC_MUX_V2_TESTING_H__ \ No newline at end of file