float dy = goal->y() - init->y();
float edist = pow(pow(dx, 2) + pow(dy, 2), 0.5);
float heur = BCAR_TURNING_RADIUS * MIN(
- abs(goal->h() - init->h()),
+ std::abs(goal->h() - init->h()),
2 * M_PI - abs(goal->h() - init->h())
);
return MAX(edist, heur);