Add feature detection test code

Shi-Tomasi corner detector from opencv. Optimize downsampling, feature
parameters.