Subversion Repositories HelenOS-historic

#

# 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.

#

## very low and hardware-level functions

#  Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word

# and 1 means interrupt with error word

#define ERROR_WORD_INTERRUPT_LIST 0x00027D00

.text

.global paging_on

.global enable_l_apic_in_msr

.global interrupt_handlers

.global inb

.global inw

.global inl

.global outb

.global outw

.global outl

.global memcpy

.global memsetb

.global memsetw

.global memcmp

## Turn paging on

#

# Enable paging and write-back caching in CR0.

#

paging_on:

	movl %cr0,%edx

	orl $(1<<31),%edx		# paging on

	andl $~((1<<30)|(1<<29)),%edx	# clear Cache Disable and not Write Though

	movl %edx,%cr0

	jmp 0f

0:

	ret

## Enable local APIC

#

# Enable local APIC in MSR.

#

enable_l_apic_in_msr:

	push %eax

	movl $0x1b, %ecx

	rdmsr

	orl $(1<<11),%eax

	orl $(0xfee00000),%eax

	wrmsr

	pop %eax

	ret

## Declare interrupt handlers

#

# Declare interrupt handlers for n interrupt

# vectors starting at vector i.

#

# The handlers setup data segment registers

# and call trap_dispatcher().

#

.macro handler i n

	push %ebp

	movl %esp,%ebp

	pusha

	push %ds

	push %es

	# we must fill the data segment registers

	movw $16,%ax

	movw %ax,%ds

	movw %ax,%es

	movl $(\i),%edi

	pushl %ebp

	addl $4,(%esp)

	pushl %edi

	call trap_dispatcher

	addl $8,%esp

	pop %es

	pop %ds

# CLNT

	pushfl

	pop %eax

	and $0xFFFFBFFF,%eax

	push %eax

	popfl

# Test if this is interrupt with error word or not

	mov $\i,%cl

	movl $1,%eax

	test $0xe0,%cl

	jnz 0f

	and $0x1f,%cl

	shl %cl,%eax

	and $ERROR_WORD_INTERRUPT_LIST,%eax

	jz 0f

# Return with error word

	popa

	pop %ebp

	add $4,%esp	# Skip error word

	iret

0:

# Return with no error word

	popa

	pop %ebp

	iret

	.if (\n-\i)-1

	handler "(\i+1)",\n

	.endif

.endm

# keep in sync with pm.h !!!

IDT_ITEMS=64

interrupt_handlers:

h_start:

	handler 0 64

#	handler 64 128	

#	handler 128 192

#	handler 192 256

h_end:

## I/O input (byte)

#

# Get a byte from I/O port and store it AL.

#

inb:

	xorl %eax,%eax

	movl 4(%esp),%edx

	inb %dx,%al

	ret

## I/O input (word)

#

# Get a word from I/O port and store it AX.

#

inw:

	xorl %eax,%eax

	movl 4(%esp),%edx

	inw %dx,%ax

	ret

## I/O input (dword)

#

# Get a dword from I/O port and store it EAX.

#

inl:

	xorl %eax,%eax

	movl 4(%esp),%edx

	inl %dx,%eax

	ret

## I/O output (byte)

#

# Send a byte to I/O port.

#

outb:

	push %eax

	movl 8(%esp),%edx

	movl 12(%esp),%eax

	outb %al,%dx

	pop %eax

	ret

## I/O output (word)

#

# Send a word to I/O port.

#

outw:

	push %eax

	movl 8(%esp),%edx

	movl 12(%esp),%eax

	outw %ax,%dx

	pop %eax

	ret

## I/O output (dword)

#

# Send a dword to I/O port.

#

outl:

	push %eax

	movl 8(%esp),%edx

	movl 12(%esp),%eax

	outl %eax,%dx

	pop %eax

	ret

## Copy memory

#

# Copy a given number of bytes (3rd argument)

# from the memory location defined by 2nd argument

# to the memory location defined by 1st argument.

# The memory areas cannot overlap.

#

SRC=16

DST=12

CNT=20

memcpy:

	push %esi

	push %edi

	movl CNT(%esp),%ecx

	movl DST(%esp),%edi

	movl SRC(%esp),%esi

	rep movsb %ds:(%esi),%es:(%edi)

	pop %edi

	pop %esi

	ret

## Fill memory with bytes

#

# Fill a given number of bytes (2nd argument)

# at memory defined by 1st argument with the

# byte value defined by 3rd argument.

#

DST=12

CNT=16

X=20

memsetb:

	push %eax

	push %edi

	movl CNT(%esp),%ecx

	movl DST(%esp),%edi

	movl X(%esp),%eax

	rep stosb %al,%es:(%edi)

	pop %edi

	pop %eax

	ret

## Fill memory with words

#

# Fill a given number of words (2nd argument)

# at memory defined by 1st argument with the

# word value defined by 3rd argument.

#

DST=12

CNT=16

X=20

memsetw:

	push %eax

	push %edi

	movl CNT(%esp),%ecx

	movl DST(%esp),%edi

	movl X(%esp),%eax

	rep stosw %ax,%es:(%edi)

	pop %edi

	pop %eax

	ret

## Compare memory regions for equality

#

# Compare a given number of bytes (3rd argument)

# at memory locations defined by 1st and 2nd argument

# for equality. If the bytes are equal, EAX contains

# 0.

#

SRC=12

DST=16

CNT=20

memcmp:

	push %esi

	push %edi

	movl CNT(%esp),%ecx

	movl DST(%esp),%edi

	movl SRC(%esp),%esi

	repe cmpsb %es:(%edi),%ds:(%esi)

	movl %ecx,%eax		# %ecx contains the return value (zero on success)

	pop %edi

	pop %esi

	ret

# THIS IS USERSPACE CODE

.global utext

utext:

	xor %ax,%ax

	mov %ax,%ds

	mov %ax,%es

	mov %ax,%fs

	mov %ax,%gs

0:

	int $48

	jmp 0b

	# not reached

utext_end:

.data

.global utext_size

utext_size:

	.long utext_end - utext 

#.section K_DATA_START

.global interrupt_handler_size

interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS