From 8dc4d7ae3bde58a681f4a32922e680022a162cd8 Mon Sep 17 00:00:00 2001 From: Alopez <alopez@iri.upc.edu> Date: Fri, 8 Oct 2021 10:40:07 +0200 Subject: [PATCH] Addes sample_parking_loc. Sample_parking as old version plus global loc signal --- data/sample_parking/landmarks.txt | 5 +++-- data/sample_parking/sample_parking.xodr | 2 +- data/sample_parking_loc/landmarks.txt | 4 ++-- data/sample_parking_loc/sample_parking_loc.xodr | 4 ++-- .../sample_parking/sample_parking_signals.launch | 12 +++++++++++- .../sample_parking_loc_signals.launch | 16 ++++++++-------- maps/sample_parking_loc/sample_parking_loc.yaml | 2 +- 7 files changed, 28 insertions(+), 17 deletions(-) diff --git a/data/sample_parking/landmarks.txt b/data/sample_parking/landmarks.txt index 61446b2..fff1024 100644 --- a/data/sample_parking/landmarks.txt +++ b/data/sample_parking/landmarks.txt @@ -1,3 +1,4 @@ +201.000000 2.600000 -0.800000 -1.570796 3 1001.000000 0.000000 -0.600000 -1.570796 0 1031.000000 8.600000 1.500000 0.000000 0 1032.000000 7.400000 6.600000 -3.141593 0 @@ -5,8 +6,8 @@ 1081.000000 -1.600000 6.500000 -3.141587 0 1082.000000 -0.400000 1.500000 -0.000000 0 1101.000000 4.100000 4.200000 0.000000 0 -1102.000000 4.100000 7.000000 0.000000 0 -1103.000000 2.900000 1.000000 -3.141593 0 +1102.000000 4.100000 7.000000 0.000000 1 +1103.000000 2.900000 1.000000 -3.141593 1 1104.000000 4.100000 1.500000 0.000000 0 1105.000000 2.900000 6.500000 -3.141593 0 1106.000000 4.100000 5.800000 -3.141593 0 diff --git a/data/sample_parking/sample_parking.xodr b/data/sample_parking/sample_parking.xodr index d1d3771..e05b1fd 100644 --- a/data/sample_parking/sample_parking.xodr +++ b/data/sample_parking/sample_parking.xodr @@ -605,6 +605,7 @@ </objects> <signals> <signal s="1.0000000000000000e+00" t="-6.0000000000000000e+00" id="1111" name="parking_11_1" dynamic="no" orientation="+" zOffset="0.0000000000000000e+00" country="DEU" type="314" subtype="-1" value="0.0000000000000000e+00" /> + <signal s="1.0000000000000000e+00" t="-8.0000000000000000e+00" id="201" name="globlocsign1" dynamic="no" orientation="-" zOffset="0.0000000000000000e+00" country="DEU" type="1001" subtype="-1" value="0.0000000000000000e+00" /> </signals> </road> <road name="juntion_1_1_0_1" length="2.0000000000000000e+01" id="1001" junction="1"> @@ -1079,4 +1080,3 @@ </connection> </junction> </OpenDRIVE> - diff --git a/data/sample_parking_loc/landmarks.txt b/data/sample_parking_loc/landmarks.txt index a95dd47..f2413e7 100644 --- a/data/sample_parking_loc/landmarks.txt +++ b/data/sample_parking_loc/landmarks.txt @@ -46,8 +46,8 @@ 1081.000000 -1.600000 6.500000 -3.141587 0 1082.000000 -0.400000 1.500000 -0.000000 0 1101.000000 4.100000 4.200000 0.000000 0 -1102.000000 4.100000 7.000000 0.000000 0 -1103.000000 2.900000 1.000000 -3.141593 0 +1102.000000 4.100000 7.000000 0.000000 1 +1103.000000 2.900000 1.000000 -3.141593 1 1104.000000 4.100000 1.500000 0.000000 0 1105.000000 2.900000 6.500000 -3.141593 0 1106.000000 4.100000 5.800000 -3.141593 0 diff --git a/data/sample_parking_loc/sample_parking_loc.xodr b/data/sample_parking_loc/sample_parking_loc.xodr index 6166182..c39c3e6 100644 --- a/data/sample_parking_loc/sample_parking_loc.xodr +++ b/data/sample_parking_loc/sample_parking_loc.xodr @@ -581,8 +581,8 @@ </objects> <signals> <signal s="3.2000000000000000e+01" t="-6.0000000000000000e+00" id="1101" name="parking_10_1" dynamic="no" orientation="-" zOffset="0.0000000000000000e+00" country="DEU" type="314" subtype="-1" value="0.0000000000000000e+00" /> - <signal s="6.0000000000000000e+01" t="-6.0000000000000000e+00" id="1102" name="giveway_10_1" dynamic="no" orientation="-" zOffset="0.0000000000000000e+00" country="DEU" type="205" subtype="-1" value="0.0000000000000000e+00" /> - <signal s="0.0000000000000000e+00" t="6.0000000000000000e+00" id="1103" name="giveway_10_2" dynamic="no" orientation="+" zOffset="0.0000000000000000e+00" country="DEU" type="205" subtype="-1" value="0.0000000000000000e+00" /> + <signal s="6.0000000000000000e+01" t="-6.0000000000000000e+00" id="1102" name="giveway_10_1" dynamic="no" orientation="-" zOffset="0.0000000000000000e+00" country="DEU" type="1000001" subtype="-1" value="0.0000000000000000e+00" /> + <signal s="0.0000000000000000e+00" t="6.0000000000000000e+00" id="1103" name="giveway_10_2" dynamic="no" orientation="+" zOffset="0.0000000000000000e+00" country="DEU" type="1000001" subtype="-1" value="0.0000000000000000e+00" /> <signal s="5.0000000000000000e+00" t="-6.0000000000000000e+00" id="1104" name="max50_10_1" dynamic="no" orientation="-" zOffset="0.0000000000000000e+00" country="DEU" type="274" subtype="-1" value="5.0000000000000000e+01" /> <signal s="5.5000000000000000e+01" t="6.0000000000000000e+00" id="1105" name="max50_10_2" dynamic="no" orientation="+" zOffset="0.0000000000000000e+00" country="DEU" type="274" subtype="-1" value="5.0000000000000000e+01" /> <signal s="4.8000000000000000e+01" t="-6.0000000000000000e+00" id="1106" name="parking_10_2" dynamic="no" orientation="+" zOffset="0.0000000000000000e+00" country="DEU" type="314" subtype="-1" value="5.0000000000000000e+01" /> diff --git a/launch/sample_parking/sample_parking_signals.launch b/launch/sample_parking/sample_parking_signals.launch index 1ad5a5f..9e4bdce 100644 --- a/launch/sample_parking/sample_parking_signals.launch +++ b/launch/sample_parking/sample_parking_signals.launch @@ -132,5 +132,15 @@ <arg name="yaw" value="0"/> <arg name="parent" value="$(arg parent)"/> </include> -</launch> + <include file="$(find iri_sign_description)/launch/spawn_sign.launch"> + <arg name="name" value="global_loc_201"/> + <arg name="model" value="sign"/> + <arg name="type" value="global_loc"/> + <arg name="tag" value="alvar3_neg_1"/> + <arg name="x" value="2.6"/> + <arg name="y" value="-0.8"/> + <arg name="yaw" value="3.14159"/> + <arg name="parent" value="$(arg parent)"/> + </include> +</launch> diff --git a/launch/sample_parking_loc/sample_parking_loc_signals.launch b/launch/sample_parking_loc/sample_parking_loc_signals.launch index 8cdcad4..9d8f62b 100644 --- a/launch/sample_parking_loc/sample_parking_loc_signals.launch +++ b/launch/sample_parking_loc/sample_parking_loc_signals.launch @@ -328,20 +328,20 @@ <arg name="parent" value="$(arg parent)"/> </include> - <include file="$(find iri_sign_description)/launch/spawn_sign.launch"> - <arg name="name" value="giveway_1102"/> - <arg name="model" value="sign"/> - <arg name="type" value="giveway"/> + <include file="$(find iri_sign_description)/launch/spawn_semaphore.launch"> + <arg name="name" value="semaphore_1102"/> + <arg name="model" value="semaphore"/> + <arg name="initial_state" value="True"/> <arg name="x" value="4.1"/> <arg name="y" value="7"/> <arg name="yaw" value="4.71239"/> <arg name="parent" value="$(arg parent)"/> </include> - <include file="$(find iri_sign_description)/launch/spawn_sign.launch"> - <arg name="name" value="giveway_1103"/> - <arg name="model" value="sign"/> - <arg name="type" value="giveway"/> + <include file="$(find iri_sign_description)/launch/spawn_semaphore.launch"> + <arg name="name" value="semaphore_1103"/> + <arg name="model" value="semaphore"/> + <arg name="initial_state" value="True"/> <arg name="x" value="2.9"/> <arg name="y" value="1"/> <arg name="yaw" value="1.5708"/> diff --git a/maps/sample_parking_loc/sample_parking_loc.yaml b/maps/sample_parking_loc/sample_parking_loc.yaml index c7564dd..daf70ac 100644 --- a/maps/sample_parking_loc/sample_parking_loc.yaml +++ b/maps/sample_parking_loc/sample_parking_loc.yaml @@ -1,4 +1,4 @@ -image: sample_parking.pgm +image: sample_parking_loc.pgm resolution: 0.050000 origin: [-5.000000, -5.000000, 0.000000] negate: 0 -- GitLab