matlab/c++ factor graph framework - View it on GitHub