2KHz an ICP messen

Hallo zusammen,

ich versuche über den ICP-Pin Frequenzen von ca. 1-10 kHz zu messen.
Die Messung an sich klappt ganz gut dafür ist die Genauigkeit
verherrend (Der Wert ändert sich andauernd). Ich möchte in einigen µsec
messen können. Ich verwende 16Mhz extern.  Weiss jemand einen Rat oder
hat jemand von Euch ein Stück Code.

Vielen Dank im Voraus.
Oliver

Hier ist meine ICP routine:

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;
    }
}