Fix wrong filter condition (Thanks Parai Wang)
[apps/agl-service-can-low-level.git] / low-can-binding / diagnostic / diagnostic-manager.cpp
index 61aa699..8533503 100644 (file)
@@ -41,7 +41,7 @@ diagnostic_manager_t::diagnostic_manager_t()
 ///  to have 1 diagnostic bus which are the first bus declared in the JSON
 ///  description file. Configuration instance will return it.
 ///
-/// this will initialize DiagnosticShims and cancel all active requests 
+/// this will initialize DiagnosticShims and cancel all active requests
 ///  if there are any.
 bool diagnostic_manager_t::initialize()
 {
@@ -52,7 +52,7 @@ bool diagnostic_manager_t::initialize()
        reset();
 
        initialized_ = true;
-       DEBUG("Diagnostic Manager initialized");
+       AFB_DEBUG("Diagnostic Manager initialized");
        return initialized_;
 }
 
@@ -62,13 +62,13 @@ bool diagnostic_manager_t::initialize()
 void diagnostic_manager_t::init_diagnostic_shims()
 {
        shims_ = diagnostic_init_shims(shims_logger, shims_send, NULL);
-       DEBUG("Shims initialized");
+       AFB_DEBUG("Shims initialized");
 }
 
 /// @brief Force cleanup all active requests.
 void diagnostic_manager_t::reset()
 {
-       DEBUG("Clearing existing diagnostic requests");
+       AFB_DEBUG("Clearing existing diagnostic requests");
        cleanup_active_requests(true);
 }
 
@@ -80,7 +80,7 @@ void diagnostic_manager_t::reset()
 /// @param[in] data - The data payload for the message. NULL is valid if size is also 0.
 /// @param[in] size - The size of the data payload, in bytes.
 ///
-/// @return true if the CAN message was sent successfully. 
+/// @return true if the CAN message was sent successfully.
 bool diagnostic_manager_t::shims_send(const uint32_t arbitration_id, const uint8_t* data, const uint8_t size)
 {
        diagnostic_manager_t& dm = application_t::instance().get_diagnostic_manager();
@@ -132,7 +132,7 @@ void diagnostic_manager_t::shims_logger(const char* format, ...)
        char buffer[256];
        vsnprintf(buffer, 256, format, args);
 
-       DEBUG("%s", buffer);
+       AFB_DEBUG("%s", buffer);
        va_end(args);
 }
 
@@ -185,7 +185,7 @@ void diagnostic_manager_t::cancel_request(active_diagnostic_request_t* entry)
 }
 
 /// @brief Cleanup a specific request if it isn't running and get complete. As it is almost
-/// impossible to get that state for a recurring request without waiting for that, you can 
+/// impossible to get that state for a recurring request without waiting for that, you can
 /// force the cleaning operation.
 ///
 /// @param[in] entry - the request to clean
