X-Git-Url: https://gerrit.automotivelinux.org/gerrit/gitweb?a=blobdiff_plain;f=CAN-binder%2Flow-can-binding%2Futils%2Fsocketcan-bcm.cpp;h=cd84a851d613aa38830481af0aafe049a73a1dcb;hb=71c41df6cd794b670f9a16ca060a9c4ab054200e;hp=1009a421fd3e1a5ee958d6fba262255fc6fc2816;hpb=1f4eb8c5562bf5c0bc6ebd1b35977cd71d9b3a83;p=apps%2Fagl-service-can-low-level.git

diff --git a/CAN-binder/low-can-binding/utils/socketcan-bcm.cpp b/CAN-binder/low-can-binding/utils/socketcan-bcm.cpp
index 1009a421..cd84a851 100644
--- a/CAN-binder/low-can-binding/utils/socketcan-bcm.cpp
+++ b/CAN-binder/low-can-binding/utils/socketcan-bcm.cpp
@@ -21,6 +21,8 @@
 #include <sys/ioctl.h>
 #include <fcntl.h>
 
+#include "../binding/application.hpp"
+
 namespace utils
 {
 	/// @brief Connect the socket.
@@ -90,7 +92,10 @@ namespace utils
 		cm = ::can_message_t::convert_from_frame(msg.frames ,
 				nbytes-sizeof(struct bcm_msg_head),
 				timestamp);
-		cm.set_sub_id((int)s.socket());
+		if(application_t::instance().get_diagnostic_manager().is_diagnostic_response(cm))
+			{cm.set_sub_id(msg.frames.data[2]);}
+		else
+			{cm.set_sub_id((int)s.socket());}
 
 		return s;
 	}