hannibalh:
It seems like If I use processing to transmit data to Arduino, and then the port will be busy. I used a led to show the state of thetaDiff(if thetaDiff is negative, the led will turn off, else it will turn on), it looks like good.
I don't understand that, or more accurately, I don't know what was in your mind that gave rise to that comment.
...R