'm computer engineering TA with 12+ years of experience, experienced with C programming - kernel development - building hardware drivers and firmwares for DSP interfacing circuits - FPGA - microcontrollers, give me more details abut your project to perfectly help you
I'll provide commented source code + documentations prove the results correctness.