Skip to content

Commit 8756323

Browse files
committed
removed comments for old cost function
1 parent b9da3c0 commit 8756323

2 files changed

Lines changed: 2 additions & 5 deletions

File tree

mesh_layers/include/mesh_layers/inflation_layer.h

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -112,7 +112,7 @@ class InflationLayer : public mesh_map::AbstractLayer
112112
*
113113
* @return resulting cost value
114114
*/
115-
float fading(const float val);
115+
float fading(const float squared_distance);
116116

117117
/**
118118
* @brief inflate around lethal vertices by using an wave front propagation and assign riskiness values to vertices

mesh_layers/src/inflation_layer.cpp

Lines changed: 1 addition & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -238,10 +238,7 @@ float InflationLayer::fading(const float squared_distance)
238238
// <= Inflation radius
239239
if (distance > config_.inscribed_radius)
240240
{
241-
// Map values from [config_.inscribed_radius, config_.inflation_radius] to [0, pi]
242-
// float alpha = ((dist - config_.inscribed_radius) / (config_.inflation_radius - config_.inscribed_radius)) * M_PI;
243-
// return config_.inscribed_value * (cos(alpha) + 1) / 2.0;
244-
241+
// http://wiki.ros.org/costmap_2d - cost decay function
245242
const float factor = exp(-1.0f * config_.cost_scaling_factor * (distance - config_.inscribed_radius));
246243
const float cost = config_.inscribed_value * factor;
247244
return cost;

0 commit comments

Comments
 (0)