These are my ISRs where I set the CMP value by adding a "timeout value" (0x85 for 1us), and clear the interrupt flag, these are done inside "Handler":
ISR(IsrSTM0)
{
Handler((uint8) STM_CFG_STM0_INSTANCE, (uint8) STM_CFG_STMN_CH0);
Os_IncrementCounter_Counter_1();
}
ISR(IsrSTM1)
{
Handler((uint8) STM_CFG_STM1_INSTANCE, (uint8) STM_CFG_STMN_CH0);
Os_IncrementCounter_Counter_2();
}