sábado, 15 de septiembre de 2018

PWM Velocidad y Giro de motor DC



Control de Giro y Velocidad PWM con PIC16F




Un gran saludo a los visitantes de este blog, el cual esta dedicado a la programación de microcontroladores PIC, Hoy quiero mostrarles como hacer uso del modulo ECCP que poseen gran parte de los modelos PIC16F.
Nuestro objetivo es controlar la velocidad y giro de un motor DC, utilizando la modulación PWM a través del modulo ECCP de un PIC16F887. El funcionamiento es bastante simple, un solo potenciómetro de 10k determinara el giro y la velocidad en proporción a la rotación que altera su resistencia, considerando como punto de referencia la mitad de su valor(5k). Para controlar el motor se usara el modulo L9110 considerando los requerimientos de voltaje y consumo con los que opera un pequeño motor DC 12V / 0.3A

La programación del microcontrolador se realizara utilizando el compilador XC8 y el entorno MPLABX, ambos disponibles en la pagina de microchip. 

Paso 1. Sobre el modulo L9110


Fig1. Modulo de control con L9110
 
Este pequeño modulo de bajo coste puede operar con voltajes en el rango de 2.5 a 12V, suministrando hasta 800mA de corriente de forma continua, posee dos canales A y B cada uno lleva un circuito integrado ASIC L9110 que incorpora los respectivos diodos de protección en sus salidas.


Paso 2. Conexión Motor-L9110 al PIC16F.

Solo haremos uso de un canal de este modulo, básicamente cada canal lleva un circuito integrado L9110, el cual controla al motor DC en función a las señales de entrada Forward(Adelante) y Backward(Atrás), las cuales se activa con nivel lógico alto.
Fig2.Conexión del L9110

Paso 3. Modulación por ancho de pulso PWM.

La modulación por ancho de pulso PWM(Pulse-Width Modulation) se utiliza bastante en los sistemas digitales, como una técnica de control de energía aplicada a una carga.
 
