/* * Copyright (C) 2015, 2016 "IoT.bzh" * Author "Romain Forlot" * * 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 #include #include #include "diagnostic-manager.hpp" #include "../utils/openxc-utils.hpp" #include "../utils/signals.hpp" #include "../binding/application.hpp" #define MAX_RECURRING_DIAGNOSTIC_FREQUENCY_HZ 10 #define MAX_SIMULTANEOUS_DIAG_REQUESTS 50 // There are only 8 slots of in flight diagnostic requests #define MAX_SIMULTANEOUS_IN_FLIGHT_REQUESTS 8 #define TIMERFD_ACCURACY 0 #define MICRO 1000000 diagnostic_manager_t::diagnostic_manager_t() : initialized_{false} {} diagnostic_manager_t::~diagnostic_manager_t() { for(auto r: recurring_requests_) { delete(r); } for(auto r: non_recurring_requests_) { delete(r); } } /// @brief Diagnostic manager is not initialized at launch but after /// the initialization of CAN bus devices. For the moment, it is only possible /// 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 /// if there are any. bool diagnostic_manager_t::initialize(std::string diagnostic_bus) { if (! diagnostic_bus.empty()) { bus_ = diagnostic_bus; init_diagnostic_shims(); reset(); AFB_DEBUG("Diagnostic Manager initialized"); initialized_ = true; return initialized_; } AFB_ERROR("Diagnostic Manager missing its bus name in the config"); return initialized_; } bool diagnostic_manager_t::is_initialized() const { return initialized_; } /// @brief initialize shims used by UDS lib and set initialized_ to true. /// It is needed before used the diagnostic manager fully because shims are /// required by most member functions. void diagnostic_manager_t::init_diagnostic_shims() { shims_ = diagnostic_init_shims(shims_logger, shims_send, NULL); AFB_DEBUG("Shims initialized"); } /// @brief Force cleanup all active requests. void diagnostic_manager_t::reset() { AFB_DEBUG("Clearing existing diagnostic requests"); cleanup_active_requests(true); } /// @brief send function use by diagnostic library. It will open a BCM CAN socket TX_SETUP type. /// That socket will send cyclic messages configured from a diagnostic request. /// /// @param[in] arbitration_id - CAN arbitration ID to use when send message. OBD2 broadcast ID /// is 0x7DF by example. /// @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. 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(); active_diagnostic_request_t* current_adr = dm.get_last_recurring_requests(); utils::socketcan_bcm_t& tx_socket = current_adr->get_socket(); // Make sure that socket has been opened. if(! tx_socket) tx_socket.open(dm.get_bus_device_name()); struct bcm_msg bcm_msg; struct can_frame cf; struct timeval freq = current_adr->get_frequency_clock().get_timeval_from_period(); bcm_msg.msg_head.opcode = TX_SETUP; bcm_msg.msg_head.can_id = arbitration_id; bcm_msg.msg_head.flags = SETTIMER|STARTTIMER|TX_CP_CAN_ID; bcm_msg.msg_head.count = 0; bcm_msg.msg_head.ival1.tv_sec = 0; bcm_msg.msg_head.ival1.tv_usec = 0; bcm_msg.msg_head.ival2.tv_sec = freq.tv_sec; bcm_msg.msg_head.ival2.tv_usec = freq.tv_usec; bcm_msg.msg_head.nframes = 1; cf.can_dlc = size; ::memset(cf.data, 0, sizeof(cf.data)); ::memcpy(cf.data, data, size); bcm_msg.frames[0] = cf; can_message_t msg = can_message_t(); msg.set_bcm_msg(bcm_msg); tx_socket.write_message(msg); if(tx_socket) return true; return false; } /// @brief The type signature for an optional logging function, if the user /// wishes to provide one. It should print, store or otherwise display the /// message. /// /// message - A format string to log using the given parameters. /// ... (vargs) - the parameters for the format string. /// void diagnostic_manager_t::shims_logger(const char* format, ...) { va_list args; va_start(args, format); char buffer[256]; vsnprintf(buffer, 256, format, args); AFB_DEBUG("%s", buffer); va_end(args); } const std::string diagnostic_manager_t::get_bus_name() const { return bus_; } const std::string diagnostic_manager_t::get_bus_device_name() const { return application_t::instance().get_can_bus_manager() .get_can_device_name(bus_); } active_diagnostic_request_t* diagnostic_manager_t::get_last_recurring_requests() const { return recurring_requests_.back(); } /// @brief Return diagnostic manager shims member. DiagnosticShims& diagnostic_manager_t::get_shims() { return shims_; } /// @brief Search for a specific active diagnostic request in the provided requests list /// and erase it from the vector. This is useful at unsubscription to clean up the list otherwize /// all received CAN messages will be passed to DiagnosticRequestHandle of all active diagnostic request /// contained in the vector but no event if connected to, so we will decode uneeded request. /// /// @param[in] entry - a pointer of an active_diagnostic_request instance to clean up /// @param[in] requests_list - a vector where to make the search and cleaning. void diagnostic_manager_t::find_and_erase(active_diagnostic_request_t* entry, std::vector& requests_list) { auto i = std::find(requests_list.begin(), requests_list.end(), entry); if ( i != requests_list.end()) requests_list.erase(i); } /// @brief Free memory allocated on active_diagnostic_request_t object and close the socket. void diagnostic_manager_t::cancel_request(active_diagnostic_request_t* entry) { entry->get_socket().close(); delete entry; entry = nullptr; } /// @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 /// force the cleaning operation. /// /// @param[in] entry - the request to clean /// @param[in] force - Force the cleaning or not ? void diagnostic_manager_t::cleanup_request(active_diagnostic_request_t* entry, bool force) { if(entry != nullptr && (force || entry->response_received())) { c

#!/usr/bin/make -f
# Copyright (C) 2015, 2016 "IoT.bzh"
# Author "Romain Forlot" <romain.forlot@iot.bzh>
#
# 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.

BUILD_DIR   := build
PACKAGING_DIR := conf.d/default/wgt

VPATH = etc:$(PACKAGING_DIR):$(PACKAGING_DIR)/etc:$(BUILD_DIR)

.PHONY: all clean mrproper package

all: build

clean:
	@([ -d ${BUILD_DIR} ] && make -C ${BUILD_DIR} clean) || echo Nothing to clean

mrproper:
	@rm -rf ${BUILD_DIR} package packaging

build: conf.d/default/cmake config.xml.in icon-default.png ${BUILD_DIR}/Makefile
	@cmake --build ${BUILD_DIR} --target all

package: build | $(PKG_FILELIST)
	@mkdir -p ${BUILD_DIR}/$@/bin
	@mkdir -p ${BUILD_DIR}/$@/etc
	@mkdir -p ${BUILD_DIR}/$@/lib
	@mkdir -p ${BUILD_DIR}/$@/htdocs
	@mkdir -p ${BUILD_DIR}/$@/data
	@mkdir -p package
	@cmake --build ${BUILD_DIR} --target widget
	@cp ${BUILD_DIR}/*wgt package

${BUILD_DIR}/Makefile:
	@[ -d ${BUILD_DIR} ] || mkdir -p ${BUILD_DIR}
	@[ -f