I did this as a project for my computer vision class. You can download:

the paper the program and source (for cygwin and maybe linux (untested)) the program and source (for mac 32/64bit intel (also includes the required libpicio source, VL Vector Library source))

Once you run the program hit h to view on screen help for the controls.