How to implement micros() function on stm8s003?

[carlogulliani]

I need to decode ASK/OOK signal, for this aim I need to know the period in microseconds between several edges. I decided to use TIM1 for this purpose, here is my code

    // Set fCPU = 16MHz
    CLK_CKDIVR = 0;
    CLK_PCKENR1 = 0xFF;
    CLK_PCKENR2 = 0;
 
uint16_t micros() {
    return (uint16_t) ((TIM1_CNTRH << 8) | TIM1_CNTRL);
}
 
void tim1_init(void) {
    // 1MHz = 1uS
    TIM1_PSCRH = 0x00;
    TIM1_PSCRL = 0x10;
 
    TIM1_IER = 0x00; // disable interrupts
    TIM1_CR1 = 0x01;
}

and to get signal I use

ISR_PORTD(handlerD) {
	state = PinRead(GD0_PORT, GD0_PIN);
  uint16_t m = micros();
  if (state == HIGH) {
    lolen = abs(m - prevtime);
  }
  else {
    hilen = abs(m - prevtime);
  }
  prevtime = abs(m);
  if (state == HIGH)
  {
    if (flag == 0) {
      // the end of packet
      if (CheckValue(Pe, hilen) && CheckValue(Pe2, lolen)) // valid 1
      {
        if (bcounter < 32)
          code1 = (code1 << 1) | 1;
        else if (bcounter < 64)
          code2 = (code2 << 1) | 1;
        bcounter++;
      }
      else if (CheckValue(Pe2, hilen) && CheckValue(Pe, lolen)) // valid 0
      {
        if (bcounter < 32)
          code1 = (code1 << 1) | 0;
        else if (bcounter < 64)
          code2 = (code2 << 1) | 0; bcounter++;
      }
      else
        bcounter = 0;
    }
    else {
      if (bcounter < 32)
          code1 = (code1 << 1) | 1;
        else if (bcounter < 64)
          code2 = (code2 << 1) | 1;
        bcounter++;
    }
  }
  //printf("bcounter: %d\r\n", bcounter);
  if (bcounter >= 65)
  {
    printf("Got: %x %x\r\n", code1, code2);
    Pe2 = lolen;
    Pe = hilen;
    flag = 1;
    bcounter = 0;
    code1 = 0;
    code2 = 0;
  }
}

but get the values not I expected