modified: src/v2i-hub/MessageReceiverPlugin/src/MessageReceiverPlugi…

…n.cpp
usdot-fhwa-OPS · Jun 26, 2023 · 63ae453 · 63ae453
1 parent cf28cae
commit 63ae453
Showing 1 changed file with 5 additions and 3 deletions.
diff --git a/src/v2i-hub/MessageReceiverPlugin/src/MessageReceiverPlugin.cpp b/src/v2i-hub/MessageReceiverPlugin/src/MessageReceiverPlugin.cpp
@@ -166,7 +166,7 @@ void MessageReceiverPlugin::OnMessageReceived(routeable_message &msg)
 	BsmEncodedMessage encodedBsm;
 	SrmEncodedMessage encodedSrm;
 
-
+	uint16_t msgPSID = NULL;
 
 	if (msg.get_type() == "Unknown" && msg.get_subtype() == "Unknown")
 	{
@@ -263,6 +263,7 @@ void MessageReceiverPlugin::OnMessageReceived(routeable_message &msg)
 								}
 
 								sendMsg = encode(encodedBsm, bsm);
+								msgPSID = 0x20;
 								if (!simBSM) return;
 							}
 							break;
@@ -280,6 +281,7 @@ void MessageReceiverPlugin::OnMessageReceived(routeable_message &msg)
 										ntohl(*((uint32_t*)&(bytes.data()[24]))),
 										ntohl(*((uint32_t*)&(bytes.data()[28]))));
 								sendMsg = encode(encodedSrm, srm);
+								msgPSID = 0xE0000016;
 
 							}
 							break;
@@ -330,14 +332,14 @@ void MessageReceiverPlugin::OnMessageReceived(routeable_message &msg)
 		if (routeDsrc)
 		{	
 			sendMsg->set_flags(IvpMsgFlags_RouteDSRC);
-			this->OutgoingMessage(*sendMsg, true);
+			sendMsg->addDsrcMetadata(msgPSID);
 		}
 		else
 		{
 
 			sendMsg->set_flags(IvpMsgFlags_None);
-			this->OutgoingMessage(*sendMsg);
 		}
+		this->OutgoingMessage(*sendMsg);
 	}
 }