X-Git-Url: https://gerrit.automotivelinux.org/gerrit/gitweb?a=blobdiff_plain;f=CAN-binder%2Flow-can-binding%2Flow-can-binding.cpp;h=e6af92cc0f7c2dd3ba75b47e80fd44ff66afd1f5;hb=f741d262ecd237121cc8cceb0f0893daa70bdf32;hp=365080bcc812b50c55e6806ebf19364a7327c904;hpb=0b4dccf94a2a6b1ff4f5dc233b0ce0977927096d;p=apps%2Flow-level-can-service.git diff --git a/CAN-binder/low-can-binding/low-can-binding.cpp b/CAN-binder/low-can-binding/low-can-binding.cpp index 365080b..e6af92c 100644 --- a/CAN-binder/low-can-binding/low-can-binding.cpp +++ b/CAN-binder/low-can-binding/low-can-binding.cpp @@ -142,6 +142,7 @@ static int subscribe_unsubscribe_signals(struct afb_req request, bool subscribe, for(const auto& sig : signals.diagnostic_messages) { + diagnostic_manager_t& diag_m = conf.get_diagnostic_manager(); DiagnosticRequest* diag_req = conf.get_request_from_diagnostic_message(sig->get_name()); // If the requested diagnostic message isn't supported by the car then unsubcribe it @@ -150,14 +151,14 @@ static int subscribe_unsubscribe_signals(struct afb_req request, bool subscribe, if(sig->get_supported() && subscribe) { float frequency = sig->get_frequency(); - subscribe = conf.get_diagnostic_manager().add_recurring_request( + subscribe = diag_m.add_recurring_request( diag_req, sig->get_name().c_str(), false, sig->get_decoder(), sig->get_callback(), (float)frequency); //TODO: Adding callback requesting ignition status: diag_req, sig.c_str(), false, diagnostic_message_t::decode_obd2_response, diagnostic_message_t::check_ignition_status, frequency); } else { - conf.get_diagnostic_manager().cleanup_request( - conf.get_diagnostic_manager().find_recurring_request(diag_req), true); + diag_m.cleanup_request( + diag_m.find_recurring_request(diag_req), true); WARNING(binder_interface, "%s: signal: %s isn't supported. Canceling operation.", __FUNCTION__, sig->get_name().c_str()); return -1; } @@ -171,16 +172,18 @@ static int subscribe_unsubscribe_signals(struct afb_req request, bool subscribe, for(const auto& sig: signals.can_signals) { - ret = subscribe_unsubscribe_signal(request, subscribe, sig->get_name()); - if(ret <= 0) - return ret; - rets++; - DEBUG(binder_interface, "%s: signal: %s subscribed", __FUNCTION__, sig->get_name().c_str()); + if(conf.get_can_bus_manager().create_rx_filter(*sig) <= 0 && + subscribe_unsubscribe_signal(request, subscribe, sig->get_name()) <= 0) + { + return -1; + rets++; + DEBUG(binder_interface, "%s: signal: %s subscribed", __FUNCTION__, sig->get_name().c_str()); + } } return rets; } -static const std::vector parse_signals_from_request(struct afb_req request, bool subscribe) +static const std::vector parse_args_from_request(struct afb_req request, bool subscribe) { int i, n; std::vector ret; @@ -213,13 +216,14 @@ extern "C" { static void subscribe(struct afb_req request) { - std::vector signals; + std::vector args; struct utils::signals_found sf; int ok = 0, total = 0; + bool subscribe = true; - signals = parse_signals_from_request(request, true); + args = parse_args_from_request(request, subscribe); - for(const auto& sig: signals) + for(const auto& sig: args) { openxc_DynamicField search_key = build_DynamicField(sig); sf = utils::signals_manager_t::instance().find_signals(search_key); @@ -240,7 +244,7 @@ extern "C" static void unsubscribe(struct afb_req request) { - parse_signals_from_request(request, false); + parse_args_from_request(request, false); } static const struct afb_verb_desc_v1 verbs[]=