@@ -242,7 +242,8 @@ void categorizeVehicles(
242
242
return ;
243
243
}
244
244
245
- lanelet::ArcCoordinates getOcclusionPoint (const PredictedObject & obj, const ConstLineString2d & ll_string)
245
+ lanelet::ArcCoordinates getOcclusionPoint (
246
+ const PredictedObject & obj, const ConstLineString2d & ll_string)
246
247
{
247
248
const auto poly = tier4_autoware_utils::toPolygon2d (obj);
248
249
std::deque<lanelet::ArcCoordinates> arcs;
@@ -257,16 +258,18 @@ lanelet::ArcCoordinates getOcclusionPoint(const PredictedObject & obj, const Con
257
258
* Ego===============> path
258
259
**/
259
260
// sort by arc length
260
- std::sort (arcs.begin (), arcs.end (), [](lanelet::ArcCoordinates arc1, lanelet::ArcCoordinates arc2) {
261
- return arc1.length < arc2.length ;
262
- });
261
+ std::sort (
262
+ arcs.begin (), arcs.end (), [](lanelet::ArcCoordinates arc1, lanelet::ArcCoordinates arc2) {
263
+ return arc1.length < arc2.length ;
264
+ });
263
265
// remove closest 2 polygon point
264
266
arcs.pop_front ();
265
267
arcs.pop_front ();
266
268
// sort by arc distance
267
- std::sort (arcs.begin (), arcs.end (), [](lanelet::ArcCoordinates arc1, lanelet::ArcCoordinates arc2) {
268
- return std::abs (arc1.distance ) < std::abs (arc2.distance );
269
- });
269
+ std::sort (
270
+ arcs.begin (), arcs.end (), [](lanelet::ArcCoordinates arc1, lanelet::ArcCoordinates arc2) {
271
+ return std::abs (arc1.distance ) < std::abs (arc2.distance );
272
+ });
270
273
// return closest to path point which is choosen by farthest 2 points.
271
274
return arcs.at (0 );
272
275
}
0 commit comments