2KHz an ICP messen

Hallo zusammen,

hat jemand von Euch Frequenzen von 1-10Khz über den ICP-Pin gemessen?
Die Messung klappt bei mir schon, allerdings ist die Ungenauigkeit
verheerend. Ich möchte auf einige µs genau Messen.
Hat jemand von Euch eine Idee oder ein Stück Code?

Vielem Dank im Voraus.

Oliver

Der code:

SIGNAL (SIG_INPUT_CAPTURE3)
{
    TCNT3 = 0x0000;
    if (icp3_sb == 0)                   // Messung starten:
    {
        timer3_hv = 0;                  // Hilfsvariable auf 0;
        icp3_sb = 1;                    // Status_bit auf 1
    }
    else if (icp3_sb == 1)              // Messung stopen
    {
        *icptimer3_wert_ptr = ICR3L;
        *icptimer3_wert_ptr |= (int)ICR3H << 8;
        *icpback3_ptr = 0x01;
    }
}