i will code VHDL function of what you need
i have 2 year experience in embedded image processing and digital system design using VHDL.
I am good at fields such as:
-Embedded image processing algorithm (Sobel,image binarisation).
-Least square algorithm implementation in FPGA.
-Digital system design.
-State machine design.
Thanks , I am always her to help you.