Una salida digital tipo PWM presenta un comportamiento analógico en la carga, debido a la continua conmutación entre los estados lógicos; En otras palabras si aplicamos este patrón de señal para alimentar una fuente de luz nos sera posible controlar su brillo, tal como se observa en la siguiente imagen.
 
 
Fig3. Suministro de energía con PWM(https://www.mikroe.com)
 
Básicamente una señal PWM trabaja a una frecuencia fija o predefinida, sobre la cual se determinan los siguientes periodos de tiempo:

Fig4. Pulsos periódicos
  • T: Es el periodo de la señal, que depende directamente de la frecuencia de operación.
  • tcy: Es el tiempo en la cual la señal se mantiene activa, su valor debe ser menor que T

Los microcontroladores PIC16 poseen módulos conocidos como CCP(Capture-Compare-PWM) y ECCP(Enhanced Capture-Compare-PWM) siendo este ultimo un modelo con funcionalidades mejoradas con respecto al CCP, en particular un PIC16F887 cuenta con ambos módulos pero no son totalmente independientes, porque ambos comparten como recurso a los módulos TMR1/TMR2. 
 
En esta ocasión nos centraremos en utilizar el modulo ECCP para generar una modulación PWM que controle la velocidad y giro del motor.  En el PIC16F887 los pines de salida asociados al modulo son el RC2/P1A, RD5/P1B, RD6/P1C, RD7/P1D, a través de estos pines se generaran patrones de modulación que pueden aplicarse a la entrada de circuito puente o medio puente para controlar el motor.

Fig5. Patrones de modulación PWM

Aunque es posible cambiar la polaridad de las señales que se muestran en la fig5., para el control de nuestro motor DC no sera necesario porque los modos Full-Bridge Forward y Full-Bridge Reverse se adecuan para controlar el sentido de giro utilizando los pines P1D y P1B, estos se conectaran a las entradas A-IA(Forward) A-IB(Backward) en cualquiera de los dos canales que posee el modulo L9110.

Paso 4. Programación y control de velocidad.

Como parte de la programación, nos enfocaremos en la creación de tres rutinas que harán uso de la modulación PWM. 
Las ecuaciones a utilizar para determinar la periodicidad y ciclo de trabajo, se extrajeron de la hoja de datos del microcontrolador, donde intervienen los siguientes recursos:
  • Fosc. Frecuencia de Oscilación del reloj para el microcontrolador.
  • T. Periodo de la señal PWM.
  • PR2. Registro de 8-bits(TMR2) para determinar el periodo
  • T2CKPS. Pre-escala asignado el registro TMR2.
  • t1. Ciclo activo (tcy) de la señal PWM(Tiempo en alto).
  • CCPRxL. 8-bits MSB del ciclo activo de la señal.
  • DCxBx. 2-bits LSB del ciclo activo de la señal. 
Para establecer la periodicidad o periodo T de la señal PWM, utilizamos la siguiente ecuación:
Ec1. Periodo de la señal
 
El valor de PR2 puede ser de 0 a 255, mientras que T2CKPS puede ser únicamente 1,4 o 16.
 
Para establecer el tiempo en que la señal PWM permanece activa o en nivel alto, utilizamos la siguiente formula:
Ec2. Periodo activo de la señal
 
Observe que la combinación de ocho bits del registro CCPRx y los dos bits del registro DCxBx, conforman una longitud total de 10-bits. (0-1023)
 
Utilizando las ecuaciones Ec1 y Ec2 , podemos determinar el ciclo de trabajo de la señal PWM, calculando la siguiente relación:
Ec3. Ciclo de trabajo
 
Si aplicamos a esta ecuación Ec3. los valores máximos, es decir el registro PR2=255 y los 10-bits conformados por los registros CCPRxL:DCxB=1023, el resultado sera dt = 1, lo cual nos indica un ciclo activo al 100%.
 
La Ec3. también muestra que el control de la modulación PWM tendrá una resolución de 10-bits (1024 pasos), solo cuando PR2=255, por lo tanto si PR2 se ajustara a un valor menor a 255, la resolución se ajustara a la siguiente ecuación:
Ec4. Resolución PWM si PR2 < 255

El primer procedimiento del programa se llama CCPSetupPWM1, y contendrá las instrucciones para configurar el modulo ECCP1, para una señal PWM con periodo de 500us(0.5ms) o frecuencia de 2kHz,  todo la configuración se efectuara considerando que la frecuencia del PIC16 es Fosc=4MHz.

void CCPSetupPWM1() //Fosc = 4MHz, Fpwm=2KHz -> T=0.5mS
{
    TRISDbits.TRISD5 = 1;   //Coloca en tri-state el pin P1B
    TRISDbits.TRISD7 = 1;   //Coloca en tri-state el pin P1D
    PIR1bits.TMR2IF = 0;    //Limpia la bandera del TMR2
    CCP1CONbits.CCP1M = 0b1100; //P1A-P1C y
P1B-P1D Activo en Alto
    CCP1CONbits.P1M = 3; //1=Adelante(01), 3=Atras(11)
    PR2 = 127;  //PWM(T) = (127+1) * 4 * (4)/(4^6) = 0.0005 seg
    T2CONbits.T2CKPS = 1; //Pre-escala 1:4
    T2CONbits.TMR2ON = 1; //Arranca el Timer   
    while(PIR1bits.TMR2IF == 0); //Espera un nuevo ciclo PWM
    TRISDbits.TRISD5 = 0;   //Habilita salida P1B
    TRISDbits.TRISD7 = 0;   //Habilita salida P1D
}

Con esta configuración PR2=127 el control sera posible con una resolución de 9-bits (Ec4.), es decir que hay hasta 512 pasos intermedios para ajustar el ciclo activo o ciclo de trabajo de la señal. Ahora codificaremos otro procedimiento que permita establecer la resolución durante la ejecución del programa.
 
void CCPSetduty(unsigned int n)
{
    CCPR1L = n >> 2;        //Carga los 8-bits MSB del ciclo
    CCP1CONbits.DC1B = n;   //Carga los 2-bits LSB del ciclo
    PIR1bits.TMR2IF = 0;  
}


Finalmente crearemos un par de procedimientos para determinar el sentido de giro del motor, utilizando los bits P1M del registro CCP1CON que controlan este comportamiento, si el bit P1M1=0 el sentido de giro es hacia adelante y si P1M1=1 el giro es en reversa, notara que en las rutinas hay instrucciones adicionales que son necesarios para cambiar los bits P1M, esto como parte de las recomendaciones que se mencionan en la hoja de datos.


void MotorAdelante()
{
    TRISDbits.TRISD5 = 1;   //Deshabilita pin CCPx P1B
    TRISDbits.TRISD7 = 1;   //Deshabilita pin CCPx P1D
    PIR1bits.TMR2IF = 0;    //Limpia la bandera
    CCP1CONbits.P1M = 1;    //1=Forward
    while(PIR1bits.TMR2IF == 0);//Espera un nuevo ciclo
    TRISDbits.TRISD5 = 0;   //Habilita pin CCPx P1B
    TRISDbits.TRISD7 = 0;   //Habilita pin CCPx P1D
}
void MotorReversa()
{
    TRISDbits.TRISD5 = 1;   //Deshabilita pin CCPx P1B
    TRISDbits.TRISD7 = 1;   //Deshabilita pin CCPx P1D
    PIR1bits.TMR2IF = 0;    //Limpia la bandera
    CCP1CONbits.P1M = 3;    //3=Back
    while(PIR1bits.TMR2IF == 0);//Espera un nuevo ciclo
    TRISDbits.TRISD5 = 0;   //Habilita pin CCPx P1B
    TRISDbits.TRISD7 = 0;   //Habilita pin CCPx P1D
}

Ahora si, podemos elaborar un pequeño programa como ejemplo practico para controlar el motor DC. Agregaremos un potenciómetro al canal 0 del modulo ADC(Pin AN0), y como el convertidor ADC del PIC tiene una resolución de 10-bits, de los 1024 valores posibles, 512 corresponderán a cada sentido de giro, entonces el control de velocidad corresponderá con una resolución de 9-bit.

#pragma config FOSC=INTRC_NOCLKOUT, WDTE = OFF, LVP = OFF
#include <xc.h>
#include <stdlib.h>
unsigned int adval;
void MotorAdelante();
void MotorReversa();
void CCPSetduty(unsigned n);
void CCPSetupPWM1();
void ADCStart(char ch);
unsigned int ADCRead();
 
void main(void) 
{
    OSCCONbits.IRCF = 6; //Ajusta oscilador interno a 4MHz
    ANSEL = 0;
    ANSELH = 0;
    ANSELbits.ANS0 = 1; //Configura el pin AN0 como entrada
    TRISD = 0;
    TRISC = 0;
    TRISEbits.TRISE2 = 0;
    ADCON0bits.ADCS = 0b11; //Ajusta el TAD a FRC
    ADCON0bits.ADON = 1; //Habilita el modulo ADC
    CCPSetupPWM1(); //Prepara el modo PWM
    while(1)
    {
        ADCStart(0);    //Inicia captura del canal 0
        __delay_us(20); //Espera requerida para completar la captura
        adval = ADCRead();//Lee el valor ADC(valor entre 0-1023)
        if(adval >= 512) //Control a la mitad del POT para adelante
        {
           adval = adval - 512;
           if(adval > 512) adval = 512; //El valor no debe superar los 9bits.
           MotorAdelante();
        }
        else    //Control a la mitad del POT para atras
        {
           adval = 512 - adval;
           if(adval > 512) adval = 512; //El valor no puede superar los 9bits
           MotorReversa();
        }
        CCPSetduty(adval); //Ajusta el ciclo de trabajo
        PORTEbits.RE2 = 0; //Apaga led
        __delay_ms(100);
        PORTEbits.RE2 = 1;
        __delay_ms(100);
    }
}
 
void ADCStart(char ch)
{
    ADCON0bits.CHS = ch;
    __delay_us(20);
    ADCON0bits.GO = 1;
}
unsigned int ADCRead()
{
    unsigned int value;
    while(ADCON0bits.GO);
    value = ADRESH;
    value = value << 8;
    value = value | ADRESL;
    value = value >> 6;
    return value;
}


Paso 5. Prueba y Simulación.





Paso 6. Conclusiones y Recomendaciones.

Es recomendable utilizar una frecuencia PWM superior a 4KHz, para minimizar o evitar la percepción del ruido.

Se debería considerar alguna rutina o mecanismo para reducir la velocidad del motor cuando se aplica un cambio al sentido de giro, sobre todo si el ciclo de trabajo es alto.

El presente ejemplo solo se implemento con fines educativos, sin considerar elementos de protección adicionales a cualquier circuito de control para motores.

Pablo Zarate Arancibia
Ingeniero Electrónico
pablinzte@gmail.com

lunes, 3 de septiembre de 2018

TMR Distancia con HC-SR04


 Medición HC-SR04 con el PIC16F

Hola como estas, soy Pablo y te doy la bienvenida a mi blog dedicado al mundo de la electrónica digital, y en especial a la programación de microcontroladores PIC, el contenido publicado en este sitio tiene un propósito educativo que pueda ser de ayuda en tu formación, por lo estaré atento a cualquier consulta o critica constructiva relacionada con esta publicación. Al final encontraras mis datos de contacto.
Hoy veremos como utilizar el modulo HC-SR04 que es bastante común verlos en proyectos de robótica con microcontroladores. El objetivo que buscaremos lograr sera el de medir la distancia que desde el origen donde se encuentra el sensor al objeto que esta de frente, para lo cual usaremos un microcontrolador PIC16F887
La programación del ejemplo se realizara utilizando el software  de diseño  MPLABX  y el compilador de lenguaje C para PIC XC8 ambos disponibles en la pagina de microchip de forma gratuita. Aquí dejo los enlaces de las versiones utilizadas para nuestro ejemplo:  <<MPLABX v6.20>>   <<XC8 v2.45>>
Mencionar también que es necesario contar con conocimientos mínimos sobre programación en lenguaje C y el uso de microcontroladores PIC16.

Introducción al Tema

El HC-SR04 es un sensor de distancia que utiliza ondas de ultrasonido para determinar la distancia de un objeto, lo destacable de este sensor es su bajo costo, tamaño y consumo de energía, y que gracias a su buena precisión lo convierten en uno de los sensores mas utilizados en diversos proyectos electrónicos, como vera en la figura 1, el modulo consta de dos transductores, un emisor, un receptor y la electrónica necesaria para su operación.

Fig1. Sensor ultrasónico HC-SR04
 

Revisando la hoja de dato de este modulo, describiremos los aspectos mas importantes para su implementación:

  • El voltaje de operación es 5V, aunque existen versiones que trabajan con menor voltaje, en cuanto al consumo es alrededor unos 15mA.
  • Su rango de medición va de 2 — 400 centímetros, aunque en algunas especificaciones indica que puede llegar a los 500 centímetros.
  • En rango de apertura para detectar los objetos es mas o menos 30 grados.
La figura 2, muestra de forma sencilla como funciona este modulo de detección, donde las señales de disparo (TRIG) y retorno (ECHO) se conectan de forma directa con los pines del microcontrolador.

Fig1. Funcionamiento del modulo HC-SR04

Para que el Microcontrolador de inicio al proceso de una medición con este sensor, primero generara un pulso de disparo en TRIG, el ancho de este pulso deberá ser al menos 10us, cuando el sensor recibe el pulso, automáticamente emitirá al espacio ocho tonos pulsantes de 40Khz que no son audibles, entonces los tonos en su recorrido por el espacio podrán reflejarse en cualquier obstáculo produciendo un eco que retornara al sensor. La señal que retorna al sensor servirá para determinar a que distancia se encuentra el objeto reflectante, esto se consigue calculando el tiempo de retardo desde la emisión del tono hasta la recepción del eco. El sensor provee a través de la salida ECHO, la duración del retardo, entonces el microcontrolador solo tiene que medir el ancho de pulso que tiene la salida del sensor y calcular la distancia considerando que los tonos emitido viajan por el espacio a la velocidad del sonido (343 m/s).
La referencia que se tiene con relación al ancho de pulso es de 1 centímetro por cada 29 microsegundos (343 m/s), pero considerando que los tonos cubren dos veces la distancia(trayecto de ida y trayecto de vuelta), podemos deducir que la distancia sera 1cm por cada 28us.

Esquema del Circuito

El modulo no requiere elementos adicionales, así que solo se necesita alimentarlo con 5V y conectar el pin ECHO del sensor al un pin de entrada en el PIC (pin RB4), luego pin TRIG del sensor a un pin de salida del PIC (pin RB3), siguiendo la distribución de pines que muestra la  figura 2.
 
Fig2. Pines del modulo HC-SR04

Adicionalmente se utilizara un diodo LED conectado al pin de salida RE2, mismo que servirá para indicar el funcionamiento normal del programa mediante un destello cada segundo. 
Fig3. Esquema del circuito Proteus

 
 
La figura 3, muestra el esquema simplificado del circuito que utilizaremos para realizar unas pruebas de medición, el esquema posibilita la simulación pero carece de las conexiones de alimentación y elementos adicionales para un montaje real. 
 
Programación de medición

Ahora describiré el programa que servirá para medir la distancia en centímetros, donde la frecuencia del oscilador es Fosc = 8Mhz, para ser mas práctico dentro del mismo código se comenta la función de cada linea explicando y al final explicare las secciones que conllevan a manejar el sensor.
El programa hace uso de un temporizador utilizando el modulo TMR1, con el cual se desea contar los microsegundos que pasan cuando se recibe el pulso de retorno. Si quieres conocer con mayor detalle como funcione este recurso del microcontrolador PIC, te recomiendo revises esta publicación.
 
#pragma config FOSC = INTRC_NOCLKOUT, WDTE = OFF, LVP = OFF
#include <xc.h>
#include <stdio.h>
#define _XTAL_FREQ 8000000
//Definición del oscilador
#define TRIGpin PORTBbits.RB3
//Salida del disparo
#define ECHOpin PORTBbits.RB4
//Entrada del eco
#define LEDpin PORTEbits.RE2
//Salida del led
uint16_t distcm = 0;
//Variable de distancia en cm
uint16_t SR04Getval(void);
//Función para leer sensor
void setup(void);
//Procedimiento de inicialización
void main(void)
{
    setup();
//Inicializa el PIC
    while(1)
    {
        distcm = SR04Getval();
//Lectura distancia
        printf("Distancia cm:%u\r\n", distcm);
//Envía mensaje
        __delay_ms(500);
//Espera medio segundo
        PORTEbits.RE2 = 0;
//Apaga el led
        __delay_ms(500);
//Espera medio segundo
        PORTEbits.RE2 = 1;
//Enciende el led
    }
}
void setup(void)
//Procedimiento de inicialización
{
    OSCCONbits.IRCF = 0b111;
//Fosc=8MHz Tcy=0.5uS
    while(OSCCONbits.HTS == 0){};
    ANSEL = 0;    
//AN0-AN7 en modo digital
    ANSELH = 0;    
//AN8-AN12 en modo digital
    TRISEbits.TRISE2 = 0;
//Pin RE2 como salida LED
    TRISBbits.TRISB3 = 0;
//Pin RB3 como salida TRIG
    TRISBbits.TRISB4 = 1;
//Pin RB3 como entrada ECHO
    OPTION_REGbits.nRBPU = 0;
//Activa pull-ups
    TRIGpin = 0;
//Pin TRIG en nivel 0
  
  /* CONFIGURA TIMER1 1uS Fosc=8MHz */
    T1CONbits.TMR1CS = 0;
//Modo temporizador
    T1CONbits.T1CKPS = 0b01;
//Ajuste pre-escala 1:2
   
/* CONFIGURA USART A 9600 BPS 8MHz*/
    TXSTAbits.BRGH = 1;
//Alta del Generador
    TXSTAbits.TXEN = 1;
//Activa el transmisor
    RCSTAbits.SPEN = 1;
//Habilita el modulo USART
    SPBRG = 51;
//Formula [8MHz/(16 * 9600)] - 1
}
uint16_t SR04Getval(void)
//Función para lectura del sensor
{
    uint16_t value;
//Valor temporal
    TRIGpin = 1;
//Nivel alto para inicio de pulso
    _delay(20);
//Espera de pulso 10us
    TRIGpin = 0;
//Nivel bajo para fin de pulso
    while(ECHOpin == 0);
//Espera inicio del ECO
    TMR1H = 0x00;
//Reinicia contador
    TMR1L = 0x00;
    PIR1bits.TMR1IF = 0;
//Limpia bandera
    T1CONbits.TMR1ON = 1;
//Inicia temporizador
    while(ECHOpin == 1)
//Espera fin del ECO
    {
        if(PIR1bits.TMR1IF)
//Si hay desbordamiento
        break;
//Sale del bucle
    }
    T1CONbits.TMR1ON = 0;
//Apaga temporizador
    value = TMR1L;
//Recupera valor del tiempo
    value |= (uint16_t) TMR1H << 8;
    return value/58;
//vs= 343m/s => 1cm/29uS
}

void putch(char byte)
//Procedimiento salida serial
{
    while(PIR1bits.TXIF == 0) {};
    TXREG = byte;
}

El programa principal luego de llevar a cabo la configuracion inicial llamando al procedimiento setup, ingresa en un bucle indefinido donde se ejecuta de manera secuencial, la lectura del sensor llamando a la función SR04Getval, esta función retorna un numero que representa la distancia medida en centímetros., luego se envía un mensaje formateado con el valor de distancia a través del puerto serial, finalmente se ejecuta un par de esperas de medio segundo para encender y apagar el LED,

Este ejemplo es una forma muy sencilla de leer el sensor, además los retardos provocados con el procedimiento __delay_ms generan un tiempo muerto o inactivo que deberia evitarse en cualquier sistema secuencial, de la misma manera si revisados la codificación de la función SR04Getval, observaremos que su ejecución puede conllevar a un proceso bloqueante, debido a las sentencias condicionales while de carácter indefinido, por ejemplo si retira la conexión en la linea ECO, el programa quedara colgado, y esto también representa una condición indeseable en cualquier sistema electrónico
.

Una mejor solución para llevar a cabo la lectura de este sensor, de manera segura y evitando las condiciones que pueden darse en el programa anterior, es utilizar interrupciones, donde se pueden aplicar eventos para la detección de flanco, cambios de estado o eventos propios del contador. En nuestro caso veremos un ejemplo utilizando la interrupción por cambio de estado.
 
Programa de medición con interrupción 
Con el propósito de evitar procesos bloqueantes dentro del programa, en este ejemplo se hace uso de las interrupciones del modulo temporizador TMR0 y el cambio de estado del PORTB. La codificación en si utiliza una técnica de programación por estados, si quieres conocer mas detalles al respecto, te recomiendo revises antes de continuar, la siguiente publicación. 
Además este programa podría adaptarse con facilidad para manejar mas de un sensor de distancia, dado que en este PIC, la interrupción por cambio de estado puede aplicarse a todos los pines del PORTB.

#pragma config FOSC = INTRC_NOCLKOUT, WDTE = OFF, LVP = OFF
#include <xc.h>
#include <stdio.h>
#define TRIGpin PORTBbits.RB3
//Salida del disparo
#define ECHOpin PORTBbits.RB4
//Entrada del eco
#define LEDpin PORTEbits.RE2 
//Salida del led
uint16_t distcm = 0;
//Variable de distancia en cm
volatile __bit tick1ms = 0, distOK, catchT1;
//Banderas
void taskLED(void);
//Tarea para destellar LED
void taskSR04(void);
//Tarea para leer sensor
void setup(void);
   //Procedimiento de inicialización
void __interrupt() isr(void)
//Rutina ISR
{
    uint8_t res;
    if(INTCONbits.T0IF)
//Evento de tiempo 0.0001s
    {
        INTCONbits.T0IF = 0;  //Limpia bandera
        TMR0 += 131;
//Reinicia contador T0
        tick1ms = 1;
//Activa bandera
    }
    if(INTCONbits.RBIF)
//Evento de cambio en pin RB4
    {
        res = PORTB;
//Registrar valor PORTB
        INTCONbits.RBIF = 0;
//Limpia condición
        T1CONbits.TMR1ON = 0;
//Para el temporizador T1
        catchT1 = 1;
//Activa Bandera
    }
}
void main(void)
{
    setup();
//Inicializa el PIC
    while(1)
    {
        if(tick1ms)
//Valida cada milisegundo
        {
            tick1ms = 0;
//Limpia bandera
            taskLED();  
//Tarea para destellar led
            taskSR04(); 
//Tarea para lectura de sensor
            if(distOK)  
//Si hay distancia calculada
            {
                distOK = 0;
//Limpia bandera
                printf("Distancia cm:%u\r\n", distcm);
//Enviar mensaje
            }
        }
    }
}
void setup(void)
{
    OSCCONbits.IRCF = 0b111;
//Fosc=8MHz Tcy=0.5uS
    while(OSCCONbits.HTS == 0){};
    ANSEL = 0;    
//AN0-AN7 en modo digital
    ANSELH = 0;  
//AN8-AN12 en modo digital
    TRISEbits.TRISE2 = 0;
//Pin RE2 como salida LED
    TRISBbits.TRISB3 = 0;
//Pin RB3 como salida TRIG
    TRISBbits.TRISB4 = 1;
//Pin RB3 como entrada ECHO
    OPTION_REGbits.nRBPU = 0;
//Activa pull-ups
    TRIGpin = 0;
//Pin TRIG en nivel 0
  
  /* CONFIGURA LA INT POR CAMBIO*/
    IOCBbits.IOCB4 = 1;
//Activa Interrupción por cambio en RB4
   
/* CONFIGURACION TIMER0 1MS Fosc=8Mhz*/
    OPTION_REGbits.T0CS = 0;
//Modo Termporizador
    OPTION_REGbits.PSA = 0;
//Con prescala
    OPTION_REGbits.PS = 0b011;
//Prescala 1:16
    TMR0 = 131;
//256-[(time*Fosc)/(pre*4)] time=0.001 seg
    INTCONbits.T0IF = 0;
//Limpia bandera
    INTCONbits.T0IE = 1;
//Activa interrupción del TMR0
   
/* CONFIGURA TIMER1 1uS Fosc=8MHz */
    T1CONbits.TMR1CS = 0;
//Modo temporizador
    T1CONbits.T1CKPS = 0b01;
//Ajuste pre-escala 1:2
   
/* CONFIGURA USART A 9600 BPS 8MHz*/
    TXSTAbits.BRGH = 1;
//Alta del Generador
    TXSTAbits.TXEN = 1;
//Activa el transmisor
    RCSTAbits.SPEN = 1;
//Habilita el modulo USART
    SPBRG = 51;
//Formula [8MHz/(16 * 9600)] - 1
    INTCONbits.GIE = 1;
//Habilita las Interrupciones
}
void taskSR04(void)
//Tarea para lectura de sensor, cada 1ms
{
    static uint8_t state = 0;
    static uint16_t cnt = 0;
    uint16_t value;
    cnt++; 
//Incrementa contador
    switch(state)
    {
        case 0:
//Estado para enviar disparo
            value = PORTB;
//Registra condición
            INTCONbits.RBIF = 0;
            INTCONbits.RBIE = 1;
//Activa interrupción RB   
            T1CONbits.TMR1ON = 0;
            TMR1L = 0;
//Reinicia temporizador T1
            TMR1H = 0;
            PIR1bits.TMR1IF = 0;
            T1CONbits.TMR1ON = 1;
//Arranca T1
            catchT1 = 0;
//Limpia bandera
            TRIGpin = 1;
//Inicio del disparo TRIG
            _delay(20);
//Tiempo del pulso 0.5u x 20 = 10u
            TRIGpin = 0;
//Fin del disparo TRIG
            cnt = 0;
//Reinicia contador
            state++;
//Siguiente estado
            break;
        case 1:
//Estado de espera inicio del pulso ECO
            if(catchT1)
//Flanco POS detectado
            {
                catchT1 = 0;
//Limpia bandera
                T1CONbits.TMR1ON = 0;
//Para contador
                TMR1L = 0;
//Reinicia contado
                TMR1H = 0;
                PIR1bits.TMR1IF = 0;
                T1CONbits.TMR1ON = 1;
//Arranca el contador
                state++;
//Siguiente estado
            }
            if(PIR1bits.TMR1IF) state = 3;
//Limite de tiempo > a 65ms
            break;
        case 2:
//Estado de espera final del pulso ECO
            if(catchT1)
//Flanco NEG detectado
            {
                catchT1 = 0;
//Limpia bandera
                INTCONbits.RBIE = 0;
//Desactiva interrupción RB
                value = TMR1L;
//Recupera valor del contador us
                value |= (uint16_t) (TMR1H << 8);
                distcm = value/58U;
//1cm/30uS solo ida
                distOK = 1;
//Activa bandera
                state++;
//Siguiente Estado
            }
            if(PIR1bits.TMR1IF) state = 3;
//Limite de tiempo > a 65ms
            break;
        case 3:
//Estado para espera de repetición
            if(cnt >= 999)
                state = 0;
//Reinicia maquina cada 0.5s
            break;
            
    }
}
void taskLED(void)
//Destella led ciclo 1ms
{
    static uint16_t tcnt = 0;
    if(tcnt++ > 999)
    {
        tcnt = 0;
        LEDpin = 1;
    }
    if(tcnt == 200) LEDpin = 0;
}
void putch(char byte)
{
    while(PIR1bits.TXIF == 0) {};
    TXREG = byte;
}
 
 
Pruebas de funcionamiento
Para realizar las pruebas de funcionamiento del circuito he utilizado una placa de pruebas que utiliza un PIC16F887, lo cual facilito la conexión del sensor y el convertidor UART/USB para recibir los mensajes en una terminal serial para PC, note lo simple que resulta montar el circuito que se muestra en la figura 4.
 
Fig4. Montaje del circuito con PIC16F887

Los mensajes recibidos por la terminal serial de la figura 5, muestra la información de distancia en centímetros por cada segundo.

Fig5. Datos de distancia recibidos del sensor

Aquí dejo los enlaces para que puedas descargar el proyecto, se encuentra en formato gzip, debes descomprimir y abrir con MPLABX  
Si quieres ver como compilar e implementar los proyectos de este blog, elaborados con MPLABX mira este vídeo.<Compilando proyectos MPLABX>

Conclusiones y recomendaciones
Con la implementación de este circuito junto al programa descrito, se demostró como realizar mediciones de distancia, utilizando el sensor SR04, si estás pensando utilizar este sensor en un proyecto electrónico, te recomiendo considerar los siguientes aspectos:
  • El código de este ejemplo asume una situación ideal donde los pulsos de disparo siempre serán reflejados, y así el ancho de pulso en el pin eco tendría una duración no mayor a 400 centímetros que es la distancia máxima del sensor; pero en una situación real estas condiciones podrían no ocurrir si el objeto esta muy distante o no existe un reflejo de los pulsos, entonces se sugiere tomar en cuenta estos detalles en la programación en caso de una implementación real.
  • También es una buena opción utilizar el promedio de varias lecturas con la finalidad de reducir el error por pequeñas variaciones que suceden entre lecturas,  estos por lo general se deben a interferencias que sufren los pulsos en el trayecto. 
 
Sin mas que mencionar agradezco tu visita al blog y espero que el ejemplo visto pueda ser útil en tu formación y el proyecto que desarrollas.

Atentamente, Pablo Zárate Arancibia  email: pablinza@me.com / pablinzte@gmail.com, @pablinzar

Santa Cruz de la Sierra - Bolivia