We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent b5eb4de commit 415a4a2Copy full SHA for 415a4a2
moveit_planners/stomp/include/stomp_moveit/cost_functions.hpp
@@ -168,7 +168,7 @@ CostFn getCostFunctionFromStateValidator(const StateValidatorFn& state_validator
168
const long kernel_start = mu - static_cast<long>(sigma) * 4;
169
const long kernel_end = mu + static_cast<long>(sigma) * 4;
170
const long bounded_kernel_start = std::max(0l, kernel_start);
171
- const long bounded_kernel_end = std::min(values.cols() - 1, kernel_end);
+ const long bounded_kernel_end = std::min(static_cast<long>(values.cols()) - 1, kernel_end);
172
for (auto j = bounded_kernel_start; j <= bounded_kernel_end; ++j)
173
{
174
costs(j) = std::exp(-std::pow(j - mu, 2) / (2 * std::pow(sigma, 2))) / (sigma * std::sqrt(2 * M_PI));
0 commit comments