What does the code do? How does that differ from what you want the code to do? Your posted code seems to be missing some library includes. Does the code compile? If not, what errors occur?
If you want our help you need to follow the guidelines in the "how to use the forum-please read" stickies.