Sistema de Controle e Medição de Fator de Potência

Preciso de um programador que conheça a linguagem C, trata-se de um trabalho de TCC, a parte de hardware está ok, o que preciso é da revisão da programação, pois as leituras e os acionamentos realizados pelo sistema não estão funcionando corretamente.

Meu trabalho é um medidor e controlador de fator de potência, ou seja, ele mede a defasagem entre tensão e corrente e converte pra ângulo e mostra o cosseno ( fator de potência) deste ângulo. Estando o fator de potência abaixo de 0,92 ele aciona banco de capacitores e os desliga após chegar ao valor desejado. . Além da medição do fator de potência estou medindo o valor de tensão e corrente  e com isso acho o valor de potência ativa, aparente e reativa.



O funcionamento é o seguinte:

Estou fazendo a medição do fator de potência através dos circuitos zeros cross, um é para o sinal de corrente e outro para o de tensão. Todas as vezes em que esses sinais passam pelo zero da rede é gerado um pulso que é enviado ao microcontrolador.
Esses pulsos são recebidos pelos pinos CCP1 e Ccp2 do pic, configurei esses pinos em modo capture, para que todas as vezes em que ocorrer a transição de borda de subida nesses pinos, ele capturar o tempo em que o timer1 está, e armazena esse tempo nas variáveis tempo1 e tempo2. Após isso sabendo qual tempo é maior consigo saber se o circuito é indutivo ou capacitivo, pois só devo acionar o banco de capacitores se o circuito for indutivo.

Simulei no proteus e funcionou parcialmente, pois as vezes ele fica mostrando o mesmo valor porém  variando a indicação de circuito capacitivo e indutivo.