M:/USB-BDI/USB-BDI/Firmware/MPC555-USB-BDI/lib/delay.c

Go to the documentation of this file.

/*
 * Copyright 2003 Free Software Foundation, Inc.
 * 
 * This file is part of GNU Radio
 * 
 * GNU Radio is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 3, or (at your option)
 * any later version.
 * 
 * GNU Radio is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 * 
 * You should have received a copy of the GNU General Public License
 * along with GNU Radio; see the file COPYING.  If not, write to
 * the Free Software Foundation, Inc., 51 Franklin Street,
 * Boston, MA 02110-1301, USA.
 *
 */

static void udelay1(void) __naked {
        __asm           ; lcall that got us here took 4 bus cycles
        ret                     ; 4 bus cycles
        __endasm;
}

void udelay(unsigned char usecs) {
        do {
                udelay1 ();
        } while(--usecs != 0);
}

static void mdelay1(void) __naked {
        __asm
        mov     dptr,#(-1200 & 0xffff)

002$:   
        inc     dptr            ; 3 bus cycles
        mov     a, dpl          ; 2 bus cycles
        orl     a, dph          ; 2 bus cycles
        jnz     002$            ; 3 bus cycles

        ret
        __endasm;
}

void mdelay(unsigned short msecs) {
        do {
                mdelay1 ();
        } while(--msecs != 0);
}