Eso es, he "partido es dos" el 1959 de manera que son don char y se reduce practicamente a la mitad en tiempo, esta el problema de que como trabajo con numeros enteros pierdo precision, pero por lo que he probado tampoco es demasiada, puede ser una alternativa.
La otra alternativa es cambiar el reloj, este pic acepta hasta 48 Mhz y yo utilizo uno de 25, seria casi el doble de rapido, se reduciria de 41 a 21,6 microsegundos, ahora que tengo que cambiar todos los calculos del resto del programa...
Por ahora voy a probar cambiando el reloj a ver si es sufuciente, gracias por la ayuda, un saludo.