М3/М4 - как сделать трюк с прерываниями? Опции

[Allregia]

Подкажите решение:
1) есть проограмма, сейчас на М3 (lpc1768) но вообще будет на М4 (stm32f4), без ОС.
в ней выполняются фоновые задачи, в т.ч и пересылка DMA, и есть циклы типа while()
2) есть довольно высокочастотное прерывание (неважно от чего) INT1 с регулярной частотой (периодом - T1)
3) после каждых N должна выполниться подпрограмма SUB1, время выполнения SUB1 - T2
Естественно, T2< N*T1,
но - T2>T1.
Т.е. во время выплонения SUB1 обязательно произойдет прерывание INT1.
4) пропустить INT нельзя, как нельзя пропустить и SUB1.

Первой что пришло в голову - крутить в INT1 счетчик, когда он досчитал до N - выставлять флаг.
В SUB1 его проверять, но при в основной программе во всех циклах вставлять вызов SUB1

Код

#define N 10
u8 IntFlag=0;
//-----
void INT1(void){
static cnt=0;
    .........
   if(++cnt>N){
      cnt=0;
      IntFlag=1;
   }
}
//-----
void SUB1(void){
   if(IntFlag){
      IntFlag=0;
      ...........
   }
}
//
int main(void){
    .......
   while(xxxx){
      .....
      SUB1();
   }

    ........
}

Проблемы:
1) не пропустить бы какой-то while/for, это надо из все просматривать во всей программе, е везде вставлять вызов SUB1
2) на многочисленные вызовы SUB1 тратиться довольно много времени, так например скорость записи в SD-флешку (по DMA!) падает процентов на 20-30 (хотя и огстается в пределат требуемогодля моей задачи).

Может кто подскажет более элегантное решение ?
Может оформить SUB1 как прерывание более низкого уровня чем INT1 и вместо установки флага, как-то его иничиировать в конце N-ного INT1 ? но как это сделать ?

[Allregia]

Т.е как я понял. проще всего через EXTI:

Код

//высокочастотное прерывание:
void INT1(void){
static cnt=0;
    .........
   if(++cnt>N){
      cnt=0;
      EXTI_GenerateSWInterrupt(EXTI_Line15);// "взвоим курок" - после выхода из INT1 произойдет вызов прерывания EXTI15_10  
   }
}

// программное прерывание:
void EXTI15_10_IRQHandler(void){
  if(EXTI_GetITStatus(EXTI_Line15) != RESET)  {
    SUB1();
    EXTI_ClearITPendingBit(EXTI_Line15); // Clear the EXTI line 15 pending bit
  }
}

// Настройки:
void Init_EXTI_SWI(void){
  EXTI_InitTypeDef   EXTI_InitStructure;
  NVIC_InitTypeDef   NVIC_InitStructure;

  /* Enable SYSCFG clock */
//  RCC_APB2PeriphClockCmd(RCC_APB2Periph_SYSCFG, ENABLE);
  
  /* Configure EXTI Line15 */
  EXTI_InitStructure.EXTI_Line = EXTI_Line15;
  EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
  EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Falling;
  EXTI_InitStructure.EXTI_LineCmd = ENABLE;
  EXTI_Init(&EXTI_InitStructure);

  /* Enable and set EXTI15_10 Interrupt to the lowest priority */
  NVIC_InitStructure.NVIC_IRQChannel = EXTI15_10_IRQn;
  NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0x0F;
  NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0x0F;
  NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;

  NVIC_Init(&NVIC_InitStructure);

}
// в настройке ВЧ прерывания приоритет повыше:
//  NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0x01;
//  NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0x01;

А еще такой дурацкий вопрос - в SUB1 надо как-то специально разрешать прерывания более высокого уровня чтобы INT1 могло происходить во время выполнения SUB1 или это автоматически ?