IR_Servo works really fine now.

I added IR_Servo and Servo test codes into github, and divided them
into different files.