autowarefoundation / autoware_ai

Apache License 2.0
27 stars 11 forks source link

Localization is not completed. #928

Closed andoh104 closed 7 years ago

andoh104 commented 7 years ago

Localization is not completed. This is a Rviz screen shot. screenshot from 2017-06-13 22 42 30

andoh104 commented 7 years ago
andoh104 commented 7 years ago

diff e05cf7b and 409e75a: https://github.com/CPFL/Autoware/compare/e05cf7b7d6c065fa3f4d7abe92ba0f3f9a4f753c...409e75adcc26e6966c1516d33929d95ba054aa91

andoh104 commented 7 years ago

I tested some revision between e05cf7b and 409e75a .

So, I think this commit causes localization problem. https://github.com/CPFL/Autoware/commit/14f7eca8a5b5aecf110ce6ebb3ab0467323b75fd

andoh104 commented 7 years ago

I tried to debug this issue, but I could only make a temporary patch. This patch will make the commit 14f7eca unavailable.

~/Autoware$ git diff
diff --git a/ros/src/sensing/filters/packages/points_downsampler/include/points_
index b42336e..2e61291 100644
--- a/ros/src/sensing/filters/packages/points_downsampler/include/points_downsam
+++ b/ros/src/sensing/filters/packages/points_downsampler/include/points_downsam
@@ -21,7 +21,11 @@ static pcl::PointCloud<pcl::PointXYZI> removePointsByRange(pc
     }
   }

+#if 0
   return narrowed_scan;
+#else
+  return scan;    //  This is a only tempolary patch for Localization problem.
+#endif
 }

 #endif // POINTS_DOWNSAMPLER_H
kitsukawa commented 7 years ago

The commit 14f7eca does not include the modification of matching algorithm. In our environment, we can do matching as before. By the way, do you open the app window every time after running ndt_matching? The problem may be solved by opening app window and clicking OK after running ndt_matching.

andoh104 commented 7 years ago

kitsukawa-san Thank you for your answer.

I understood that another commit of matching algorithm is necessary in addition to the commit 14f7eca. But I don't understand what is the app window. (Is it Rviz or Runtime Manager ?)

andoh104 commented 7 years ago

After checking "ring_filter" of Runtime Manager, Localization is completed. runtimemanagerring_filter2017-06-20 07 32 28

But localization is unstable.

andoh104 commented 7 years ago

I committed this temporary patch into my branch. https://github.com/andoh104/Autoware/blob/LocalizationPatch/ros/src/sensing/filters/packages/points_downsampler/include/points_downsampler.h

andoh104 commented 7 years ago

@kitsukawa -san

I debuged this method:removePointsByRange. https://github.com/andoh104/Autoware/blob/LocalizationPatch/ros/src/sensing/filters/packages/points_downsampler/include/points_downsampler.h Then I found that max_range is always set to 0.0 . So this is bug.

andoh104 commented 7 years ago

I have made a Pull Request to fix this issue.

kitsukawa commented 7 years ago

@andoh104 Thank you very much for the bug fixes.

andoh104 commented 7 years ago

Don't mention it. I will close this, if it is merged into master branch. Thanks,

andoh104 commented 7 years ago

It has been merged into master branch. I tested master branch is OK.