[PIC]HI-TECH Cで7セグ4桁のLEDをダイナミック点灯させる

#include <stdio.h>
#include <htc.h>
 
#define TMR0_INTERVAL (255-250) // TMRモジュールのカウント初期値
#define PRESCALER 4
int data = 0;
 
void main( void )
{
    __CONFIG ( FOSC_HS & WDTE_OFF & PWRTE_ON & CP_OFF );
    TRISB = 0;
 
    TMR0   = TMR0_INTERVAL;     // カウントアップタイマー値を初期化
 
    OPTION_REGbits.T0CS  = 0;           // タイマモードとして実行
    OPTION_REGbits.PS    = PRESCALER;   // プリスケーラ値(4:32倍, 6:128倍)
    OPTION_REGbits.PSA   = 0;           // プリスケーラをTMRモジュールで使用する
 
    INTCONbits.T0IE   = 1;      // TMR0   interruptを有効にする
    INTCONbits.GIE    = 1;      // Grobal interruptを有効にする
 
    // 無限ループに入る
    while ( 1 ) {
        NOP();
    }
}
 
// 割り込み処理(10msec周期)
static void interrupt intr( void )
{
    static int i;
    static int intr_counter;
 
    //--------------------------------
    // 一定周期でインクリメントする
    //--------------------------------
    intr_counter++;
    if ( intr_counter >= 50 ) {
        data++;         // 300msec周期で加算する
        intr_counter = 0;
    }
 
 
    //--------------------------------
    // 各桁の値をダイナミック点灯する
    //--------------------------------
    i++;
    switch ( i % 4 ) { 
        case 0:
            PORTB = data % 10;
            PORTB |= 0b11100000;
            break;
        case 1:
            PORTB = ( data / 10 ) % 10;
            PORTB |= 0b11010000;
            break;
        case 2:
            PORTB = ( data / 100 ) % 10;
            PORTB |= 0b10110000;
            break;
        case 3:
            PORTB = ( data / 1000 ) % 10;
            PORTB |= 0b01110000;
            break;
        default:
            PORTB = 0x00;
            break;
    }
 
 
    if ( data > 9999 ) {
        data = 0;
    }
 
    // 割り込みの再設定
    TMR0 = TMR0_INTERVAL;
    T0IF = 0;
}

    i++;
    switch ( i % 4 ) { 
        case 0:
            PORTB = data % 10;
            PORTB |= 0b11100000;
            break;
        case 1:
            PORTB = ( data / 10 ) % 10;
            PORTB |= 0b11010000;
            break;
        case 2:
            PORTB = ( data / 100 ) % 10;
            PORTB |= 0b10110000;
            break;
        case 3:
            PORTB = ( data / 1000 ) % 10;
            PORTB |= 0b01110000;
            break;
        default:
            PORTB = 0x00;
            break;
    }