Algorithms.h: Add hole-filling code