diff options
Diffstat (limited to 'src/pc80')
| -rw-r--r-- | src/pc80/Config.lb | 1 | ||||
| -rw-r--r-- | src/pc80/Makefile.inc | 1 | ||||
| -rw-r--r-- | src/pc80/i8254.c | 55 |
3 files changed, 55 insertions, 2 deletions
diff --git a/src/pc80/Config.lb b/src/pc80/Config.lb index e05b76954c..24af51c208 100644 --- a/src/pc80/Config.lb +++ b/src/pc80/Config.lb @@ -5,7 +5,6 @@ uses CONFIG_ARCH_X86 object mc146818rtc.o object isa-dma.o object i8259.o -#object udelay_timer2.o CONFIG_UDELAY_TIMER2 if CONFIG_UDELAY_IO object udelay_io.o diff --git a/src/pc80/Makefile.inc b/src/pc80/Makefile.inc index 0ef591497a..c7c0cd5d0a 100644 --- a/src/pc80/Makefile.inc +++ b/src/pc80/Makefile.inc @@ -1,7 +1,6 @@ obj-y += mc146818rtc.o obj-y += isa-dma.o obj-y += i8259.o -#obj-y += udelay_timer2.o CONFIG_UDELAY_TIMER2 obj-$(CONFIG_UDELAY_IO) += udelay_io.o obj-y += keyboard.o diff --git a/src/pc80/i8254.c b/src/pc80/i8254.c new file mode 100644 index 0000000000..e5dc40b56b --- /dev/null +++ b/src/pc80/i8254.c @@ -0,0 +1,55 @@ +/* + * This file is part of the coreboot project. + * + * Copyright (C) 2009 coresystems GmbH + * + * This program 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; version 2 of the License. + * + * This program 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 this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + */ + +#include <arch/io.h> +#include <pc80/i8254.h> +#include <console/console.h> + +/* Initialize i8254 timers */ + +void setup_i8254(void) +{ + /* Timer 0 (taken from biosemu) */ + outb(TIMER0_SEL|WORD_ACCESS|MODE3|BINARY_COUNT, TIMER_MODE_PORT); + outb(0x00, TIMER0_PORT); + outb(0x00, TIMER0_PORT); + + /* Timer 1 */ + outb(TIMER1_SEL|LOBYTE_ACCESS|MODE3|BINARY_COUNT, TIMER_MODE_PORT); + outb(0x12, TIMER1_PORT); +} + +#ifdef CONFIG_UDELAY_TIMER2 +static void load_timer2(unsigned int ticks) +{ + /* Set up the timer gate, turn off the speaker */ + outb((inb(PPC_PORTB) & ~PPCB_SPKR) | PPCB_T2GATE, PPC_PORTB); + outb(TIMER2_SEL|WORD_ACCESS|MODE0|BINARY_COUNT, TIMER_MODE_PORT); + outb(ticks & 0xFF, TIMER2_PORT); + outb(ticks >> 8, TIMER2_PORT); +} + + +void udelay(int usecs) +{ + load_timer2((usecs*TICKS_PER_MS)/1000); + while ((inb(PPC_PORTB) & PPCB_T2OUT) == 0) + ; +} +#endif |