13
13
# limitations under the License.sr/bin/env python
14
14
15
15
import json
16
- import logging
17
16
import math
18
17
import threading
19
18
40
39
from tier4_vehicle_msgs .msg import ActuationStatusStamped
41
40
from transforms3d .euler import euler2quat
42
41
43
- from .modules .carla_data_provider import CarlaDataProvider
44
42
from .modules .carla_data_provider import GameTime
45
43
from .modules .carla_data_provider import datetime
46
44
from .modules .carla_utils import carla_location_to_ros_point
50
48
from .modules .carla_wrapper import SensorInterface
51
49
52
50
53
- class carla_interface (object ):
51
+ class carla_ros2_interface (object ):
54
52
def __init__ (self ):
55
53
self .sensor_interface = SensorInterface ()
56
54
self .timestamp = None
@@ -77,8 +75,7 @@ def __init__(self):
77
75
78
76
# initialize ros2 node
79
77
rclpy .init (args = None )
80
- self .ros2_node = rclpy .create_node ("carla_interface" )
81
- self .logger = logging .getLogger ("log" )
78
+ self .ros2_node = rclpy .create_node ("carla_ros2_interface" )
82
79
self .parameters = {
83
80
"host" : rclpy .Parameter .Type .STRING ,
84
81
"port" : rclpy .Parameter .Type .INTEGER ,
@@ -157,13 +154,15 @@ def __init__(self):
157
154
PointCloud2 , f'/sensing/lidar/{ sensor ["id" ]} /pointcloud' , 10
158
155
)
159
156
else :
160
- self .logger .info ("Please use Top, Right, or Left as the LIDAR ID" )
157
+ self .ros2_node .get_logger ().info (
158
+ "Please use Top, Right, or Left as the LIDAR ID"
159
+ )
161
160
elif sensor ["type" ] == "sensor.other.imu" :
162
161
self .pub_imu = self .ros2_node .create_publisher (
163
162
Imu , "/sensing/imu/tamagawa/imu_raw" , 1
164
163
)
165
164
else :
166
- self .logger .info ("No Publisher for this Sensor" )
165
+ self .ros2_node . get_logger () .info ("No Publisher for this Sensor" )
167
166
pass
168
167
169
168
self .spin_thread = threading .Thread (target = rclpy .spin , args = (self .ros2_node ,))
@@ -245,15 +244,9 @@ def pose(self):
245
244
header = self .get_msg_header (frame_id = "map" )
246
245
out_pose_with_cov = PoseWithCovarianceStamped ()
247
246
pose_carla = Pose ()
248
- pose_carla .position = carla_location_to_ros_point (
249
- CarlaDataProvider .get_transform (
250
- CarlaDataProvider .get_actor_by_name (self .param_values ["ego_vehicle_role_name" ])
251
- ).location
252
- )
247
+ pose_carla .position = carla_location_to_ros_point (self .ego_actor .get_transform ().location )
253
248
pose_carla .orientation = carla_rotation_to_ros_quaternion (
254
- CarlaDataProvider .get_transform (
255
- CarlaDataProvider .get_actor_by_name (self .param_values ["ego_vehicle_role_name" ])
256
- ).rotation
249
+ self .ego_actor .get_transform ().rotation
257
250
)
258
251
out_pose_with_cov .header = header
259
252
out_pose_with_cov .pose .pose = pose_carla
@@ -461,7 +454,7 @@ def run_step(self, input_data, timestamp):
461
454
elif sensor_type == "sensor.other.imu" :
462
455
self .imu (data [1 ])
463
456
else :
464
- self .logger .info ("No Publisher for [{key}] Sensor" )
457
+ self .ros2_node . get_logger () .info ("No Publisher for [{key}] Sensor" )
465
458
466
459
# Publish ego vehicle status
467
460
self .ego_status ()
0 commit comments