Hi,
I am an electrical engineer specialising in electronics and embedded systems, and I have a great deal of experience in C programming.
I can write this program for you ASAP.
If you have any questions regarding my proposal please feel free to contact me.
Regards,
Jimi Minton