Completed function for one iteration

computeABC, computeGH, Harris corners, K matrix and L matrix computation
and estimating the flow out of these done!