|
|
@@ -108,9 +108,11 @@ def parsehancheng(input_dir, output_dir):
|
|
|
date_time = datetime.fromtimestamp(timestamp)
|
|
|
locationsimtime=(date_time-first_message_time).total_seconds()
|
|
|
ego_posx=msg.pose.position.x
|
|
|
- poseX=ego_posx-88.96626338170609
|
|
|
+ # poseX=ego_posx-88.96626338170609
|
|
|
+ poseX=ego_posx
|
|
|
ego_posy=msg.pose.position.y
|
|
|
- poseY=ego_posy-40.553671177476645
|
|
|
+ # poseY=ego_posy-40.553671177476645
|
|
|
+ poseY=ego_posy
|
|
|
poseZ=msg.pose.position.z
|
|
|
orientationX=msg.pose.orientation.x
|
|
|
orientationY=msg.pose.orientation.y
|
|
|
@@ -137,8 +139,10 @@ def parsehancheng(input_dir, output_dir):
|
|
|
#simtime=(date_time-first_message_time).total_seconds()
|
|
|
for i in range(msg_l):
|
|
|
obj_ID = msg.objects[i].id
|
|
|
- obj_x = msg.objects[i].pose.position.x-88.96626338170609
|
|
|
- obj_y = msg.objects[i].pose.position.y-40.553671177476645
|
|
|
+ # obj_x = msg.objects[i].pose.position.x-88.96626338170609
|
|
|
+ obj_x = msg.objects[i].pose.position.x
|
|
|
+ # obj_y = msg.objects[i].pose.position.y-40.553671177476645
|
|
|
+ obj_y = msg.objects[i].pose.position.y
|
|
|
obj_z = msg.objects[i].pose.position.z
|
|
|
obj_orientationX=msg.objects[i].pose.orientation.x
|
|
|
obj_orientationY=msg.objects[i].pose.orientation.y
|
