S2io: code Optimization of isr function