Skip to content

Commit 40f06e6

Browse files
committed
#50 Fix interop compilation issue
1 parent e043291 commit 40f06e6

File tree

4 files changed

+45
-42
lines changed

4 files changed

+45
-42
lines changed

CMakeLists.txt

+1-1
Original file line numberDiff line numberDiff line change
@@ -61,14 +61,14 @@ add_message_files(
6161
GeoPolygon.msg
6262
GeoSphere.msg
6363
GeoSphereArrayStamped.msg
64-
Mission.msg
6564
Object.msg
6665
ObjectNotification.msg
6766
ObjectType.msg
6867
Orientation.msg
6968
Shape.msg
7069
StationaryObstacles.msg
7170
Waypoints.msg
71+
Mission.msg
7272
)
7373

7474
## Generate services in the 'srv' folder

interop

+43-40
Original file line numberDiff line numberDiff line change
@@ -16,7 +16,7 @@ from std_msgs.msg import Header
1616
from geographic_msgs.msg import (
1717
GeoPoint,
1818
)
19-
from uavf.msg import (
19+
from uavfros.msg import (
2020
Mission,
2121
FlyZone,
2222
FlyZoneArray,
@@ -26,7 +26,7 @@ from uavf.msg import (
2626
StationaryObstacles,
2727
)
2828

29-
from uavf.srv import MissionService
29+
from uavfros.srv import MissionService
3030

3131
# AUVSI SERVER INFO
3232
SERVER_IP = "127.0.0.1"
@@ -61,108 +61,111 @@ class UAVFInteropClient(client.AsyncClient):
6161
mission_dict = json_format.MessageToDict(mission.result())
6262
return mission_dict
6363

64+
6465
def pack_mission_to_msg(mission: dict):
6566
msg = Mission()
6667

6768
# header
6869
header = Header()
6970
header.stamp = rospy.get_rostime()
70-
# header.frame_id =
71+
# header.frame_id =
7172
msg.header = header
7273

7374
# id
74-
msg.id = mission['id']
75+
msg.id = mission["id"]
7576

7677
# lostCommsPos
7778
lostCommsPos = GeoPoint()
78-
lostCommsPos.latitude = mission['lostCommsPos']['latitude']
79-
lostCommsPos.longitude = mission['lostCommsPos']['longitude']
79+
lostCommsPos.latitude = mission["lostCommsPos"]["latitude"]
80+
lostCommsPos.longitude = mission["lostCommsPos"]["longitude"]
8081
msg.lostCommsPos = lostCommsPos
8182

8283
# flyzones
8384
flyzones = FlyZoneArray()
84-
for zone in mission['flyZones']:
85+
for zone in mission["flyZones"]:
8586
flyzone = FlyZone()
86-
flyzone.max_alt = zone['altitudeMax']
87-
flyzone.min_alt = zone['altitudeMin']
87+
flyzone.max_alt = zone["altitudeMax"]
88+
flyzone.min_alt = zone["altitudeMin"]
8889
boundaryPoints = []
89-
for points in zone['boundaryPoints']:
90+
for points in zone["boundaryPoints"]:
9091
boundaryPoint = GeoPoint()
91-
boundaryPoint.latitude = points['latitude']
92-
boundaryPoint.longitude = points['longitude']
92+
boundaryPoint.latitude = points["latitude"]
93+
boundaryPoint.longitude = points["longitude"]
9394
boundaryPoints.append(boundaryPoint)
9495
flyzone.zone = boundaryPoints
9596
flyzones.flyzones.append(flyzone)
9697
msg.flyzones = flyzones
97-
98+
9899
# waypoints
99100
waypoints = []
100-
for waypoint in mission['waypoints']:
101+
for waypoint in mission["waypoints"]:
101102
temp = GeoPoint()
102-
temp.latitude = waypoint['latitude']
103-
temp.longitude = waypoint['longitude']
104-
temp.altitude = waypoint['altitude']
103+
temp.latitude = waypoint["latitude"]
104+
temp.longitude = waypoint["longitude"]
105+
temp.altitude = waypoint["altitude"]
105106
waypoints.waypoints.append(temp)
106107
msg.waypoints = waypoints
107-
108+
108109
# searchGridPoints
109110
searchGridPoints = []
110-
for point in mission['searchGridPoints']:
111+
for point in mission["searchGridPoints"]:
111112
temp = GeoPoint()
112-
temp.latitude = point['latitude']
113-
temp.longitude = point['longitude']
113+
temp.latitude = point["latitude"]
114+
temp.longitude = point["longitude"]
114115
searchGridPoints.append(temp)
115116
msg.searchGridPoints = searchGridPoints
116117

117118
# offAxisOdlcPos
118-
msg.offAxisOdlcPos.latitude = mission['offAxisOdlcPos']['latitude']
119-
msg.offAxisOdlcPos.longitude = mission['offAxisOdlcPos']['longitude']
119+
msg.offAxisOdlcPos.latitude = mission["offAxisOdlcPos"]["latitude"]
120+
msg.offAxisOdlcPos.longitude = mission["offAxisOdlcPos"]["longitude"]
120121

121122
# emergentLastKnownPos
122-
msg.emergentLastKnownPos.latitude = mission['emergentLastKnownPos']['latitude']
123-
msg.emergentLastKnownPos.longitude = mission['emergentLastKnownPos']['longitude']
123+
msg.emergentLastKnownPos.latitude = mission["emergentLastKnownPos"]["latitude"]
124+
msg.emergentLastKnownPos.longitude = mission["emergentLastKnownPos"]["longitude"]
124125

125126
# airDropBoundaryPoints
126127
boundaryPoints = []
127-
for point in mission['airDropBoundaryPoints']:
128+
for point in mission["airDropBoundaryPoints"]:
128129
temp = GeoPoint()
129-
temp.latitude = point['latitude']
130-
temp.longitude = point['longitude']
130+
temp.latitude = point["latitude"]
131+
temp.longitude = point["longitude"]
131132
boundaryPoints.append(temp)
132133
msg.airDropBoundaryPoints = boundaryPoints
133134

134135
# airDropPos
135-
msg.airDropPos.latitude = mission['airDropPos']['latitude']
136-
msg.airDropPos.longitude = mission['airDropPos']['longitude']
136+
msg.airDropPos.latitude = mission["airDropPos"]["latitude"]
137+
msg.airDropPos.longitude = mission["airDropPos"]["longitude"]
137138

138139
# ugvDropPos
139-
msg.ugvDropPos.latitude = mission['ugvDropPos']['latitude']
140-
msg.ugvDropPos.longitude = mission['ugvDropPos']['longitude']
140+
msg.ugvDropPos.latitude = mission["ugvDropPos"]["latitude"]
141+
msg.ugvDropPos.longitude = mission["ugvDropPos"]["longitude"]
141142

142143
# stationaryObstacles
143144
stationaryObstacles = []
144-
for obstacle in mission['stationaryObstacles']:
145+
for obstacle in mission["stationaryObstacles"]:
145146
temp = GeoCylinder()
146-
temp.center.latitude = obstacle['latitude']
147-
temp.center.longitude = obstacle['longitude']
148-
temp.height = obstacle['height']
149-
temp.radius = obstacle['radius']
147+
temp.center.latitude = obstacle["latitude"]
148+
temp.center.longitude = obstacle["longitude"]
149+
temp.height = obstacle["height"]
150+
temp.radius = obstacle["radius"]
150151
stationaryObstacles.append(temp)
151152
msg.stationaryObstacles = stationaryObstacles
152153

153154
# mapCenterPos
154-
msg.mapCenterPos.latitude = mission['mapCenterPos']['latitude']
155-
msg.mapCenterPos.longitude = mission['mapCenterPos']['longitude']
155+
msg.mapCenterPos.latitude = mission["mapCenterPos"]["latitude"]
156+
msg.mapCenterPos.longitude = mission["mapCenterPos"]["longitude"]
156157

157158
# mapHeight
158-
msg.mapHeight = mission['mapHeight']
159+
msg.mapHeight = mission["mapHeight"]
159160

160161
return msg
161162

163+
162164
def handle_mission(req):
163165
mission_data = interopclient.get_mission(MISSION_ID)
164166
return pack_mission_to_msg(mission_data)
165167

168+
166169
def mission_server():
167170
mission_serv = rospy.Service(MISSION_SERVER_TOPIC, MissionService, handle_mission)
168171
rospy.spin()

msg/FlyZoneArray.msg

+1-1
Original file line numberDiff line numberDiff line change
@@ -1 +1 @@
1-
Flyzone[] flyzones
1+
FlyZone[] flyzones

planner

Whitespace-only changes.

0 commit comments

Comments
 (0)