reduced Control_ISR to 500Hz to fix interrupt conflict with Ch6_Isr and Ch1_Isr