controller: Prepare project ot use the Controller

Initialize an empty message_set to fill later when loading the Plugins
Add the required method to be able to add a message_set

Bug-AGL: SPEC-2988

Change-Id: I1dc784648f69832de8681184adaccbf5300f831d
Signed-off-by: Romain Forlot <romain.forlot@iot.bzh>

1 files changed, 41 insertions, 0 deletions

diff --git a/low-can-binding/binding/application.cpp b/low-can-binding/binding/application.cpp
index d22633f9..bcb8d732 100644
--- a/low-can-binding/binding/application.cpp
+++ b/low-can-binding/binding/application.cpp
@@ -52,6 +52,47 @@ uint8_t application_t::get_active_message_set() const
 	return active_message_set_;
 }
 
+int application_t::add_message_set(std::shared_ptr<message_set_t> new_message_set)
+{
+
+	vect_ptr_msg_def_t messages_definition = new_message_set->get_messages_definition();
+	for(std::shared_ptr<message_definition_t> cmd : messages_definition)
+	{
+		cmd->set_parent(new_message_set);
+		std::vector<std::shared_ptr<signal_t>> signals = cmd->get_signals();
+		for(std::shared_ptr<signal_t> sig: signals)
+			sig->set_parent(cmd);
+	}
+
+	std::vector<std::shared_ptr<diagnostic_message_t>> diagnostic_messages = new_message_set->get_diagnostic_messages();
+	for(std::shared_ptr<diagnostic_message_t> dm : diagnostic_messages)
+		dm->set_parent(new_message_set);
+
+	for(auto old_msg_set : message_set_)
+	{
+		if(old_msg_set->get_index() == new_message_set->get_index())
+		{
+
+			for(auto new_msg_def : new_message_set->get_messages_definition())
+			{
+				if(old_msg_set->add_message_definition(new_msg_def) < 0)
+					return -1;
+			}
+
+			for(auto new_diag_msg : new_message_set->get_diagnostic_messages())
+			{
+				if(old_msg_set->add_diagnostic_message(new_diag_msg) < 0)
+					return -1;
+			}
+
+			return 0;
+		}
+	}
+
+	message_set_.push_back(new_message_set);
+	return 0;
+}
+
 std::vector<std::shared_ptr<message_set_t> > application_t::get_message_set()
 {
 	return message_set_;