algorithm by Brian Swichkow