As i said on the other post start studying similar project codes, cause first you will need to understand where you will have more problems with time keeping( ill leave you one, you will have to research for others if needed)
http://obscurereality.org/?p=45
He has a nice simple-ish code for you to start understanding.
Implement it to whatever way you want and fell more comfortable with.
But i can tell you will have a hell of a hard time if you expect anyone to do it all for you, lol.
Maybe start with a block diagram of the logic you will want it to perform