I did edited and commented it. Check the commentation and you know what each variable is.
I did print everywhere what goes, but it doesnt help.
I need new agortihm to replace this one.This was the only thing that came up to my mind.
but its wrong.