@@ -201,11 +201,11 @@ void diagnostic_manager_t::cleanup_request(active_diagnostic_request_t* entry, b
                {
                        cancel_request(entry);
                        find_and_erase(entry, recurring_requests_);
-                       DEBUG("Cancelling completed, recurring request: %s", request_string);
+                       AFB_DEBUG("Cancelling completed, recurring request: %s", request_string);
                }
                else if (!entry->get_recurring())
                {
-                       DEBUG("Cancelling completed, non-recurring request: %s", request_string);
+                       AFB_DEBUG("Cancelling completed, non-recurring request: %s", request_string);
                        cancel_request(entry);
                        find_and_erase(entry, non_recurring_requests_);
                }
@@ -297,14 +297,14 @@ active_diagnostic_request_t* diagnostic_manager_t::add_request(DiagnosticRequest
 
                        // Erase any existing request not already cleaned.
                        cleanup_request(entry, true);
-                       DEBUG("Added one-time diagnostic request on bus %s: %s",
+                       AFB_DEBUG("Added one-time diagnostic request on bus %s: %s",
                                        bus_.c_str(), request_string);
 
                        non_recurring_requests_.push_back(entry);
        }
        else
        {
-               WARNING("There isn't enough request entry. Vector exhausted %d/%d", (int)non_recurring_requests_.size(), MAX_SIMULTANEOUS_DIAG_REQUESTS);
+               AFB_WARNING("There isn't enough request entry. Vector exhausted %d/%d", (int)non_recurring_requests_.size(), MAX_SIMULTANEOUS_DIAG_REQUESTS);
                non_recurring_requests_.resize(MAX_SIMULTANEOUS_DIAG_REQUESTS);
        }
        return entry;
@@ -319,7 +319,7 @@ active_diagnostic_request_t* diagnostic_manager_t::add_request(DiagnosticRequest
 bool diagnostic_manager_t::validate_optional_request_attributes(float frequencyHz)
 {
        if(frequencyHz > MAX_RECURRING_DIAGNOSTIC_FREQUENCY_HZ) {
-               DEBUG("Requested recurring diagnostic frequency %lf is higher than maximum of %d",
+               AFB_DEBUG("Requested recurring diagnostic frequency %lf is higher than maximum of %d",
                        frequencyHz, MAX_RECURRING_DIAGNOSTIC_FREQUENCY_HZ);
                return false;
        }
@@ -373,16 +373,16 @@ active_diagnostic_request_t* diagnostic_manager_t::add_recurring_request(Diagnos
                        recurring_requests_.push_back(entry);
 
                        entry->set_handle(shims_, request);
-                       start_diagnostic_request(&shims_, entry->get_handle()); 
+                       start_diagnostic_request(&shims_, entry->get_handle());
                }
                else
                {
-                       WARNING("There isn't enough request entry. Vector exhausted %d/%d", (int)recurring_requests_.size(), MAX_SIMULTANEOUS_DIAG_REQUESTS);
+                       AFB_WARNING("There isn't enough request entry. Vector exhausted %d/%d", (int)recurring_requests_.size(), MAX_SIMULTANEOUS_DIAG_REQUESTS);
                        recurring_requests_.resize(MAX_SIMULTANEOUS_DIAG_REQUESTS);
                }
        }
        else
-               { DEBUG("Can't add request, one already exists with same key");}
+               { AFB_DEBUG("Can't add request, one already exists with same key");}
        return entry;
 }
 
@@ -425,7 +425,7 @@ openxc_VehicleMessage diagnostic_manager_t::relay_diagnostic_response(active_dia
                found_signals = utils::signals_manager_t::instance().find_signals(build_DynamicField(adr->get_name()));
                found_signals.diagnostic_messages.front()->set_supported(false);
                cleanup_request(adr, true);
-               NOTICE("PID not supported or ill formed. Please unsubscribe from it. Error code : %d", response.negative_response_code);
+               AFB_NOTICE("PID not supported or ill formed. Please unsubscribe from it. Error code : %d", response.negative_response_code);
                message = build_VehicleMessage(build_SimpleMessage(adr->get_name(), build_DynamicField("This PID isn't supported by your vehicle.")));
        }
 
@@ -440,7 +440,7 @@ openxc_VehicleMessage diagnostic_manager_t::relay_diagnostic_response(active_dia
 }
 
 /// @brief Will take the CAN message and pass it to the receive functions that will process
-/// diagnostic handle for each active diagnostic request then depending on the result we will 
+/// diagnostic handle for each active diagnostic request then depending on the result we will
 /// return pass the diagnostic response to decode it.
 ///
 /// @param[in] entry - A pointer to an active diagnostic request holding a valid diagnostic handle
@@ -494,7 +494,7 @@ openxc_VehicleMessage diagnostic_manager_t::find_and_decode_adr(const can_messag
 }
 
 /// @brief Tell if the CAN message received is a diagnostic response.
-/// Request broadcast ID use 0x7DF and assigned ID goes from 0x7E0 to Ox7E7. That allows up to 8 ECU to respond 
+/// Request broadcast ID use 0x7DF and assigned ID goes from 0x7E0 to Ox7E7. That allows up to 8 ECU to respond
 /// at the same time. The response is the assigned ID + 0x8, so response ID can goes from 0x7E8 to 0x7EF.
 ///
 /// @param[in] cm - CAN message received from the socket.