static __inline __asm uint32_t get_interrupt_state(void)
{
    mrs r0, primask
    bx lr
}

__inline void DelAsm(uint32_t CY)
{
__asm {
    LOOP:
    SUBS CY, CY, #1
    BNE LOOP
  }
}

0000f0  2005              MOVS     r0,#5
0000f2  bf00              NOP      
0000f4  bf00              NOP      
                  |L1.246|
0000f6  1e40              SUBS     r0,r0,#1
0000f8  d000              BEQ      |L1.252|
0000fa  e7fc              B        |L1.246|
                  |L1.252|
0000fc  bf00              NOP

0000ca  2005              MOVS     r0,#5
                  |L1.204|
0000cc  1e40              SUBS     r0,r0,#1
0000ce  d1fd              BNE      |L1.204|

do { GPIO##port->CRL&=~(GPIO_CRL_CNF##nbit); GPIO##port->CRL|=GPIO_CRL_MODE##nbit; } while (0);

do { GPIO##port->CRH&=~(GPIO_CRH_CNF##nbit); GPIO##port->CRH|=GPIO_CRH_MODE##nbit; } while (0)

#if nbit<8 OUTPIN_PP(port,nbit) do { GPIO##port->CRL&=~(GPIO_CRL_CNF##nbit); GPIO##port->CRL|=GPIO_CRL_MODE##nbit; } while (0);
#endif

#define _OUTPIN_PP(port,nbit)  if ((nbit)<8) {do { GPIO##port->CRL&=~(GPIO_CRL_CNF##nbit); GPIO##port->CRL|=GPIO_CRL_MODE##nbit; } while (0); }\
                                                             else do { GPIO##port->CRH&=~(GPIO_CRH_CNF##nbit); GPIO##port->CRH|=GPIO_CRH_MODE##nbit; } while (0)

#define PORTA   ((u32*)(APB2PERIPH_BASE + 0x0800))
#define PORTB   ((u32*)(APB2PERIPH_BASE + 0x0C00))
#define PORTC   ((u32*)(APB2PERIPH_BASE + 0x1000))
#define PORTD   ((u32*)(APB2PERIPH_BASE + 0x1400))
#define PORTE   ((u32*)(APB2PERIPH_BASE + 0x1800))
#define PORTF   ((u32*)(APB2PERIPH_BASE + 0x1C00))
#define PORTG   ((u32*)(APB2PERIPH_BASE + 0x2000))

#define pinOutPP_b(port,bit)  {*(port+((bit)/8))|=3UL<<(((bit)-(8*((bit)/8)))<<2); *(port+((bit)/8))&=~(3UL<<((((bit)-(8*((bit)/8)))<<2)+2));}

/*!****************************************************************************
@brief        Bit of Low/High byte Port configuration
@details    Конфигурация одиночного бита порта
@param        PORT - имя порта (A..G)
@param        BIT - номер бита (0..15)
@param        CM - конфигурация бита
@note        Используется перечисляемый тип CONF_MODE
@note        Для IN_PDPU нужный pull-down/pull-up задается в ODR
*/
#define GPIO_CONFB(PORT, BIT, CM)                    \
    *(uint32_t *)((uint32_t)(GPIO##PORT) + BIT / 8 * 4) =         \
    *(uint32_t *)((uint32_t)(GPIO##PORT) + BIT / 8 * 4)        \
        & (~(0xF << (BIT % 8) * 4)) | (CM << (BIT % 8) * 4)

static __inline __asm void delay_8cycles(uint32_t x)
{
loop_delay_8cycles:
    nop
    nop
    nop
    nop
    subs r0,r0,#1
    bne  loop_delay_8cycles
    bx lr
}

  DelAsm(6);

__forceinline void DelAsm(uint32_t CY)
{
__asm {
    LOOP:
    SUBS CY, CY, #1
    BNE LOOP
  }
}

0000f2  2006              MOVS     r0,#6
0000f4  bf00              NOP      
0000f6  bf00              NOP      
                  |L1.248|
0000f8  1e40              SUBS     r0,r0,#1
0000fa  d000              BEQ      |L1.254|
0000fc  e7fc              B        |L1.248|
                  |L1.254|
0000fe  bf00              NOP

0000cc  2006              MOVS     r0,#6
                  |L1.206|
0000ce  1e40              SUBS     r0,r0,#1
0000d0  d1fd              BNE      |L1.206|

#ifndef __OPTIMIZE__
# warning "Compiler optimizations disabled; functions from <util/delay.h> won't work as designed"
#endif

#pragma pack(push, 1)     // set 1 and save prev
...
#pragma pack(pop)          // restore prev

/*!****************************************************************************
@brief        Delay program loop
@param        NS - время задержки в ns
@note        Параметр округляется до ближайшего не меньшего, кратного тактам
@note        4 такта в цикле при любой оптимизации (принудительно -O3)
@note        Формула: D = 4 * CY4 - 1 + Nnop
*/
#define SYSCLK_MHZ 72
#define NS2CY(NS) ((NS * SYSCLK_MHZ + 999) / 1000)
#define DELAY_NS(NS) DELAY_CY(NS2CY(NS))

#define DELAY_CY(CY)                            \
  if      (CY == 1) { __NOP(); }                    \
  else if (CY == 2) { __NOP(); __NOP(); }                \
  else if (CY == 3) { __NOP(); __NOP(); __NOP(); }            \
  else {                                \
    if ((CY + 1) % 4 == 1) { __NOP(); }                    \
    if ((CY + 1) % 4 == 2) { __NOP(); __NOP(); }            \
    if ((CY + 1) % 4 == 3) { __NOP(); __NOP(); __NOP(); }        \
    DelayCY4((CY + 1) / 4); }                        \

/*!****************************************************************************
@brief        Delay 4 clocks in cycle
@param        CY4 - количество 4-тактовых циклов
@note        Delay = 4 * CY4 - 1
*/
#pragma push
#pragma O3
__forceinline void DelayCY4(uint32_t CY4)
{
__asm {
LOOP:
    SUBS CY4, CY4, #1
    BNE LOOP
  }
}
#pragma pop

void TSysTimer::Delay_us(uint16_t d)
{
  uint32_t DelayStart = SysTick->VAL;
  uint32_t DelayTicks = d * CLK_PER_US;
  int32_t  Delta;
  do
  {
    Delta = DelayStart - SysTick->VAL;
    if(Delta < 0) Delta += CLK_PER_MS;
  }
  while(Delta < DelayTicks);
}