Optimized the maze on top of the video image. Although found out that opencv creates a memory leak. Still looking on fixing that.