Factor graph

We'd like to contribute back our changes/additions to the factor graph toolkit based on Joseph Gonzalez's now deprecated fg toolkit (along with a few other little changes that we found useful). 

Let me know if you have any questions or would like me to change anything. 

Scott Richardson
Vision Systems Inc.