summaryrefslogtreecommitdiffstats
path: root/recipes-demo/simple-can-simulator/files
ModeNameSize
-rwxr-xr-xsimple_can_simulator.py15879logstatsplain
26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175
/*
 * 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.
 */
#include <ctime>

#include "application.hpp"

#include "../utils/signals.hpp"
#include "../utils/openxc-utils.hpp"
#include "low-can-subscription.hpp"

#define MICROSECONDS_IN_SECOND	1000000
#define ENGINE_VALUE_TIMEOUT	5

/// @brief Return singleton instance of configuration object.
application_t& application_t::instance()
{
	static application_t config;
	return config;
}

can_bus_t& application_t::get_can_bus_manager()
{
	return can_bus_manager_;
}

std::map<std::string, std::shared_ptr<low_can_subscription_t> >& application_t::get_can_devices()
{
	return can_devices_;
}

diagnostic_manager_t& application_t::get_diagnostic_manager()
{
	return diagnostic_manager_;
}

uint8_t application_t::get_active_message_set() const
{
	return active_message_set_;
}

std::vector<std::shared_ptr<message_set_t> > application_t::get_message_set()
{
	return message_set_;
}

vect_ptr_signal_t application_t::get_all_signals()
{
	return message_set_[active_message_set_]->get_all_signals();
}

vect_ptr_diag_msg_t application_t::get_diagnostic_messages()
{
	return message_set_[active_message_set_]->get_diagnostic_messages();
}

vect_ptr_msg_def_t application_t::get_messages_definition()
{
	return message_set_[active_message_set_]->get_messages_definition();
}


std::shared_ptr<message_definition_t> application_t::get_message_definition(uint32_t id)
{
	std::shared_ptr<message_definition_t> ret = nullptr;
	vect_ptr_msg_def_t messages_definition = get_messages_definition();
	for(std::shared_ptr<message_definition_t> &msg_def : messages_definition)
	{
		if(msg_def->get_id() == id)
		{
			ret = msg_def;
			break;
		}
	}
	return ret;
}


uint32_t application_t::get_signal_id(diagnostic_message_t& sig) const
{
	return sig.get_pid();
}

uint32_t application_t::get_signal_id(signal_t& sig) const
{
	return sig.get_message()->get_id();
}

void application_t::set_active_message_set(uint8_t id)
{
	active_message_set_ = id;
}

bool application_t::isEngineOn()
{
	struct utils::signals_found sf;
	openxc_DynamicField search_key = build_DynamicField("engine.speed");
	sf = utils::signals_manager_t::instance().find_signals(search_key);
	bool engine_on = false;
	uint64_t last_timestamp_in_s;

	if(sf.signals.size() == 1)
	{
		last_timestamp_in_s = sf.signals.front()->get_last_value_with_timestamp().second
						/ MICROSECONDS_IN_SECOND;

		if(sf.signals.front()->get_last_value_with_timestamp().first > 0 &&
		   std::difftime(std::time(nullptr), last_timestamp_in_s) < ENGINE_VALUE_TIMEOUT)
		{
			engine_on = true;
		}
		else
		{
			AFB_NOTICE("is_engine_on: engine.speed CAN signal found, but engine seems off");
		}
	}
	else
	{
		AFB_NOTICE("is_engine_on: Can't identify a useable engine.speed CAN signal");
	}

	if(sf.diagnostic_messages.size() == 1)
	{
		last_timestamp_in_s = sf.diagnostic_messages.front()->get_last_value_with_timestamp().second
						/ MICROSECONDS_IN_SECOND;

		if(sf.diagnostic_messages.front()->get_last_value_with_timestamp().first > 0 &&
		   std::difftime(std::time(nullptr), last_timestamp_in_s) < ENGINE_VALUE_TIMEOUT)
		{
			engine_on = true;
		}
		else
		{
			AFB_NOTICE("is_engine_on: engine.speed diagnostic message found, but engine seems off");
		}
	}
	else
	{
		AFB_NOTICE("is_engine_on: Can't identify a useable engine.speed diagnostic message");
	}

	return engine_on;
}

#ifdef USE_FEATURE_J1939
std::shared_ptr<utils::socketcan_t> application_t::get_socket_address_claiming()
{
	return subscription_address_claiming_->get_socket();
}

std::shared_ptr<low_can_subscription_t> application_t::get_subscription_address_claiming()
{
	return subscription_address_claiming_;
}


void application_t::set_subscription_address_claiming(std::shared_ptr<low_can_subscription_t> new_subscription)
{
	subscription_address_claiming_ = new_subscription;
}

#endif