Subversion Repositories HelenOS

#

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

.global cpu_sleep

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

.global memsetb

.global memsetw

.global memcmp

## Turn paging on

#

# Enable paging and write-back caching in CR0.

#

paging_on:

	pushl %eax

	movl %cr0,%eax

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

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

	movl %eax,%cr0

	jmp 0f

0:

	popl %eax

	ret

## Enable local APIC

#

# Enable local APIC in MSR.

#

enable_l_apic_in_msr:

	pusha

	movl $0x1b, %ecx

	rdmsr

	orl $(1<<11),%eax

	orl $(0xfee00000),%eax

	wrmsr

	popa

	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:

	push %edx

	xorl %eax,%eax

	movl 8(%esp),%edx

	inb %dx,%al

	pop %edx

	ret

## I/O input (word)

#

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

#

inw:

	push %edx

	xorl %eax,%eax

	movl 8(%esp),%edx

	inw %dx,%ax

	pop %edx

	ret

## I/O input (dword)

#

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

#

inl:

	push %edx

	xorl %eax,%eax

	movl 8(%esp),%edx

	inl %dx,%eax

	pop %edx

	ret

## I/O output (byte)

#

# Send a byte to I/O port.

#

outb:

	push %ebp

	movl %esp,%ebp

	pusha

	movl 8(%ebp),%edx

	movl 12(%ebp),%eax

	outb %al,%dx

	popa

	pop %ebp

	ret

## I/O output (word)

#

# Send a word to I/O port.

#

outw:

	push %ebp

	movl %esp,%ebp

	pusha

	movl 8(%ebp),%edx

	movl 12(%ebp),%eax

	outw %ax,%dx

	popa

	pop %ebp

	ret

## I/O output (dword)

#

# Send a dword to I/O port.

#

outl:

	push %ebp

	movl %esp,%ebp

	pusha

	movl 8(%ebp),%edx

	movl 12(%ebp),%eax

	outl %eax,%dx

	popa

	pop %ebp

	ret

## Copy memory

#

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

# from the memory location defined by 1st argument

# to the memory location defined by 2nd argument.

# The memory areas cannot overlap.

#

SRC=8

DST=12

CNT=16

memcopy:

	push %ebp

	movl %esp,%ebp

	pusha

	cld

	movl CNT(%ebp),%ecx

	movl DST(%ebp),%edi

	movl SRC(%ebp),%esi

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

	popa

	pop %ebp

	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=8

CNT=12

X=16

memsetb:

	push %ebp

	movl %esp,%ebp

	pusha

	cld

	movl CNT(%ebp),%ecx

	movl DST(%ebp),%edi

	movl X(%ebp),%eax

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

	popa

	pop %ebp

	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=8

CNT=12

X=16

memsetw:

	push %ebp

	movl %esp,%ebp

	pusha

	cld

	movl CNT(%ebp),%ecx

	movl DST(%ebp),%edi

	movl X(%ebp),%eax

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

	popa

	pop %ebp

	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 %ebp

	subl $4,%esp	

	movl %esp,%ebp

	pusha

	cld

	movl CNT(%ebp),%ecx

	movl DST(%ebp),%edi

	movl SRC(%ebp),%esi

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

	movl %ecx,(%ebp)

	popa

	movl (%ebp),%eax	# return value => %eax (zero on success)

	addl $4,%esp

	pop %ebp

	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