Added velocities norm measurement for hpso and return full scores for probabilities.