fixing not checking if charging enabled

lib/systems/src/ACUController.cpp

@@ -27,8 +27,8 @@ ACUControllerData_s ACUController::evaluate_accumulator(time_ms current_millis,
         has_invalid_packet = true;
     }
     _acu_state.SoC = get_state_of_charge(em_current, current_millis - _acu_state.prev_bms_time_stamp);
+
     // Cell balancing calculations
-
     bool previously_balancing = _acu_state.balancing_enabled;
 
     bool balance_enableable = ((previously_balancing && (input_state.max_board_temp < _acu_parameters.thresholds.balance_temp_limit_c)) ||

src/ACU_InterfaceTasks.cpp

@@ -123,13 +123,17 @@ HT_TASK::TaskResponse sample_bms_data(const unsigned long &sysMicros, const HT_T
     return HT_TASK::TaskResponse::YIELD;
 }
 
+std::array<bool, ACUConstants::NUM_CELLS> check_and_get_balancing_status() {
+    std::array<bool, ACUConstants::NUM_CELLS> cell_balancing_statuses = {false};
+    if(ACUControllerInstance::instance().get_status().balancing_enabled) {
+        ACUControllerInstance::instance().calculate_cell_balance_statuses(cell_balancing_statuses.data(), BMSDriverInstance_t::instance().get_bms_data().voltages.data(), ACUConstants::NUM_CELLS, BMSDriverInstance_t::instance().get_bms_data().min_cell_voltage);
+    }
+    return cell_balancing_statuses;
+}
+
 HT_TASK::TaskResponse write_cell_balancing_config(const unsigned long &sysMicros, const HT_TASK::TaskInfo &taskInfo)
 {
-
-    auto data = BMSDriverInstance_t::instance().get_bms_data();
-    static std::array<bool, ACUConstants::NUM_CELLS> cell_balancing_statuses;
-    ACUControllerInstance::instance().calculate_cell_balance_statuses(cell_balancing_statuses.data(), data.voltages.data(), ACUConstants::NUM_CELLS, data.min_cell_voltage);
-    BMSDriverInstance_t::instance().write_configuration(cell_balancing_statuses);
+    BMSDriverInstance_t::instance().write_configuration(check_and_get_balancing_status());
     return HT_TASK::TaskResponse::YIELD;
 }
 
@@ -360,6 +364,12 @@ HT_TASK::TaskResponse debug_print(const unsigned long &sysMicros, const HT_TASK:
     Serial.println("V");
     Serial.println();
 
+    Serial.println("Balancing status : ");
+    for(bool status : check_and_get_balancing_status()) {
+        Serial.print(status);
+        Serial.print(" ");
+    }
+
     Serial.print("Number of Global Faults: ");
     Serial.println(BMSFaultDataManagerInstance_t::instance().get_fault_data().max_consecutive_invalid_packet_count);
     // Serial.println("Number of Consecutive Faults Per Chip: ");

src/main.cpp

@@ -65,7 +65,7 @@ void setup()
     scheduler.schedule(sample_CAN_task);
     scheduler.schedule(idle_sample_task);
 
-    //scheduler.schedule(debug_prints_task);
+    // scheduler.schedule(debug_prints_task);
 
     handle_CAN_setup(ACUCANInterfaceImpl::CCU_CAN, ACUConstants::Veh_CAN_baudrate, &ACUCANInterfaceImpl::on_ccu_can_receive);
     handle_CAN_setup(ACUCANInterfaceImpl::EM_CAN, ACUConstants::EM_CAN_baudrate, &ACUCANInterfaceImpl::on_em_can_receive);