Full path lenght calculation is wrong

[portaloffreedom]

In the c++ evaluator (simulator) somehow the total path length can results smaller than the distance between first and last position.
This is matematically impossible.

It could be an accumulating error problem, but we are not certain

Code found here:

revolve/cpprevolve/revolve/gazebo/brains/Evaluator.cpp

Lines 101 to 106 in abdb362

	for (size_t i=1; i < this->step_poses.size(); i++)
	{
	const auto &pose_i_1 = this->step_poses[i-1];
	const auto &pose_i = this->step_poses[i];
	this->path_length += Evaluator::measure_distance(pose_i_1, pose_i);
	}