The general rule is to get in and out of an interupt as fast as possible. But in your case, the problem is a bit different. the pulse for the servo's should be every 20 msec. you have an interupt every 5 msec. so you are updating the servo 4 times as fast as you want to.