How to use the codes?
1. Compile C++ mex files. Running compile_mexfiles.m in matlab command window.
2. Run …_demo.m to get the result.
