Added tools for feature tracking test

And fixed some minor bugs. The provided detected features are dummy data
are only, and do not correspond to the sample images.