STM8S103F3P6 и создание программной задержки

#include "iostm8s103f3.h"
 
void TIM1_init(void);
void delay_us(unsigned int d);
 
void TIM1_init(void)
{
  ////Величина автоперезагрузки////
  unsigned int auto_preload = 65535;
  TIM1_ARRH=((auto_preload&0xFF00)>>8);
  TIM1_ARRL=auto_preload&0x00FF;
  ////////////////////////////////
  ////////Установка делителя//////
  unsigned int div_load = 2000;
  TIM1_PSCRH=((div_load&0xFF00)>>8);
  TIM1_PSCRL=div_load&0x00FF;
  ////////////////////////////////
  TIM1_CR1|=(1<<7)|(1<<1)|(1<<0);
}
 
void delay_us(unsigned int d)
{
  TIM1_CNTRH=0;TIM1_CNTRL=0;
  TIM1_ARRH=((d&0xFF00)>>8);
  TIM1_ARRL=d&0x00FF;
  while(((unsigned int)((TIM1_CNTRH<<8)+TIM1_CNTRL))<d){};
}
 
 int main()
{
  /////////////////////////////////////
  //Отключаем Всю периферию            // 
  CLK_PCKENR1=0x00;
  CLK_PCKENR2=0x00;
  /////////////////////////////////////
  CLK_PCKENR1|=(1<<7);//Включаем тактирование для TIM1
  TIM1_init();
  //Настройка ногодрыга для проверки таймера//
  PB_DDR|=(1<<5);
  PB_CR1|=(1<<5);
  PB_CR2|=(1<<5);
  ////////////////////////////////////////////
   while(1)
  {
    PB_ODR&=~(1<<5);
    delay_us(1000);//1сек
    PB_ODR|=(1<<5);
    delay_us(1000);//1сек
  }
  return 0;
}