Problem Fixed

Had incorrect values for points, the y position in the second group have
positive values instead of negative ones. Algorithm is ready!