Skip to content

Commit 2e7f10a

Browse files
committed
Add URDF model of ego vehicle
1 parent ca813ce commit 2e7f10a

File tree

6 files changed

+98
-17
lines changed

6 files changed

+98
-17
lines changed

launch/demo_kitti_folder.launch

Lines changed: 5 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -15,4 +15,9 @@
1515

1616
<node name="rviz" pkg="rviz" type="rviz"
1717
args="--display-config $(find continuous_clustering)/rviz/demo_kitti_folder.rviz"/>
18+
19+
<!-- below is just for visualization of a dummy car in Rviz (has not the correct dimensions) -->
20+
<param name="robot_description" command="$(find xacro)/xacro $(find continuous_clustering)/urdf/dummy_car.urdf"/>
21+
<node pkg="tf2_ros" type="static_transform_publisher" name="publish_base_link"
22+
args="0 0 -1.3 0 0 0 velo_link base_link"/>
1823
</launch>

launch/vehicle_kitti.launch

Lines changed: 3 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -7,4 +7,7 @@
77
<param name="/vehicles/vw_passat_b6/geometric/length_ref_to_rear_end" value="-3"/>
88
<param name="/vehicles/vw_passat_b6/geometric/width_ref_to_left_mirror" value="1.5"/>
99
<param name="/vehicles/vw_passat_b6/geometric/width_ref_to_right_mirror" value="-1.5"/>
10+
11+
<!-- visualize dummy car in Rviz (has not the correct dimensions!) -->
12+
<param name="robot_description" command="$(find xacro)/xacro $(find continuous_clustering)/urdf/dummy_car.urdf"/>
1013
</launch>

launch/vehicle_touareg.launch

Lines changed: 3 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -8,6 +8,9 @@
88
<param name="/vehicles/touareg/geometric/width_ref_to_left_mirror" value="1.1085"/>
99
<param name="/vehicles/touareg/geometric/width_ref_to_right_mirror" value="-1.1085"/>
1010

11+
<!-- visualize dummy car in Rviz (has not the correct dimensions!) -->
12+
<param name="robot_description" command="$(find xacro)/xacro $(find continuous_clustering)/urdf/dummy_car.urdf"/>
13+
1114
<!-- uncomment the following if you want to have the regular 360° PointCloud2 for the Ouster sensor -->
1215

1316
<!-- lidar ouster left -->

rviz/demo_kitti_folder.rviz

Lines changed: 26 additions & 10 deletions
Original file line numberDiff line numberDiff line change
@@ -11,7 +11,7 @@ Panels:
1111
- /LidarRoof1/ContinuousPointClouds1/GroundPointSegmentation1/Show only1
1212
- /LidarRoof1/ContinuousPointClouds1/InstanceSegmentation1/Enable continuous1
1313
Splitter Ratio: 0.6441441178321838
14-
Tree Height: 701
14+
Tree Height: 581
1515
- Class: rviz/Selection
1616
Name: Selection
1717
- Class: rviz/Tool Properties
@@ -62,6 +62,8 @@ Visualization Manager:
6262
Frame Timeout: 15
6363
Frames:
6464
All Enabled: true
65+
base_link:
66+
Value: true
6567
odom:
6668
Value: true
6769
velo_link:
@@ -75,17 +77,31 @@ Visualization Manager:
7577
Tree:
7678
odom:
7779
velo_link:
78-
{}
80+
base_link:
81+
{}
7982
Update Interval: 0
8083
Value: true
81-
- Class: rviz/Marker
84+
- Alpha: 1
85+
Class: rviz/RobotModel
86+
Collision Enabled: false
8287
Enabled: true
83-
Marker Topic: /ego_robot_bounding_box
84-
Name: EgoVehicle
85-
Namespaces:
86-
ego_robot: true
87-
Queue Size: 100
88+
Links:
89+
All Links Enabled: true
90+
Expand Joint Details: false
91+
Expand Link Details: false
92+
Expand Tree: false
93+
Link Tree Style: Links in Alphabetic Order
94+
base_link:
95+
Alpha: 1
96+
Show Axes: false
97+
Show Trail: false
98+
Value: true
99+
Name: RobotModel
100+
Robot Description: robot_description
101+
TF Prefix: ""
102+
Update Interval: 0
88103
Value: true
104+
Visual Enabled: true
89105
- Class: rviz/Group
90106
Displays:
91107
- Alpha: 1
@@ -467,12 +483,12 @@ Window Geometry:
467483
collapsed: false
468484
GroundPointSegmentation:
469485
collapsed: false
470-
Height: 1136
486+
Height: 1016
471487
Hide Left Dock: false
472488
Hide Right Dock: false
473489
InstanceSegmentation:
474490
collapsed: false
475-
QMainWindow State: 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
491+
QMainWindow State: 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
476492
Selection:
477493
collapsed: false
478494
Time:

