Added full program with opencv