Actualizacion del algoritmo con sus repsectivas pruebas

Signed-off-by: IvanSteven <IvanSteven@192.168.1.232>