Sobel 3by3 added. Threshold value of 800 still a bit noisy for 5by 5. Will use threshold of 1000 for 5by5. Will use switch[4] to switch between sobel 3by3 and 5by5. Whe switch[4]=1, we're outputting 5by5, switch[4]=0, we're outputting 3by3