src/tools/kitti_demo.cpp

Lines changed: 0 additions & 7 deletions
Original file line numberDiff line numberDiff line change
@@ -313,13 +313,6 @@ class KittiDemo
313313
// generate (flattened) range image from point cloud (height corresponds to number of lasers)
314314
std::vector<KittiPoint> range_image = kitti_loader.generateRangeImage(points);
315315

316-
#ifdef WITH_ROS
317-
// publish ego robot as marker
318-
if (!disable_ros_publishers)
319-
publish_ego_robot_bounding_box(
320-
timestamps_velodyne_start[frame_index], pub_ego_robot_bbox, config.ground_segmentation);
321-
#endif
322-
323316
// publish individual firings (here column and firing is the same as we pretend that the lasers
324317
// of one firing have the same azimuth angle, this is not the case for real velodyne sensors)
325318
for (int column_index = 0; column_index < KittiLoader::RANGE_IMAGE_WIDTH; column_index++)

urdf/dummy_car.urdf

Lines changed: 61 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,61 @@
1+
<?xml version="1.0"?>
2+
<robot name="touareg">
3+
4+
<!-- add colors -->
5+
<material name="gray">
6+
<color rgba="0.8 0.8 0.8 0.5"/>
7+
</material>
8+
<material name="black">
9+
<color rgba="0 0 0 1"/>
10+
</material>
11+
12+
<link name="base_link">
13+
14+
<!-- chassis -->
15+
<visual>
16+
<geometry>
17+
<box size="4.754 2.217 1.5"/>
18+
</geometry>
19+
<origin xyz="-0.0235 0 0.338" rpy="0 0 0"/>
20+
<material name="gray"/>
21+
</visual>
22+
23+
<!-- front left wheel -->
24+
<visual>
25+
<geometry>
26+
<cylinder length="0.2" radius="0.37"/>
27+
</geometry>
28+
<origin xyz="1.4275 1.1085 -0.2715" rpy="${pi / 2} 0 0"/>
29+
<material name="black"/>
30+
</visual>
31+
32+
<!-- front right wheel -->
33+
<visual>
34+
<geometry>
35+
<cylinder length="0.2" radius="0.37"/>
36+
</geometry>
37+
<origin xyz="1.4275 -1.1085 -0.2715" rpy="${pi / 2} 0 0"/>
38+
<material name="black"/>
39+
</visual>
40+
41+
<!-- rear left wheel -->
42+
<visual>
43+
<geometry>
44+
<cylinder length="0.2" radius="0.37"/>
45+
</geometry>
46+
<origin xyz="-1.4275 1.1085 -0.2715" rpy="${pi / 2} 0 0"/>
47+
<material name="black"/>
48+
</visual>
49+
50+
<!-- rear right wheel -->
51+
<visual>
52+
<geometry>
53+
<cylinder length="0.2" radius="0.37"/>
54+
</geometry>
55+
<origin xyz="-1.4275 -1.1085 -0.2715" rpy="${pi / 2} 0 0"/>
56+
<material name="black"/>
57+
</visual>
58+
</link>
59+
60+
61+
</robot>

0 commit comments

Comments
 (0)