Dear Sir, I can help you with your project in short terms and with a good quality. But need to know, what processor and what design tools do you want to use. And one more, it will be useful to look through your code.
If you are interested, please, send details.