Code for my project:Matlab toolbox from http://vision.ucsd.edu/~pdollar/toolbox/doc/