| /SPARTAN/trunk/arch/ia32/src/drivers/i8259.c |
|---|
| 0,0 → 1,120 |
| /* |
| * Copyright (C) 2001-2004 Jakub Jermar |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * - Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * - Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * - The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| #include <arch/i8259.h> |
| #include <cpu.h> |
| #include <arch/types.h> |
| #include <arch/asm.h> |
| #include <arch.h> |
| /* |
| * This is the PIC driver. |
| * Programmable Interrupt Controller for UP systems. |
| */ |
| void i8259_init(void) |
| { |
| /* ICW1: this is ICW1, ICW4 to follow */ |
| outb(PIC_PIC0PORT1, PIC_ICW1 | PIC_NEEDICW4); |
| /* ICW2: IRQ 0 maps to INT IRQBASE */ |
| outb(PIC_PIC0PORT2, IVT_IRQBASE); |
| /* ICW3: pic1 using IRQ IRQ_PIC1 */ |
| outb(PIC_PIC0PORT2, 1 << IRQ_PIC1); |
| /* ICW4: i8086 mode */ |
| outb(PIC_PIC0PORT2, 1); |
| /* ICW1: ICW1, ICW4 to follow */ |
| outb(PIC_PIC1PORT1, PIC_ICW1 | PIC_NEEDICW4); |
| /* ICW2: IRQ 8 maps to INT (IVT_IRQBASE + 8) */ |
| outb(PIC_PIC1PORT2, IVT_IRQBASE + 8); |
| /* ICW3: pic1 is known as PIC_PIC1ID */ |
| outb(PIC_PIC1PORT2, PIC_PIC1ID); |
| /* ICW4: i8086 mode */ |
| outb(PIC_PIC1PORT2, 1); |
| /* |
| * Register interrupt handler for the PIC spurious interrupt. |
| */ |
| trap_register(VECTOR_PIC_SPUR, pic_spurious); |
| /* |
| * Set the enable/disable IRQs handlers. |
| * Set the End-of-Interrupt handler. |
| */ |
| enable_irqs_function = pic_enable_irqs; |
| disable_irqs_function = pic_disable_irqs; |
| eoi_function = pic_eoi; |
| pic_disable_irqs(0xffff); /* disable all irq's */ |
| pic_enable_irqs(1<<IRQ_PIC1); /* but enable pic1 */ |
| } |
| void pic_enable_irqs(__u16 irqmask) |
| { |
| __u8 x; |
| if (irqmask & 0xff) { |
| x = inb(PIC_PIC0PORT2); |
| outb(PIC_PIC0PORT2, x & (~(irqmask & 0xff))); |
| } |
| if (irqmask >> 8) { |
| x = inb(PIC_PIC1PORT2); |
| outb(PIC_PIC1PORT2, x & (~(irqmask >> 8))); |
| } |
| } |
| void pic_disable_irqs(__u16 irqmask) |
| { |
| __u8 x; |
| if (irqmask & 0xff) { |
| x = inb(PIC_PIC0PORT2); |
| outb(PIC_PIC0PORT2, x | (irqmask & 0xff)); |
| } |
| if (irqmask >> 8) { |
| x = inb(PIC_PIC1PORT2); |
| outb(PIC_PIC1PORT2, x | (irqmask >> 8)); |
| } |
| } |
| void pic_eoi(void) |
| { |
| outb(0x20,0x20); |
| outb(0xa0,0x20); |
| } |
| void pic_spurious(__u8 n, __u32 stack[]) |
| { |
| printf("cpu%d: PIC spurious interrupt\n", the->cpu->id); |
| } |
| /SPARTAN/trunk/arch/ia32/src/drivers/i8042.c |
|---|
| 0,0 → 1,58 |
| /* |
| * Copyright (C) 2001-2004 Jakub Jermar |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * - Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * - Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * - The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| #include <arch/i8042.h> |
| #include <arch/i8259.h> |
| #include <arch/interrupt.h> |
| #include <cpu.h> |
| #include <arch/asm.h> |
| #include <arch.h> |
| #include <print.h> |
| /* |
| * i8042 processor driver. |
| * Its very essential function is enabling the A20. |
| */ |
| void i8042_init(void) |
| { |
| /* A20: deadly if not enabled */ |
| outb(0x64,0xd1); |
| outb(0x60,0xdf); |
| trap_register(VECTOR_KBD, i8042_interrupt); |
| } |
| void i8042_interrupt(__u8 n, __u32 stack[]) |
| { |
| __u8 x; |
| trap_virtual_eoi(); |
| x = inb(0x60); |
| printf("%d", the->cpu->id);; |
| } |
| /SPARTAN/trunk/arch/ia32/src/drivers/i8254.c |
|---|
| 0,0 → 1,130 |
| /* |
| * Copyright (C) 2001-2004 Jakub Jermar |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * - Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * - Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * - The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| #include <arch/types.h> |
| #include <time/clock.h> |
| #include <time/delay.h> |
| #include <arch/interrupt.h> |
| #include <arch/i8259.h> |
| #include <arch/i8254.h> |
| #include <cpu.h> |
| #include <config.h> |
| #include <arch/pm.h> |
| #include <arch/asm.h> |
| #include <arch.h> |
| /* |
| * i8254 chip driver. |
| * Low level time functions. |
| */ |
| #define CLK_PORT1 0x40 |
| #define CLK_PORT4 0x43 |
| #define CLK_CONST 1193180 |
| #define MAGIC_NUMBER 1194 |
| void i8254_init(void) |
| { |
| i8254_normal_operation(); |
| } |
| void i8254_normal_operation(void) |
| { |
| outb(CLK_PORT4, 0x36); |
| trap_virtual_disable_irqs(1<<IRQ_CLK); |
| outb(CLK_PORT1, (CLK_CONST/HZ) & 0xf); |
| outb(CLK_PORT1, (CLK_CONST/HZ) >> 8); |
| trap_virtual_enable_irqs(1<<IRQ_CLK); |
| trap_register(VECTOR_CLK, i8254_interrupt); |
| } |
| #define LOOPS 150000 |
| #define SHIFT 11 |
| void i8254_calibrate_delay_loop(void) |
| { |
| __u64 clk1, clk2; |
| __u32 t1, t2, o1, o2; |
| __u8 not_ok; |
| /* |
| * One-shot timer. Count-down from 0xffff at 1193180Hz |
| * MAGIC_NUMBER is the magic value for 1ms. |
| */ |
| outb(CLK_PORT4, 0x30); |
| outb(CLK_PORT1, 0xff); |
| outb(CLK_PORT1, 0xff); |
| do { |
| /* will read both status and count */ |
| outb(CLK_PORT4, 0xc2); |
| not_ok = (inb(CLK_PORT1)>>6)&1; |
| t1 = inb(CLK_PORT1); |
| t1 |= inb(CLK_PORT1) << 8; |
| } while (not_ok); |
| asm_delay_loop(LOOPS); |
| outb(CLK_PORT4, 0xd2); |
| t2 = inb(CLK_PORT1); |
| t2 |= inb(CLK_PORT1) << 8; |
| /* |
| * We want to determine the overhead of the calibrating mechanism. |
| */ |
| outb(CLK_PORT4, 0xd2); |
| o1 = inb(CLK_PORT1); |
| o1 |= inb(CLK_PORT1) << 8; |
| asm_fake_loop(LOOPS); |
| outb(CLK_PORT4, 0xd2); |
| o2 = inb(CLK_PORT1); |
| o2 |= inb(CLK_PORT1) << 8; |
| the->cpu->delay_loop_const = ((MAGIC_NUMBER*LOOPS)/1000) / ((t1-t2)-(o1-o2)) + |
| (((MAGIC_NUMBER*LOOPS)/1000) % ((t1-t2)-(o1-o2)) ? 1 : 0); |
| clk1 = rdtsc(); |
| delay(1<<SHIFT); |
| clk2 = rdtsc(); |
| the->cpu->frequency_mhz = (clk2-clk1)>>SHIFT; |
| return; |
| } |
| void i8254_interrupt(__u8 n, __u32 stack[]) |
| { |
| trap_virtual_eoi(); |
| clock(); |
| } |
| /SPARTAN/trunk/arch/ia32/src/drivers/ega.c |
|---|
| 0,0 → 1,116 |
| /* |
| * Copyright (C) 2001-2004 Jakub Jermar |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * - Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * - Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * - The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| #include <arch/ega.h> |
| #include <putchar.h> |
| #include <mm/page.h> |
| #include <synch/spinlock.h> |
| #include <arch/types.h> |
| #include <arch/asm.h> |
| /* |
| * The EGA driver. |
| * Simple and short. Function for displaying characters and "scrolling". |
| */ |
| static spinlock_t egalock; |
| static __u32 ega_cursor; |
| void ega_move_cursor(void); |
| void ega_init(void) |
| { |
| __u8 hi, lo; |
| map_page_to_frame(VIDEORAM, VIDEORAM, PAGE_NOT_CACHEABLE, 0); |
| outb(0x3d4,0xe); |
| hi = inb(0x3d5); |
| outb(0x3d4,0xf); |
| lo = inb(0x3d5); |
| ega_cursor = (hi<<8)|lo; |
| ega_putchar('\n'); |
| } |
| void ega_display_char(char ch) |
| { |
| __u8 *vram = (__u8 *) VIDEORAM; |
| vram[ega_cursor*2] = ch; |
| } |
| /* |
| * This function takes care of scrolling. |
| */ |
| void ega_check_cursor(void) |
| { |
| if (ega_cursor < SCREEN) |
| return; |
| memcopy(VIDEORAM + ROW*2, VIDEORAM, (SCREEN - ROW)*2); |
| memsetw(VIDEORAM + (SCREEN - ROW)*2, ROW, 0x0720); |
| ega_cursor = ega_cursor - ROW; |
| } |
| void ega_putchar(char ch) |
| { |
| pri_t pri; |
| pri = cpu_priority_high(); |
| spinlock_lock(&egalock); |
| switch (ch) { |
| case '\n': |
| ega_cursor = (ega_cursor + ROW) - ega_cursor % ROW; |
| break; |
| case '\t': |
| ega_cursor = (ega_cursor + 8) - ega_cursor % 8; |
| break; |
| default: |
| ega_display_char(ch); |
| ega_cursor++; |
| break; |
| } |
| ega_check_cursor(); |
| ega_move_cursor(); |
| spinlock_unlock(&egalock); |
| cpu_priority_restore(pri); |
| } |
| void ega_move_cursor(void) |
| { |
| outb(0x3d4,0xe); |
| outb(0x3d5,(ega_cursor>>8)&0xff); |
| outb(0x3d4,0xf); |
| outb(0x3d5,ega_cursor&0xff); |
| } |
| void putchar(char ch) |
| { |
| ega_putchar(ch); |
| } |