Skip to content

Commit 5fec0d3

Browse files
tobifalkcassava
authored andcommitted
esmini: Remove modifications to osi data
Issues were fixed in ESMini meanwhile.
1 parent c78dcaf commit 5fec0d3

File tree

1 file changed

+0
-21
lines changed

1 file changed

+0
-21
lines changed

plugins/esmini/src/esmini_osi_sensor.hpp

-21
Original file line numberDiff line numberDiff line change
@@ -38,26 +38,6 @@
3838

3939
namespace cloe_esmini {
4040

41-
// TODO(tobias): This should eventually be fixed in ESMini.
42-
void fix_esmini_osi_ground_truth(osi3::GroundTruth& gt) {
43-
// Fix moving objects.
44-
for (int i = 0; i < gt.moving_object_size(); ++i) {
45-
osi3::MovingObject* obj = gt.mutable_moving_object(i);
46-
if (obj->has_vehicle_attributes()) {
47-
// Fix wrong sign of esmini bbcenter_to_rear output.
48-
auto vec = obj->mutable_vehicle_attributes()->mutable_bbcenter_to_rear();
49-
vec->set_x(-1.0 * vec->x());
50-
vec->set_y(-1.0 * vec->y());
51-
vec->set_z(-1.0 * vec->z());
52-
// Fix wrong object reference point z-coordinate: Should be bbcenter, not street level.
53-
if (obj->has_base()) {
54-
auto pos = obj->mutable_base()->mutable_position();
55-
pos->set_z(pos->z() - vec->z());
56-
}
57-
}
58-
}
59-
}
60-
6141
class ESMiniOsiReceiver : public cloe::utility::OsiTransceiver {
6242
public:
6343
~ESMiniOsiReceiver() override = default;
@@ -126,7 +106,6 @@ class ESMiniOsiReceiver : public cloe::utility::OsiTransceiver {
126106
if (!gt.has_timestamp()) {
127107
throw cloe::ModelError("ESMiniOsiSensor: No timestamp in GroundTruth.");
128108
}
129-
fix_esmini_osi_ground_truth(gt);
130109
msgs.push_back(std::make_shared<osi3::GroundTruth>(std::move(gt)));
131110
}
132111
}

0 commit comments

Comments
 (0)