Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

feat: migrate autoware_auto_msgs to autoware_msgs #313

Merged
merged 18 commits into from
Oct 16, 2024
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
18 commits
Select commit Hold shift + click to select a range
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
The table of contents is too big for display.
Diff view
Diff view
  •  
  •  
  •  
34 changes: 17 additions & 17 deletions Assets/AWSIM/Scripts/Environments/V2I/V2IRos2Publisher.cs
Original file line number Diff line number Diff line change
Expand Up @@ -26,8 +26,8 @@ public enum TrafficSignalID{
Depth = 1,
};

IPublisher<autoware_perception_msgs.msg.TrafficSignalArray> trafficSignalsPublisher;
autoware_perception_msgs.msg.TrafficSignalArray trafficSignalArrayMsg;
IPublisher<autoware_perception_msgs.msg.TrafficLightGroupArray> trafficLightGroupPublisher;
autoware_perception_msgs.msg.TrafficLightGroupArray trafficLightGroupMsg;

V2I v2iComponent;

Expand All @@ -36,21 +36,21 @@ void Start()
v2iComponent = GetComponent<V2I>();
v2iComponent.OnOutputData += UpdateMessageAndPublish;

trafficSignalArrayMsg = new autoware_perception_msgs.msg.TrafficSignalArray();
trafficLightGroupMsg = new autoware_perception_msgs.msg.TrafficLightGroupArray();

var qos = qosSettings.GetQoSProfile();
trafficSignalsPublisher = SimulatorROS2Node.CreatePublisher<autoware_perception_msgs.msg.TrafficSignalArray>(trafficSignalsTopic, qos);
trafficLightGroupPublisher = SimulatorROS2Node.CreatePublisher<autoware_perception_msgs.msg.TrafficLightGroupArray>(trafficSignalsTopic, qos);
}

void UpdateMessageAndPublish(V2I.OutputData outputData)
{
UpdateTrafficSignalArrayMsg(outputData);
trafficSignalsPublisher.Publish(trafficSignalArrayMsg);
UpdateTrafficLightGroupMsg(outputData);
trafficLightGroupPublisher.Publish(trafficLightGroupMsg);
}

private void UpdateTrafficSignalArrayMsg(V2I.OutputData data)
private void UpdateTrafficLightGroupMsg(V2I.OutputData data)
{
var trafficSignalList = new List<autoware_perception_msgs.msg.TrafficSignal>();
var trafficLightGroup = new List<autoware_perception_msgs.msg.TrafficLightGroup>();
var allRelationID = new List<long>();
foreach (var trafficLight in data.trafficLights)
{
Expand All @@ -68,21 +68,21 @@ private void UpdateTrafficSignalArrayMsg(V2I.OutputData data)
}
foreach (var relationID in ids)
{
var trafficSignalMsg = new autoware_perception_msgs.msg.TrafficSignal();
var trafficLightGroupMsg = new autoware_perception_msgs.msg.TrafficLightGroup();
if (allRelationID.Contains(relationID))
{
continue;
}
trafficSignalMsg.Traffic_signal_id = relationID;
trafficLightGroupMsg.Traffic_light_group_id = relationID;
//Get bulbData
var trafficLightBulbData = trafficLight.GetBulbData();
//Fill TrafficSignal with bulbData
var trafficLightElementList = new List<autoware_perception_msgs.msg.TrafficSignalElement>();
var trafficLightElementList = new List<autoware_perception_msgs.msg.TrafficLightElement>();
foreach (var bulbData in trafficLightBulbData)
{
if (isBulbTurnOn(bulbData.Status))
{
var trafficLightElementMsg = new autoware_perception_msgs.msg.TrafficSignalElement();
var trafficLightElementMsg = new autoware_perception_msgs.msg.TrafficLightElement();
trafficLightElementMsg.Color = V2IROS2Utility.UnityToRosBulbColor(bulbData.Color);
trafficLightElementMsg.Shape = V2IROS2Utility.UnityToRosBulbShape(bulbData.Type);
trafficLightElementMsg.Status = V2IROS2Utility.UnityToRosBulbStatus(bulbData.Status);
Expand All @@ -91,14 +91,14 @@ private void UpdateTrafficSignalArrayMsg(V2I.OutputData data)
}
}
//Add TrafficLight signal to list
trafficSignalMsg.Elements = trafficLightElementList.ToArray();
trafficSignalList.Add(trafficSignalMsg);
trafficLightGroupMsg.Elements = trafficLightElementList.ToArray();
trafficLightGroup.Add(trafficLightGroupMsg);
allRelationID.Add(relationID);
}
}
}
trafficSignalArrayMsg.Stamp = SimulatorROS2Node.GetCurrentRosTime();
trafficSignalArrayMsg.Signals = trafficSignalList.ToArray();
trafficLightGroupMsg.Stamp = SimulatorROS2Node.GetCurrentRosTime();
trafficLightGroupMsg.Traffic_light_groups = trafficLightGroup.ToArray();
}

private bool isBulbTurnOn(TrafficLight.BulbStatus bulbStatus)
Expand All @@ -108,7 +108,7 @@ private bool isBulbTurnOn(TrafficLight.BulbStatus bulbStatus)

void OnDestroy()
{
SimulatorROS2Node.RemovePublisher<autoware_perception_msgs.msg.TrafficSignalArray>(trafficSignalsPublisher);
SimulatorROS2Node.RemovePublisher<autoware_perception_msgs.msg.TrafficLightGroupArray>(trafficLightGroupPublisher);
}
}

Expand Down
Loading
Loading