I'm an Embedded Systems engineer and I've written codes on MATLAB for a variety of projects .
I can write the code you want , but of course I'll have to get more details about it before I can set a fixed deadline.
If you're interested , please don't hesitate to contact me at any time.