Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Fix/offset #25

Merged
merged 9 commits into from
Jul 10, 2024
Merged

Fix/offset #25

merged 9 commits into from
Jul 10, 2024

Conversation

FabianThomsen
Copy link
Contributor

Three changes:

  1. Most classes in ETSI have their reference position at the front of the vehicle. The RVIZ display did account for that, but assumed, that the transformation to the center is just (-length/2, 0, height/2). The mistake was that we are not applying this transform inside the vehicle's frame (child_scene_node), but we are setting this node. So we need to apply its rotation to the transformation.
  2. The ETSI messages come in a frame like UTM_32N and have thus huge numbers inside the position fields. As RVIZ internally renders stuff using OGRE, which (by default) only uses single precision floats, these tend to flicker a lot due to rounding errors. If the UTM frame is our fixed frame, there's nothing we can do about this (except from building OGRE from source with double precision by setting OGRE_DOUBLE_PRECISION in OgreConfig.h to 1, but this would then require to build RVIZ from source, which we might want to do in future, but not in this MR). But if the fixed frame is a map frame somewhere near the ETSI messages, we can first compute all the transformations in tf, which uses double precision, and then give the resulting (small) numbers to OGRE w/o loss of precision.
  3. Minor refactoring in DENM plugin, mainly to supress compile-warnings.

(Minor change: If sim time is used, but the time source (e.g. rosbag) sends first a CAM and then a clock message, the first CAM is now discarded by checking for current_time==0)

Screenshot showing the old plugin: (CAM in blue vs ground truth position in red)
grafik

and with this fix:
grafik

@gkueppers gkueppers requested review from jpbusch and gkueppers and removed request for jpbusch July 10, 2024 10:48
@gkueppers gkueppers merged commit 9b8e088 into ika-rwth-aachen:main Jul 10, 2024
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants