/* * Copyright (C) 2015, 2016 "IoT.bzh" * Author "Romain Forlot" * Author "Loic Collignon" * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #include "low-can-hat.hpp" #include #include #include #include #include #include #include #include "openxc.pb.h" #include "configuration.hpp" #include "../can/can-bus.hpp" #include "../can/can-signals.hpp" #include "../can/can-message.hpp" #include "../utils/timer.hpp" #include "../utils/signals.hpp" #include "../diagnostic/diagnostic-message.hpp" #include "../utils/openxc-utils.hpp" extern "C" { #include }; void on_no_clients(std::string message) { DiagnosticRequest* diag_req = configuration_t::instance().get_request_from_diagnostic_message(message); if(diag_req != nullptr) { active_diagnostic_request_t* adr = configuration_t::instance().get_diagnostic_manager().find_recurring_request(diag_req); if( adr != nullptr) configuration_t::instance().get_diagnostic_manager().cleanup_request(adr, true); } } static void push_n_notify(const can_message_t cm) { can_bus_t& cbm = configuration_t::instance().get_can_bus_manager(); std::lock_guard can_message_lock(cbm.get_can_message_mutex()); { cbm.push_new_can_message(cm); } cbm.get_new_can_message_cv().notify_one(); } int read_message(sd_event_source *s, int fd, uint32_t revents, void *userdata) { can_message_t cm; can_signal_t* sig; diagnostic_manager_t& diag_m = configuration_t::instance().get_diagnostic_manager(); if(userdata != nullptr) { sig = (can_signal_t*)userdata; utils::socketcan_bcm_t s = sig->get_socket(); s >> cm; } else { utils::socketcan_bcm_t s = diag_m.get_socket(); s >> cm; } push_n_notify(cm); /* check if error or hangup */ if ((revents & (EPOLLERR|EPOLLRDHUP|EPOLLHUP)) != 0) { sd_event_source_unref(s); if(userdata != nullptr) { sig->get_socket().close(); sig->create_rx_filter(); NOTICE(binder_interface, "%s: Recreated RX_SETUP BCM job for signal: %s", __FUNCTION__, sig->get_name().c_str()); } else { diag_m.get_socket().close(); diag_m.cleanup_active_requests(true); ERROR(binder_interface, "%s: Error on diagnostic manager socket, cancelling active requests.", __FUNCTION__); } return -1; } return 0; } ///****************************************************************************** /// /// Subscription and unsubscription /// ///*******************************************************************************/ static int make_subscription_unsubscription(struct afb_req request, const std::string& sig_name, std::map& s, bool subscribe) { /* Make the subscription or unsubscription to the event */ if (((subscribe ? afb_req_subscribe : afb_req_unsubscribe)(request, s[sig_name])) < 0) { ERROR(binder_interface, "%s: Operation goes wrong for signal: %s", __FUNCTION__, sig_name.c_str()); return 0; } return 1; } static int create_event_handle(const std::string& sig_name, std::map& s) { s[sig_name] = afb_daemon_make_event(binder_interface->daemon, sig_name.c_str()); if (!afb_event_is_valid(s[sig_name])) { ERROR(binder_interface, "%s: Can't create an event for %s, something goes wrong.", __FUNCTION__, sig_name.c_str()); return 0; } return 1; } /// @brief Will determine if it is needed or not to create the event handle and checks it to be sure that /// we got a valid afb_event to get subscribe or unsubscribe. Then launch the subscription or unsubscription /// against the application framework using that event handle. static int subscribe_unsubscribe_signal(struct afb_req request, bool subscribe, const std::string& sig) { int ret; utils::signals_manager_t& sm = utils::signals_manager_t::instance(); std::lock_guard subscribed_signals_lock(sm.get_subscribed_signals_mutex()); std::map& s = sm.get_subscribed_signals(); if (s.find(sig) != s.end()) { if (!afb_event_is_valid(s[sig]) && !subscribe) { NOTICE(binder_interface, "%s: Event isn't valid, no need to unsubscribed.", __FUNCTION__); ret = -1; } else { // Event it isn't valid annymore, recreate it ret = create_event_handle(sig, s); } } else { /* Event doesn't exist , so let's create it */ struct afb_event empty_event = {nullptr, nullptr}; s[sig] = empty_event; ret = create_event_handle(sig, s); } // Check whether or not the event handler has been correctly created and // make the subscription/unsubscription operation is so. if (ret <= 0) return ret; return make_subscription_unsubscription(request, sig, s, subscribe); } /// /// @brief subscribe to all signals in the vector signals /// /// @param[in] afb_req request : contain original request use to subscribe or unsubscribe /// @param[in] subscribe boolean value used to chose between a subscription operation or an unsubscription /// @param[in] signals - struct containing vectors with can_signal_t and diagnostic_messages to subscribe /// /// @return Number of correctly subscribed signal /// static int subscribe_unsubscribe_signals(struct afb_req request, bool subscribe, const struct utils::signals_found& signals) { int ret, rets = 0; //TODO: Implement way to dynamically call the right function no matter // how much signals types we have. configuration_t& conf = configuration_t::instance(); for(const auto& sig : signals.diagnostic_messages) { diagnostic_manager_t& diag_m = conf.get_diagnostic_manager()