Hi,
I am professional embedded developer and have around 2 years of experience in c coding.
Previously I have worked on a system called reverse parking with camera where I modified LCD controller evaluation firmware for our application like adjusting resolution, putting OSD etc.
I don't know how much it resembles your project.
Is it a c code? Please message me more details or code so that I can look into it and can tell you if I can provide you solution.
Thanks,
Shailesh