No sé si tú PIC posee CPP, pero deberías utilizarlo si querés más exactitud
YA revisaste el código generado ?
Lo mas seguro tengas que compensar.
¿Habilitaste algún nivel de optimizan?
Ver el asm solo para comprobar que no estuviera metiendo basura pero como usas modo PRO eso no sucede.
Puedes usar el stop watch y ver cuando esta consumiendo dentro de las rutinas.