Some time ago I wrote a program that does this thing in 3D. Screenshots and source is here: http://adomas.org/shg/