yerzhik:
What is the problem?
What you are trying to do is trivially simple and could be done in a couple of lines of code using the Arduino libraries.
The approach you're using attacks the hardware directly, which is much harder to implement. Why don't you simply do it the easy way?