|
From: <hsu...@us...> - 2009-06-03 22:04:37
|
Revision: 16676
http://personalrobots.svn.sourceforge.net/personalrobots/?rev=16676&view=rev
Author: hsujohnhsu
Date: 2009-06-03 22:04:35 +0000 (Wed, 03 Jun 2009)
Log Message:
-----------
update robot integrated tests.
Modified Paths:
--------------
pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/CMakeLists.txt
pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_image.xml
pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_scan.xml
pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.py
pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.xml
pkg/trunk/robot_descriptions/gazebo_robot_description/gazebo_worlds/test/test_scan.world
Modified: pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/CMakeLists.txt
===================================================================
--- pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/CMakeLists.txt 2009-06-03 22:00:37 UTC (rev 16675)
+++ pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/CMakeLists.txt 2009-06-03 22:04:35 UTC (rev 16676)
@@ -2,14 +2,28 @@
include($ENV{ROS_ROOT}/core/rosbuild/rosbuild.cmake)
rospack(test_pr2_sensors_gazebo)
+
+# For now, the tests fail on 64-bit for some reason.
+# TODO: more thoroughly test and wrap up this 32-bit check
+include(CMakeDetermineSystem)
+if(CMAKE_SYSTEM_PROCESSOR MATCHES "i686" OR
+ CMAKE_SYSTEM_PROCESSOR MATCHES "i386" OR
+ CMAKE_SYSTEM_PROCESSOR MATCHES "unknown")
+ set(_is32bit TRUE)
+else(CMAKE_SYSTEM_PROCESSOR MATCHES "i686" OR
+ CMAKE_SYSTEM_PROCESSOR MATCHES "i386" OR
+ CMAKE_SYSTEM_PROCESSOR MATCHES "unknown")
+ set(_is32bit FALSE)
+endif(CMAKE_SYSTEM_PROCESSOR MATCHES "i686" OR
+ CMAKE_SYSTEM_PROCESSOR MATCHES "i386" OR
+ CMAKE_SYSTEM_PROCESSOR MATCHES "unknown")
+
+if(CMAKE_SYSTEM_NAME MATCHES "Linux" AND _is32bit)
rospack_add_rostest(test_scan.xml)
+rospack_add_rostest(test_camera.xml)
rospack_add_rostest(hztest_pr2_scan.xml)
+rospack_add_rostest(hztest_pr2_image.xml)
+endif(CMAKE_SYSTEM_NAME MATCHES "Linux" AND _is32bit)
-# below need xvfb-run to test on build machine
-# These tests are moved into the future, pending resolution of xvfb issues
-# (#957)
-#rospack_add_rostest_graphical(hztest_pr2_image.xml)
-#rospack_add_rostest_graphical(test_camera.xml)
-rospack_add_rostest_future(hztest_pr2_image.xml)
-rospack_add_rostest_future(test_camera.xml)
+
Modified: pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_image.xml
===================================================================
--- pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_image.xml 2009-06-03 22:00:37 UTC (rev 16675)
+++ pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_image.xml 2009-06-03 22:04:35 UTC (rev 16676)
@@ -9,13 +9,13 @@
<include file="$(find stereo_image_proc)/stereo.launch" />
<!-- Run hztest -->
- <!-- Test for publication of 'left axis camera image publish rate' topic -->
- <test test-name="hztest_test_axis_left_image" pkg="rostest" type="hztest" time-limit="60" name="axis_left_image_test">
+ <!-- Test for publication rate of 'stereo/cloud' topic -->
+ <test test-name="hztest_test_stereo_cloud" pkg="rostest" type="hztest" time-limit="60" name="stereo_cloud_test">
<!-- The topic to listen for -->
- <param name="topic" value="/axis_l/image" />
+ <param name="topic" value="/stereo/cloud" />
<!-- The expected publication rate [Hz]. Set to 0.0 to only check that
at least one message is received. -->
- <param name="hz" value="15.0" />
+ <param name="hz" value="20.0" />
<!-- Acceptable error in the publication rate [Hz]. Ignored if hz is set
to 0.0. -->
<param name="hzerror" value="1.0" />
@@ -29,15 +29,6 @@
<param name="check_intervals" value="false" />
</test>
- <!-- Test for publication of 'right axis camera image publish rate' topic -->
- <test test-name="hztest_test_axis_right_image" pkg="rostest" type="hztest" time-limit="60" name="axis_right_image_test">
- <param name="topic" value="/axis_r/image" />
- <param name="hz" value="15.0" />
- <param name="hzerror" value="1.0" />
- <param name="test_duration" value="2.0" />
- <param name="check_intervals" value="false" />
- </test>
-
<!-- Test for publication of 'left stereo camera image publish rate' topic -->
<test test-name="hztest_test_stereo_left_image" pkg="rostest" type="hztest" time-limit="60" name="stereo_left_image_test">
<param name="topic" value="/stereo/left/image" />
Modified: pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_scan.xml
===================================================================
--- pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_scan.xml 2009-06-03 22:00:37 UTC (rev 16675)
+++ pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/hztest_pr2_scan.xml 2009-06-03 22:04:35 UTC (rev 16676)
@@ -37,15 +37,4 @@
<param name="check_intervals" value="false" />
</test>
- <!-- Test for publication of 'axis_left_ptz_state' topic. -->
- <test test-name="hztest_test_axis_left_ptz_state" pkg="rostest" type="hztest" time-limit="50" name="axis_left_ptz_state_test">
- <!-- Note how we use a different parameter namespace and node name
- for this test (axis_left/ptz_state_test vs. scan_test). -->
- <param name="topic" value="/axis_l/ptz_state" />
- <param name="hz" value="15.0" />
- <param name="hzerror" value="1.0" />
- <param name="test_duration" value="2.0" />
- <param name="check_intervals" value="false" />
- </test>
-
</launch>
Modified: pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.py
===================================================================
--- pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.py 2009-06-03 22:00:37 UTC (rev 16675)
+++ pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.py 2009-06-03 22:04:35 UTC (rev 16676)
@@ -53,203 +53,100 @@
FAIL_COUNT_TOL = 10
TARGET_RANGES = [
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 2.05170464516, 2.04536008835, 2.03909778595, 2.03291654587, 2.02681565285,
-2.02079415321, 2.01485085487, 2.00898480415, 2.0031952858, 1.99748134613, 1.99184203148, 1.98627638817,
-1.98078382015, 1.97536325455, 1.9700139761, 1.96473526955, 1.95952606201, 1.95438587666, 1.94931387901,
-1.94430923462, 1.93937122822, 1.93449926376, 1.92969250679, 1.92495036125, 1.92027211189, 1.91565704346,
-1.91110467911, 1.90661418438, 1.90218496323, 1.91215276718, 1.93008923531, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 2.64686512947, 2.6173157692, 2.59563803673, 2.57963132858, 2.5657658577,
-2.55445694923, 2.54415798187, 2.53618431091, 2.52831435204, 2.5224199295, 2.51713490486, 2.51194572449,
-2.50885725021, 2.50583004951, 2.50296163559, 2.50192046165, 2.50093340874, 2.5, 2.50093340874,
-2.50192022324, 2.50296139717, 2.50582957268, 2.50885748863, 2.51194500923, 2.51713514328, 2.52241945267,
-2.52831435204, 2.53618454933, 2.54415798187, 2.55445718765, 2.5657658577, 2.57963109016, 2.59563827515,
-2.6173157692, 2.64686512947, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 2.74098372459, 2.72118186951, 2.72313261032, 2.72514390945, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 1.85238564014, 1.80339097977, 1.77707922459, 1.75727534294, 1.74103367329,
-1.72714829445, 1.71498286724, 1.70415234566, 1.69440209866, 1.68555378914, 1.67747652531, 1.67007064819,
-1.66325867176, 1.6569788456, 1.65118086338, 1.64582335949, 1.64087188244, 1.63629746437, 1.63207530975,
-1.62818443775, 1.62460672855, 1.62132656574, 1.61833024025, 1.61560595036, 1.61314368248, 1.61093437672,
-1.60897052288, 1.60724556446, 1.6057536602, 1.60449028015, 1.60345125198, 1.60263371468, 1.60203504562,
-1.60165333748, 1.60148763657, 1.60153746605, 1.60180282593, 1.60228455067, 1.60298418999, 1.60390377045,
-1.60504591465, 1.60641443729, 1.60801339149, 1.60984802246, 1.61192440987, 1.61424958706, 1.61683177948,
-1.61968040466, 1.62280631065, 1.62622225285, 1.62994265556, 1.6339840889, 1.63836622238, 1.64311158657,
-1.64824676514, 1.65380322933, 1.65981829166, 1.66633713245, 1.6734149456, 1.68112039566, 1.68954002857,
-1.69878637791, 1.709010005, 1.72041964531, 1.73332083225, 1.74819290638, 1.76587283611, 1.7881039381,
-1.82019233704, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907,
-10.0500001907, 10.0500001907, 10.0500001907, 10.0500001907, ]
+10.0, 9.99399757385, 9.9937582016, 10.0, 9.99924373627, 10.0, 9.9972114563,
+9.99843502045, 9.99649715424, 10.0, 9.99730396271, 9.99415111542, 9.99961185455, 10.0,
+10.0, 9.99529933929, 10.0, 9.99807262421, 9.99406337738, 9.99944400787, 10.0,
+9.99863243103, 10.0, 9.99963474274, 10.0, 10.0, 10.0, 10.0,
+9.99961471558, 10.0, 9.98990726471, 9.99514579773, 9.99402713776, 9.99685573578, 10.0,
+9.99297523499, 9.99838447571, 9.99619579315, 9.99819755554, 9.99129009247, 10.0, 10.0,
+10.0, 10.0, 10.0, 9.99783802032, 9.99913311005, 9.99995613098, 9.98977661133,
+10.0, 10.0, 9.99752616882, 10.0, 9.99956035614, 9.99086093903, 9.99842834473,
+9.99786186218, 10.0, 10.0, 10.0, 10.0, 9.99822807312, 9.99658298492,
+9.99853229523, 9.99167919159, 10.0, 9.99986076355, 9.99435043335, 10.0, 10.0,
+10.0, 9.99513053894, 9.98856830597, 10.0, 9.99642944336, 9.98850345612, 9.99767971039,
+9.99714851379, 9.99507045746, 10.0, 9.99815559387, 10.0, 9.99589824677, 10.0,
+10.0, 9.99189662933, 9.99931144714, 9.99942684174, 9.99921417236, 9.99763774872, 10.0,
+10.0, 10.0, 10.0, 9.998005867, 10.0, 9.99797916412, 10.0,
+9.9910364151, 9.99975681305, 9.99505996704, 10.0, 10.0, 10.0, 9.99684619904,
+9.99744796753, 10.0, 9.99491786957, 9.99804782867, 9.9970035553, 9.99922180176, 10.0,
+10.0, 10.0, 10.0, 9.99434661865, 9.99643421173, 9.99948787689, 9.99103736877,
+10.0, 10.0, 10.0, 10.0, 10.0, 9.9973859787, 10.0,
+10.0, 10.0, 9.99809455872, 9.99889373779, 9.99034881592, 9.99793052673, 10.0,
+9.9971818924, 9.99768733978, 10.0, 9.99692344666, 9.99988460541, 10.0, 9.99223423004,
+10.0, 10.0, 10.0, 9.99819850922, 10.0, 10.0, 10.0,
+10.0, 9.99682426453, 10.0, 10.0, 10.0, 10.0, 10.0,
+10.0, 10.0, 10.0, 9.99664402008, 10.0, 9.99862480164, 10.0,
+10.0, 10.0, 9.99706840515, 10.0, 10.0, 9.98929977417, 9.99841403961,
+10.0, 10.0, 10.0, 9.99358081818, 10.0, 9.99743366241, 9.99925231934,
+9.99480342865, 10.0, 10.0, 10.0, 10.0, 9.99949550629, 10.0,
+10.0, 9.99554920197, 10.0, 10.0, 9.99991321564, 10.0, 9.99794387817,
+10.0, 9.99642467499, 10.0, 10.0, 10.0, 9.98939418793, 9.9947309494,
+10.0, 9.9953584671, 10.0, 10.0, 10.0, 9.99892425537, 10.0,
+10.0, 10.0, 9.99651241302, 10.0, 9.99716758728, 10.0, 9.99913024902,
+9.99498558044, 2.05108785629, 2.04519438744, 2.03086853027, 2.02336859703, 2.02695035934, 2.01738643646,
+1.99918735027, 2.00864744186, 1.99042928219, 1.98470938206, 1.98090338707, 1.97631084919, 1.96668255329,
+1.95483136177, 1.94926846027, 1.94627141953, 1.93911385536, 1.93856620789, 1.93666291237, 1.92490839958,
+1.92113339901, 1.91130304337, 1.91240274906, 1.90771627426, 1.90004253387, 1.93301081657, 9.99470233917,
+10.0, 9.99024391174, 9.99987506866, 10.0, 10.0, 2.18067216873, 2.11301398277,
+2.08739566803, 2.05290126801, 2.03444051743, 2.02023077011, 1.99386107922, 1.97925257683, 1.96436369419,
+1.9570697546, 1.94566953182, 1.93343639374, 1.91916835308, 1.9097315073, 1.907320261, 1.89995443821,
+1.89109528065, 1.89161360264, 1.88245260715, 1.87980854511, 1.87433433533, 1.86727118492, 1.86018013954,
+1.85684943199, 1.85423696041, 1.84425783157, 1.84913480282, 1.84618794918, 1.84153211117, 1.83750474453,
+1.82634449005, 1.82742106915, 1.83639419079, 1.8382332325, 1.8308942318, 1.83025789261, 1.8338599205,
+1.83691883087, 1.83545875549, 1.82727754116, 1.82949829102, 1.83963871002, 1.83275127411, 1.83578753471,
+1.83859550953, 1.84460675716, 1.85028421879, 1.8518140316, 1.84998071194, 1.85201394558, 1.86617028713,
+1.85826230049, 1.86342644691, 1.86991691589, 1.87508845329, 1.87938523293, 1.88695478439, 1.89659917355,
+1.9102935791, 1.90650248528, 1.92319214344, 1.93869578838, 1.94202721119, 1.96269178391, 1.96761965752,
+1.98466300964, 1.98671412468, 2.02200675011, 2.03376460075, 2.04798221588, 2.08420419693, 2.11029624939,
+2.16892075539, 2.51382231712, 2.50081801414, 2.50967860222, 2.49142122269, 2.49915242195, 2.50723528862,
+2.50705099106, 2.5037727356, 2.50623059273, 2.51073670387, 2.52612090111, 2.5315425396, 2.53415799141,
+2.54296064377, 2.55387878418, 2.56562280655, 2.59482359886, 2.61063861847, 2.6498336792, 10.0,
+10.0, 10.0, 10.0, 10.0, 10.0, 10.0, 10.0,
+9.9956445694, 9.99517631531, 10.0, 2.75734806061, 2.71639323235, 2.72030115128, 2.72558283806,
+10.0, 9.99477481842, 9.99865245819, 10.0, 10.0, 10.0, 9.99842739105,
+9.99849796295, 10.0, 10.0, 10.0, 10.0, 9.99830627441, 10.0,
+10.0, 10.0, 10.0, 10.0, 9.99744606018, 10.0, 9.99559783936,
+1.80707252026, 1.77755796909, 1.74133491516, 1.72746968269, 1.71787917614, 1.7034715414, 1.69972836971,
+1.68761336803, 1.67333197594, 1.66359114647, 1.65025925636, 1.65254878998, 1.63525867462, 1.64059412479,
+1.63240599632, 1.62345135212, 1.61991167068, 1.62780690193, 1.62304496765, 1.61492908001, 1.61679852009,
+1.62112545967, 1.60656380653, 1.60316884518, 1.60714066029, 1.59530711174, 1.60085105896, 1.60502040386,
+1.61660766602, 1.60286164284, 1.60207593441, 1.60052359104, 1.60095691681, 1.60423982143, 1.60822331905,
+1.6106556654, 1.62005293369, 1.61586606503, 1.62607228756, 1.62305355072, 1.62072408199, 1.62711369991,
+1.63709652424, 1.63697564602, 1.64713156223, 1.65632939339, 1.65328645706, 1.66583585739, 1.66880512238,
+1.68445622921, 1.68863415718, 1.69351518154, 1.7129740715, 1.73280155659, 1.75123381615, 1.76783192158,
+1.79901301861, 1.86156880856, 9.99738788605, 9.992228508, 9.99994468689, 9.99779891968, 9.99337387085,
+9.99182319641, 10.0, 10.0, 10.0, 9.99703979492, 9.99970149994, 10.0,
+9.999335289, 10.0, 9.99604129791, 10.0, 10.0, 9.99740505219, 10.0,
+10.0, 10.0, 10.0, 9.99222183228, 9.99573707581, 10.0, 9.99619674683,
+9.9939365387, 9.99981498718, 9.9928817749, 10.0, 9.99474048615, 9.99834823608, 9.99298095703,
+10.0, 10.0, 9.99308204651, 10.0, 9.99935913086, 10.0, 10.0,
+10.0, 9.99820899963, 9.99529933929, 9.99827575684, 9.9948797226, 10.0, 9.99988937378,
+9.999584198, 9.99994659424, 9.9975605011, 10.0, 9.99345874786, 10.0, 10.0,
+10.0, 9.99958515167, 9.99833774567, 9.99597167969, 9.99865531921, 10.0, 9.99568748474,
+10.0, 9.9882106781, 9.99309635162, 10.0, 9.99610996246, 10.0, 10.0,
+10.0, 10.0, 10.0, 9.99768352509, 10.0, 10.0, 10.0,
+10.0, 10.0, 9.99998950958, 10.0, 10.0, 9.99999523163, 10.0,
+10.0, 10.0, 10.0, 9.99959945679, 10.0, 9.99616622925, 9.99081897736,
+10.0, 10.0, 10.0, 9.99273777008, 10.0, 10.0, 10.0,
+10.0, 10.0, 10.0, 10.0, 10.0, 10.0, 10.0,
+10.0, 9.99827766418, 10.0, 9.99130821228, 9.99394321442, 10.0, 9.99984169006,
+9.99740791321, 10.0, 9.99520015717, 10.0, 9.99419403076, 10.0, 9.9997215271,
+9.99447917938, 9.99009609222, 10.0, 10.0, 10.0, 10.0, 10.0,
+9.99915504456, 10.0, 9.99174404144, 10.0, 10.0, 9.99153614044, 10.0,
+10.0, 10.0, 9.99759864807, 9.99976348877, 9.99283599854, 9.99860095978, 10.0,
+10.0, 9.99280261993, 9.9950838089, 9.98802757263, 10.0, 9.99755477905, 9.99777030945,
+10.0, 9.9999704361, 10.0, 10.0, 10.0, 10.0, 10.0,
+10.0, 9.9981918335, 9.99122905731, 9.99353027344, 10.0, 9.99995136261, 10.0,
+10.0, 9.99731826782, 9.9998626709, 10.0, 9.9979057312, 10.0, 10.0,
+9.99132919312, 10.0, 9.99921417236, 9.9884853363, 9.99441051483, 9.99137401581, 10.0,
+10.0, 10.0, 9.99632358551, 9.99571609497, 10.0, 10.0, 10.0,
+10.0, 9.99969100952, 10.0, 10.0, 9.99812889099, 9.99746513367, 9.99060916901,
+9.99426174164, 9.99900722504, 9.99610614777, 9.99338150024, 9.99703502655, 9.99886131287, 9.99685287476,
+10.0, 9.99549865723, 10.0, 9.99433898926, 9.98309326172, 9.99733734131, 10.0,
+9.99887466431, 10.0, 10.0, 9.98931789398, 9.99801635742, 9.99863052368, 10.0,
+10.0, 9.9970664978, 9.99593925476, ]
-TARGET_RANGES_NO_CUP = [
-9.99476337433, 9.99915409088, 9.9980840683, 9.99544811249, 9.99247932434, 9.99987125397, 10.0,
-10.0, 10.0, 9.99570083618, 9.99697780609, 9.99871063232, 10.0, 9.9951505661,
-9.99574947357, 9.99571800232, 10.0, 9.99369239807, 9.98751068115, 10.0, 10.0,
-10.0, 10.0, 10.0, 10.0, 9.99402236938, 9.99502182007, 9.99989032745,
-9.99433040619, 10.0, 10.0, 10.0, 10.0, 9.99642848969, 9.99311733246,
-9.99080371857, 9.99869918823, 9.99518108368, 9.9992313385, 9.99637699127, 9.99965381622, 10.0,
-10.0, 10.0, 9.98989868164, 10.0, 10.0, 10.0, 9.99868202209,
-9.99988460541, 10.0, 10.0, 10.0, 10.0, 10.0, 10.0,
-10.0, 9.99419593811, 9.99769973755, 10.0, 9.99773597717, 9.99521923065, 9.9989528656,
-10.0, 10.0, 9.99299144745, 10.0, 10.0, 10.0, 10.0,
-9.99306488037, 9.99461555481, 10.0, 10.0, 10.0, 10.0, 9.9988899231,
-10.0, 9.99577617645, 10.0, 9.99996948242, 10.0, 9.99888038635, 10.0,
-9.99547863007, 10.0, 9.99754333496, 9.99646663666, 9.99636745453, 10.0, 9.99492073059,
-10.0, 9.99544906616, 9.99992465973, 10.0, 9.99313831329, 9.9924287796, 9.99806690216,
-10.0, 9.99959754944, 9.9965429306, 10.0, 9.99796295166, 9.99425697327, 10.0,
-10.0, 9.993309021, 9.99934768677, 9.99693965912, 9.99562644958, 9.99121761322, 10.0,
-10.0, 10.0, 9.99929714203, 9.98904514313, 10.0, 9.99738502502, 9.99516010284,
-10.0, 9.99420166016, 9.99589443207, 9.99719142914, 10.0, 9.99889755249, 9.99705886841,
-9.99546432495, 9.99746227264, 10.0, 10.0, 10.0, 9.99825286865, 9.99210739136,
-9.99803924561, 10.0, 9.99971008301, 9.99635696411, 10.0, 9.99846744537, 10.0,
-10.0, 9.99960613251, 10.0, 10.0, 10.0, 10.0, 10.0,
-9.9983921051, 9.99517917633, 10.0, 10.0, 10.0, 9.99143028259, 9.99753952026,
-9.99354362488, 9.99571418762, 9.99830722809, 10.0, 10.0, 10.0, 10.0,
-9.99717235565, 10.0, 10.0, 9.99768161774, 10.0, 10.0, 10.0,
-10.0, 10.0, 9.99769306183, 9.99876308441, 10.0, 9.99790000916, 10.0,
-10.0, 10.0, 9.99973678589, 10.0, 10.0, 9.9947719574, 9.99311733246,
-9.99606513977, 9.99509048462, 9.99731826782, 10.0, 9.99836826324, 10.0, 10.0,
-9.9998550415, 10.0, 10.0, 9.99485683441, 10.0, 10.0, 10.0,
-10.0, 10.0, 9.99743270874, 10.0, 10.0, 10.0, 10.0,
-10.0, 10.0, 10.0, 10.0, 9.99156475067, 9.99921417236, 10.0,
-10.0, 2.06086134911, 2.04304623604, 2.0339550972, 2.02424860001, 2.01822209358, 2.00541353226,
-2.00950431824, 2.01216411591, 1.99409127235, 1.98584282398, 1.9796885252, 1.97141456604, 1.97109520435,
-1.96310019493, 1.95760452747, 1.94794130325, 1.94456517696, 1.9429050684, 1.93092298508, 1.92481744289,
-1.91104245186, 1.92116236687, 1.90875279903, 1.91201162338, 1.91060841084, 1.9481087923, 10.0,
-9.99790000916, 10.0, 9.9997549057, 10.0, 2.20694303513, 2.13595581055, 2.09233593941,
-2.05992150307, 2.04684782028, 2.0105304718, 2.0034236908, 1.98622024059, 1.96934950352, 1.95327341557,
-1.94734430313, 1.93790948391, 1.91805744171, 1.92023038864, 1.91111695766, 1.90268266201, 1.89178168774,
-1.88587677479, 1.88105416298, 1.87175905704, 1.87152767181, 1.85961914062, 1.86312639713, 1.85783874989,
-1.85148191452, 1.85052847862, 1.85015428066, 1.83663785458, 1.8420343399, 1.83422958851, 1.83971726894,
-1.82643020153, 1.84026670456, 1.82681381702, 1.82727408409, 1.82976984978, 1.83560442924, 1.82895517349,
-1.82742130756, 1.83289515972, 1.83308851719, 1.83400034904, 1.83486151695, 1.83346903324, 1.843121171,
-1.83799111843, 1.84082233906, 1.83912694454, 1.85082960129, 1.85728240013, 1.85684919357, 1.86858487129,
-1.85801696777, 1.86892950535, 1.87535607815, 1.88767051697, 1.8894739151, 1.88158750534, 1.90748083591,
-1.91861128807, 1.91681289673, 1.92637014389, 1.9453959465, 1.94760048389, 1.96476387978, 1.97642087936,
-1.98773860931, 2.00082230568, 2.02187848091, 2.04454755783, 2.06747937202, 2.09650659561, 2.13415074348,
-2.2187731266, 9.99858570099, 9.99892234802, 10.0, 9.99847984314, 9.99835777283, 10.0,
-9.99802207947, 10.0, 10.0, 9.99804782867, 10.0, 9.99098968506, 10.0,
-9.98982906342, 9.99451065063, 10.0, 10.0, 10.0, 10.0, 9.99514484406,
-10.0, 9.99383735657, 10.0, 9.99984645844, 9.99502182007, 10.0, 10.0,
-9.99558448792, 9.99419307709, 10.0, 9.99855041504, 10.0, 9.99853992462, 10.0,
-9.99225997925, 9.99515724182, 9.9920425415, 10.0, 9.9990272522, 10.0, 10.0,
-10.0, 10.0, 10.0, 9.99676132202, 10.0, 10.0, 9.99200820923,
-10.0, 10.0, 10.0, 10.0, 9.99334526062, 9.9963054657, 1.81890285015,
-1.78722798824, 1.7564176321, 1.73074293137, 1.72104763985, 1.71541452408, 1.69194555283, 1.68025803566,
-1.68196249008, 1.67249023914, 1.65943968296, 1.66511642933, 1.6518150568, 1.64434278011, 1.63414955139,
-1.63466000557, 1.6311827898, 1.62357568741, 1.62163007259, 1.61668038368, 1.6198694706, 1.61859762669,
-1.61467289925, 1.61767232418, 1.60972583294, 1.59921658039, 1.60989630222, 1.60952198505, 1.60353279114,
-1.60106611252, 1.60755217075, 1.60279548168, 1.6037607193, 1.59758174419, 1.61504018307, 1.60315585136,
-1.61430108547, 1.61935985088, 1.6197283268, 1.6197873354, 1.63474357128, 1.62740767002, 1.63514101505,
-1.64930307865, 1.65339374542, 1.64165866375, 1.66210532188, 1.66579389572, 1.67740690708, 1.69021046162,
-1.6914730072, 1.71135175228, 1.71780586243, 1.73485779762, 1.74796378613, 1.77337503433, 1.79069185257,
-1.85190665722, 9.99466514587, 9.99758243561, 10.0, 10.0, 9.99541854858, 9.99849796295,
-10.0, 9.99859523773, 10.0, 10.0, 10.0, 10.0, 9.99609375,
-9.99290943146, 10.0, 10.0, 9.99337387085, 10.0, 9.99309444427, 10.0,
-10.0, 9.99879550934, 10.0, 9.99773311615, 9.99247074127, 9.99773311615, 10.0,
-10.0, 9.99690723419, 9.9930562973, 10.0, 9.9975605011, 9.99978923798, 9.99831199646,
-10.0, 10.0, 9.99663925171, 10.0, 9.9908323288, 10.0, 10.0,
-9.99440383911, 9.99343204498, 9.99680995941, 10.0, 9.9914522171, 10.0, 9.99971008301,
-9.99607467651, 10.0, 10.0, 10.0, 10.0, 9.99754428864, 9.99942398071,
-9.99652862549, 10.0, 9.99985599518, 10.0, 9.99620819092, 10.0, 10.0,
-10.0, 9.99734973907, 9.99345207214, 9.99027442932, 10.0, 10.0, 9.99174880981,
-10.0, 10.0, 10.0, 10.0, 10.0, 9.99772644043, 9.99623966217,
-9.99545478821, 9.99369525909, 9.99638557434, 10.0, 10.0, 10.0, 9.99510478973,
-10.0, 9.99890422821, 10.0, 9.99664783478, 9.99530029297, 9.99272155762, 9.99526691437,
-9.99059009552, 9.99496936798, 9.99064540863, 10.0, 10.0, 10.0, 10.0,
-10.0, 10.0, 9.99388217926, 9.99864006042, 9.99601364136, 10.0, 10.0,
-10.0, 9.99941635132, 9.99548149109, 9.99714565277, 10.0, 10.0, 10.0,
-9.99674892426, 10.0, 10.0, 10.0, 10.0, 10.0, 9.99993991852,
-9.99406242371, 9.99754905701, 10.0, 9.99809741974, 10.0, 10.0, 10.0,
-9.99078083038, 10.0, 10.0, 9.9890537262, 10.0, 10.0, 9.99831676483,
-9.99514293671, 9.99895572662, 10.0, 9.99979972839, 10.0, 10.0, 9.99960517883,
-10.0, 9.9977645874, 9.99483966827, 9.99435138702, 9.99808311462, 10.0, 10.0,
-10.0, 9.99860095978, 9.99510669708, 9.99941539764, 9.99424552917, 10.0, 10.0,
-10.0, 10.0, 10.0, 9.99568939209, 10.0, 9.99476718903, 10.0,
-9.99623680115, 10.0, 10.0, 9.99558544159, 10.0, 10.0, 10.0,
-9.99999809265, 9.99686145782, 9.99739742279, 10.0, 9.99958515167, 10.0, 10.0,
-10.0, 10.0, 9.9971036911, 10.0, 10.0, 9.99803543091, 9.99508190155,
-9.99119567871, 9.9919462204, 9.99840164185, 10.0, 9.99807834625, 9.99764728546, 9.99995422363,
-9.99419116974, 10.0, 10.0, 9.99629592896, 9.99354934692, 9.99356937408, 10.0,
-10.0, 9.99736213684, 10.0, 10.0, 9.99850463867, 10.0, 10.0,
-10.0, 9.99309253693, 10.0, 9.99250221252, 10.0, 10.0, 9.99476718903,
-9.99114704132, 10.0, 10.0, ]
-
-
-
-
class PointCloudTest(unittest.TestCase):
def __init__(self, *args):
super(PointCloudTest, self).__init__(*args)
@@ -272,8 +169,8 @@
fail_count = 0
print "Input laser scan received"
self.printPointCloud(cloud) #uncomment to capture new data
- while (i < len(cloud.ranges) and i < len(TARGET_RANGES_NO_CUP)):
- d = cloud.ranges[i] - TARGET_RANGES_NO_CUP[i]
+ while (i < len(cloud.ranges) and i < len(TARGET_RANGES)):
+ d = cloud.ranges[i] - TARGET_RANGES[i]
if ((d < - ERROR_TOL) or (d > ERROR_TOL)):
fail_count += 1
print "fail_count:" + str(fail_count) + " failed. error:" + str(d) + " exceeded tolerance:" + str(ERROR_TOL)
Modified: pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.xml
===================================================================
--- pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.xml 2009-06-03 22:00:37 UTC (rev 16675)
+++ pkg/trunk/drivers/simulator/test_pr2_sensors_gazebo/test_scan.xml 2009-06-03 22:04:35 UTC (rev 16676)
@@ -1,7 +1,7 @@
<launch>
<master auto="start" />
- <node pkg="gazebo" type="gazebo" args="-r $(find gazebo_robot_description)/gazebo_worlds/test/test_scan.world" respawn="false" output="screen">
+ <node pkg="gazebo" type="gazebo" args="$(find gazebo_robot_description)/gazebo_worlds/test/test_scan.world" respawn="false" output="screen">
<env name="LD_LIBRARY_PATH" value="$(find gazebo_plugin)/lib:$(find gazebo)/gazebo/lib:$(find Cg)/Cg/lib:$(optenv LD_LIBRARY_PATH)" />
<env name="GAZEBO_RESOURCE_PATH" value="$(find gazebo_robot_description):$(find gazebo)/gazebo/share/gazebo" />
<env name="OGRE_RESOURCE_PATH" value="$(find ogre)/ogre/lib/OGRE" />
Modified: pkg/trunk/robot_descriptions/gazebo_robot_description/gazebo_worlds/test/test_scan.world
===================================================================
--- pkg/trunk/robot_descriptions/gazebo_robot_description/gazebo_worlds/test/test_scan.world 2009-06-03 22:00:37 UTC (rev 16675)
+++ pkg/trunk/robot_descriptions/gazebo_robot_description/gazebo_worlds/test/test_scan.world 2009-06-03 22:04:35 UTC (rev 16676)
@@ -82,9 +82,10 @@
<model:physical name="sphere1_model">
<xyz> 2.5 -0.5 0.5064</xyz>
<rpy> 0.0 0.0 0.0 </rpy>
- <static>false</static>
+ <static>true</static>
<body:sphere name="sphere1_body">
<geom:sphere name="sphere1_geom">
+ <laserRetro>3000.0</laserRetro>
<mesh>default</mesh>
<size>0.5</size>
<mass> 0.5</mass>
@@ -103,9 +104,10 @@
<model:physical name="box1_model">
<xyz> 2.0 -1.0 0.24</xyz>
<rpy> 0.0 0.0 0.0</rpy>
- <static>false</static>
+ <static>true</static>
<body:box name="box1_body">
<geom:box name="box1_geom">
+ <laserRetro>500.0</laserRetro>
<mesh>default</mesh>
<size>0.05 0.30 0.5</size>
<mass> 0.5</mass>
@@ -124,9 +126,10 @@
<model:physical name="cylinder1_model">
<xyz> 2.0 0.8 1.0</xyz>
<rpy> 0.0 0.0 0.0</rpy>
- <static>false</static>
+ <static>true</static>
<body:cylinder name="cylinder1_body">
<geom:cylinder name="cylinder1_geom">
+ <laserRetro>1000.0</laserRetro>
<mesh>default</mesh>
<size>0.30 2.0</size>
<mass> 0.5</mass>
@@ -142,13 +145,13 @@
</model:physical>
<!-- The trimesh cup -->
- <!-- commented out because xvfb is not working reliably yet
<model:physical name="cup1_model">
<xyz> 3.0 0.0 0.009</xyz>
<rpy> 90.0 0.0 90.0</rpy>
- <static>false</static>
+ <static>true</static>
<body:trimesh name="cup1_body">
<geom:trimesh name="cup1_geom">
+ <laserRetro>2000.0</laserRetro>
<kp>1000000000.0</kp>
<kd>1.3</kd>
<scale> 0.3 0.3 0.3</scale>
@@ -174,7 +177,6 @@
</geom:trimesh>
</body:trimesh>
</model:physical>
- -->
<!-- White Directional light -->
<model:renderable name="directional_white">
@@ -184,6 +186,7 @@
<diffuseColor>0.4 0.4 0.4</diffuseColor>
<specularColor>0.0 0.0 0.0</specularColor>
<attenuation>1 0.0 1.0 0.4</attenuation>
+ <range>20</range>
</light>
</model:renderable>
This was sent by the SourceForge.net collaborative development platform, the world's largest Open Source development site.
|