Rough Draft harris corner func