Greatly improve the algorithm.

Signed-off-by: Edward Z. Yang <ezyang@mit.edu>