Harris detector working

Working Harris, but may need to reduce the amount of detected features