Đếm sản phẩm dùng phương pháp Poilling với button

/*
 * File:   counter_SP.c
 * Author: PhanHoangThinh
 *
 * Created on Ngày 29 tháng 6 nam 2017, 21:21
 */


#include <xc.h>
#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include "lcd.h"
#define _XTAL_FREQ 4000000
// CONFIG1
#pragma config FOSC = HS        // Oscillator Selection bits (HS oscillator: High-speed crystal/resonator on RA6/OSC2/CLKOUT and RA7/OSC1/CLKIN)
#pragma config WDTE = OFF       // Watchdog Timer Enable bit (WDT disabled and can be enabled by SWDTEN bit of the WDTCON register)
#pragma config PWRTE = OFF      // Power-up Timer Enable bit (PWRT disabled)
#pragma config MCLRE = ON       // RE3/MCLR pin function select bit (RE3/MCLR pin function is MCLR)
#pragma config CP = OFF         // Code Protection bit (Program memory code protection is disabled)
#pragma config CPD = OFF        // Data Code Protection bit (Data memory code protection is disabled)
#pragma config BOREN = OFF      // Brown Out Reset Selection bits (BOR disabled)
#pragma config IESO = OFF       // Internal External Switchover bit (Internal/External Switchover mode is disabled)
#pragma config FCMEN = OFF      // Fail-Safe Clock Monitor Enabled bit (Fail-Safe Clock Monitor is disabled)
#pragma config LVP = OFF        // Low Voltage Programming Enable bit (RB3 pin has digital I/O, HV on MCLR must be used for programming)

// CONFIG2
#pragma config BOR4V = BOR40V   // Brown-out Reset Selection bit (Brown-out Reset set to 4.0V)
#pragma config WRT = OFF        // Flash Program Memory Self Write Enable bits (Write protection off)

// #pragma config statements should precede project file includes.
// Use project enums instead of #define for ON and OFF.
unsigned int dem=0;
void main(void) {
 
    ANSEL=0;
    ANSELH=0;
    TRISBbits.TRISB0=TRISBbits.TRISB1=1;
    nRBPU=0;
    WPUB0=WPUB1=1;
    lcd_init();
    lcd_gotoxy(1,0);
    printf("PRODUCT COUNTER");
    lcd_gotoxy(7,1);
    printf("%02d",dem);
    while(1)
    {
        if(RB0==0)
        {
            __delay_ms(100);
            while(RB0==0);
                __delay_ms(100);
                dem++;
                lcd_gotoxy(7,1);
                printf("%02d",dem);
                if(dem==99)
                {
                    dem=0;
                    lcd_gotoxy(7,1);
                    printf("%02d",dem);
                }
            }
        if(RB1==0)
        {
            __delay_ms(100);
            while(RB1==0);
            dem=0;
            lcd_gotoxy(7,1);
            printf("%02d",dem);
        }

        }

    }