Added PID loops and ISR update flag