Skip to content

Commit

Permalink
delete unused class
Browse files Browse the repository at this point in the history
Signed-off-by: Daniel Sanchez <[email protected]>
  • Loading branch information
danielsanchezaran committed Jan 12, 2024
1 parent 15bc19a commit 327d993
Showing 1 changed file with 0 additions and 31 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -367,37 +367,6 @@ class MapBasedPredictionNode : public rclcpp::Node
}
return true;
};
struct ObjectAccelerationMonitor
{
std::vector<TrackedObject> tracked_objects_;
double smoothing_factor_ = 0.5;

double getFilteredAcceleration(const TrackedObject & object)
{
const double current_acceleration = std::hypot(
object.kinematics.acceleration_with_covariance.accel.linear.x,
object.kinematics.acceleration_with_covariance.accel.linear.y);

const auto uuid = tier4_autoware_utils::toHexString(object.object_id);
const auto prev_object_info =
std::find_if(tracked_objects_.begin(), tracked_objects_.end(), [&](const auto & object) {
return tier4_autoware_utils::toHexString(object.object_id) == uuid;
});

if (prev_object_info == tracked_objects_.end()) {
tracked_objects_.push_back(object);
return current_acceleration;
}
const double prev_acceleration = std::hypot(
prev_object_info->kinematics.acceleration_with_covariance.accel.linear.x,
prev_object_info->kinematics.acceleration_with_covariance.accel.linear.y);
const double filtered_acceleration =
smoothing_factor_ * current_acceleration + (1.0 - smoothing_factor_) * prev_acceleration;
*prev_object_info = object;
return filtered_acceleration;
}
};
ObjectAccelerationMonitor object_acceleration_monitor_;
};
} // namespace map_based_prediction

Expand Down

0 comments on commit 327d993

Please sign in to comment.