WebSVN – Kolibri OS – Diff – /kernel/trunk/core/sys32.inc

 ;;  Distributed under GPL. See file COPYING for details.        ;;
 ;;  Copyright 2003 Ville Turjanmaa                              ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-$Revision: 1038 $
+$Revision: 1056 $
-align 4
-idtreg:
      dw   8*0x41-1
-     dd   idts+8
-build_interrupt_table:
+align 4 ;3A08
 build_interrupt_table:
-	mov    edi, idts+8
-	mov    esi, sys_int
-	mov    ecx, 0x40
+        mov     edi, idts
-     @@:
+        mov     esi, sys_int
-	lodsd
+        mov     ecx, 0x40
-	mov    [edi],	ax	     ; lower part of offset
+        mov     eax, (10001110b shl 24) + os_code
-	mov    [edi+2], word os_code ; segment selector
-	mov	ax, word 10001110b shl 8	; type: interrupt gate
+  @@:   movsw   ;low word of code-entry
-	mov	[edi+4], eax
-	add    edi, 8
-	loop	@b
+        stosd   ;interrupt gate type : os_code selector
+        movsw   ;high word of code-entry
-	;mov    edi,8*0x40+idts+8
+        loop    @b
-	mov	dword [edi], (i40 and 0xFFFF) or (os_code shl 16)
+        movsd   ;copy low  dword of trap gate for int 0x40
-	mov	dword [edi+4], (11101111b shl 8) or (i40 and 0xFFFF0000)
+        movsd   ;copy high dword of trap gate for int 0x40
-						; type: trap gate
-	ret
+        lidt    [esi]
-iglobal
         ret
-  msg_sel_ker	db "kernel", 0
-  msg_sel_app	db "application", 0
+iglobal
-  sys_int:
+  align 4
-    dd e0,debug_exc,e2,e3
-    dd e4,e5,e6,e7
+  sys_int:
-    dd e8,e9,e10,e11
+    ;exception handlers addresses (for interrupt gate construction)
+        dd      e0,e1,e2,e3,e4,e5,e6,except_7
-    dd e12,e13,page_fault_handler,e15
+        dd      e8,e9,e10,e11,e12,e13,page_fault_exc,e15
         dd      e16, e17,e18, e19
-    dd except_16, e17,e18, except_19
+        times   12 dd unknown_interrupt ;int_20..int_31
     times 12 dd unknown_interrupt
+    ;interrupt handlers addresses (for interrupt gate construction)
-    dd	 irq0, irq_serv.irq_1, irq_serv.irq_2
+        dd      irq0, irq_serv.irq_1, irq_serv.irq_2
-if USE_COM_IRQ
+    if  USE_COM_IRQ
-    dd	 irq_serv.irq_3, irq_serv.irq_4
+        dd      irq_serv.irq_3, irq_serv.irq_4
-else
+    else
+        dd      p_irq3, p_irq4 ;??? íåñòûêîâêà
+    end if
+        dd      irq_serv.irq_5,  p_irq6,          irq_serv.irq_7
+        dd      irq_serv.irq_8,  irq_serv.irq_9,  irq_serv.irq_10
+        dd      irq_serv.irq_11, irq_serv.irq_12, irqD,p_irq14,p_irq15
-    dd	 p_irq3, p_irq4
+        times   16 dd unknown_interrupt ;int_0x30..int_0x3F
+    ;int_0x40 gate trap (for directly copied)
+        dw      i40 and 0xFFFF, os_code, 11101111b shl 8, i40 shr 16
+  idtreg: ; data for LIDT instruction (must be immediately below sys_int data)
+        dw      2*($-sys_int-4)-1
+        dd      idts ;0x8000B100
+        dw      0    ;ïðîñòî âûðàâíèâàíèå
+  msg_fault_sel dd  msg_exc_8,msg_exc_u,msg_exc_a,msg_exc_b
+                dd  msg_exc_c,msg_exc_d,msg_exc_e
+  msg_exc_8     db "Double fault", 0
+  msg_exc_u     db "Undefined Exception", 0
+  msg_exc_a     db "Invalid TSS", 0
+  msg_exc_b     db "Segment not present", 0
-end if
-    dd	 irq_serv.irq_5,  p_irq6,	  irq_serv.irq_7
+  msg_exc_c     db "Stack fault", 0
-    dd	 irq_serv.irq_8,  irq_serv.irq_9, irq_serv.irq_10
+  msg_exc_d     db "General protection fault", 0
-    dd	 irq_serv.irq_11, irq_serv.irq_12,irqD ,p_irq14,p_irq15
   msg_exc_e     db "Page fault", 0
     times 16 dd unknown_interrupt
+  msg_sel_ker   db "kernel", 0
-    dd	 i40
-endg
+  msg_sel_app   db "application", 0
-macro save_ring3_context
-{
-    pushad
-}
-macro restore_ring3_context
-{
+endg
-    popad
-}
-; simply return control to interrupted process
+macro save_ring3_context {
-unknown_interrupt:
+        pushad
      iret
+macro restore_ring3_context {
-macro exc_wo_code [num]
+        popad
-{
-  forward
   e#num :
-      save_ring3_context
+macro exc_wo_code [num] {
-      mov bl, num
+  e#num :
-      jmp exc_c
+        save_ring3_context
         mov     bl, num
+        jmp     exc_c
-macro exc_w_code [num]
-{
-  forward
+} exc_wo_code   0,1,2,3,4,5,6,15,16,19
-  e#num :
-      add esp, 4
-      save_ring3_context
+macro exc_w_code [num] {
+  e#num :
+        add     esp, 4
+        save_ring3_context
+        mov     bl, num
+        jmp     exc_c
+} exc_w_code    8,9,10,11,12,13,17,18
+uglobal
+  pf_err_code   dd ?
+endg
+page_fault_exc:
+        pop     [pf_err_code]  ;äåéñòâèòåëüíî äî ñëåäóþùåãî #PF
+        save_ring3_context
+        mov     bl,14
+exc_c:                         ;èñêëþ÷åíèå
+; Ôðýéì ñòåêà ïðè èñêëþ÷åíèè/ïðåðûâàíèè èç 3-ãî êîëüöà + pushad (ò.å., èìåííî çäåñü)
+  reg_ss        equ esp+0x30
+  reg_esp3      equ esp+0x2C
+  reg_eflags    equ esp+0x28
+  reg_cs3       equ esp+0x24
+  reg_eip       equ esp+0x20
+ ; ýòî ôðýéì îò pushad
-      mov bl, num
+  reg_eax       equ esp+0x1C
-      jmp exc_c
+  reg_ecx       equ esp+0x18
   reg_edx       equ esp+0x14
+  reg_ebx       equ esp+0x10
-exc_wo_code 0, 2, 3, 4, 5, 6, 9, 15, 18
+  reg_esp0      equ esp+0x0C
-exc_w_code 8, 10, 11, 12, 13, 14, 17
+  reg_ebp       equ esp+0x08
+  reg_esi       equ esp+0x04
+  reg_edi       equ esp+0x00
+        Mov     ds,ax,app_data  ; çàãðóçèì ïðàâèëüíûå çíà÷åíèÿ
+        mov     es,ax           ; â ñåãìåíòíûå ðåãèñòðû
+        cld                     ; è ïðèâîäèì DF ê ñòàíäàðòó
+; redirect to V86 manager? (EFLAGS & 0x20000) != 0?
+        test    byte[reg_eflags+2],2
+        jnz     v86_exc_c
+        cmp     bl,14           ; #PF
-exc_c:
+        jne     .l0
-	mov   ax, app_data  ;èñêëþ÷åíèå
+        call    page_fault_handler
-	mov   ds, ax	    ;çàãðóçèì ïðàâèëüíûå çíà÷åíè
+  .l0:  mov     esi, [current_slot]
-	mov   es, ax	    ;â ðåãèñòðû
+        mov     eax,[esi+APPDATA.fpu_handler]
         cmp     bl,16           ; #MF
-; redirect to V86 manager? (EFLAGS & 0x20000) != 0?
-	test	byte [esp+20h+8+2], 2
-	jnz	v86_exc_c
+        je      .l1
-; test if debugging
+        cmp     bl,19           ; #XF
-	cli
+        jne     .l2
-	mov   eax, [current_slot]
-	mov   eax, [eax+APPDATA.debugger_slot]
+        mov     eax,[esi+APPDATA.sse_handler]
-	test  eax, eax
-	jnz   .debug
+  .l1:  test    eax, eax
-	sti
+        jnz     IRetToUserHook
-; not debuggee => say error and terminate
+  .l2:  cli
-	movzx eax, bl
-	mov   [error_interrupt], eax
+        mov     eax, [esi+APPDATA.debugger_slot]
-	call  show_error_parameters
-	add   esp, 0x20
+        test    eax, eax
-	mov   edx, [TASK_BASE]
+        jnz     .debug
-	mov   [edx + TASKDATA.state], byte 4
-	jmp   change_task
+        sti
+; not debuggee => say error and terminate
-.debug:
+        call    show_error_parameters ;; only ONE using, inline ???
-; we are debugged process, notify debugger and suspend ourself
+       ;mov     edx, [TASK_BASE]
-; eax=debugger PID
+        mov     [edx + TASKDATA.state], byte 4 ; terminate
-	cld
+        jmp     change_task     ; stack - here it does not matter at all
-	movzx ecx, bl
+.debug:
-	push  ecx
+; we are debugged process, notify debugger and suspend ourself
-	mov   ecx, [TASK_BASE]
+; eax=debugger PID
+        cmp     bl,1            ; #DB
-	push  dword [ecx+TASKDATA.pid]	  ; PID of current process
+        je      debug_ex
-	push  12
-	pop   ecx
-	push  1        ; 1=exception
-	call  debugger_notify
-	pop   ecx
-	pop   ecx
+        movzx   edx, bl         ; debug_message data=Number_Of_Exception
-	pop   ecx
+        mov     ecx,1           ; debug_message code=other_exception
-	mov   edx, [TASK_BASE]
+        jmp     debug_ex.notify ; notify debugger and suspend ourself
-	mov   byte [edx+TASKDATA.state], 1	  ; suspended
-	call  change_task
-	restore_ring3_context
-	iretd
+IRetToUserHook:
-iglobal
-	hexletters	db '0123456789ABCDEF'
-	error_interrupt dd  -1
-endg
+        xchg    eax, [reg_eip]
-;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
-show_error_parameters:
-    mov eax,[CURRENT_TASK]
-    shl eax, 5
+        sub     dword[reg_esp3], 4
-    DEBUGF  1, "K : Process - forced terminate PID: %x\n", [CURRENT_TASK + TASKDATA.pid + eax]
-    mov eax, [error_interrupt]
-    cmp al, 0x08
+        mov     edi, [reg_esp3]
-    jne @f
-    DEBUGF  1, "K : Double fault\n"
+        stosd
-    jmp defined_error
-@@:
-    cmp al, 0x0a
-    jne @f
-    DEBUGF  1, "K : Invalid TSS\n"
+        restore_ring3_context
-    jmp defined_error
-@@:
+unknown_interrupt:
-    cmp al, 0x0b
-    jne @f
-    DEBUGF  1, "K : Segment not present\n"
-    jmp defined_error
-@@:
+        iretd
-    cmp al, 0x0c
-    jne @f
-    DEBUGF  1, "K : Stack fault\n"
-    jmp defined_error
-@@:
-    cmp al, 0x0d
-    jne @f
-    DEBUGF  1, "K : General protection fault\n"
-    jmp defined_error
-@@:
+;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
-    cmp al, 0x0e
+show_error_parameters:
-    jne @f
+        mov     edx,[TASK_BASE] ;not scratched below
-    DEBUGF  1, "K : Page fault\n"
+        DEBUGF  1, "K : Process - forced terminate PID: %x\n", [edx+TASKDATA.pid]
-    jmp defined_error
+        cmp     bl, 0x08
-@@:
+        jb      .l0
-    DEBUGF  1, "K : Undefined Exception\n"
+        cmp     bl, 0x0e
+        jbe     .l1
+  .l0:  mov     bl, 0x09
-defined_error:
+  .l1:  movzx   eax,bl
-    DEBUGF  1, "K : EAX : %x EBX : %x ECX : %x\n", [esp + 0x20], [esp - 12 + 0x20], [esp - 4 + 0x20]
+        mov     eax,[msg_fault_sel+eax*4 - 0x08*4]
-    DEBUGF  1, "K : EDX : %x ESI : %x EDI : %x\n", [esp - 8 + 0x20], [esp - 24 + 0x20], [esp - 28 + 0x20]
+        DEBUGF  1, "K : %s\n", eax
+        mov     eax, [reg_cs3+4]
+        mov     edi, msg_sel_app
+        mov     ebx, [reg_esp3+4]
+        cmp     eax, app_code
+        je      @f
+        mov     edi, msg_sel_ker
+        mov     ebx, [reg_esp0+4]
+    @@: DEBUGF  1, "K : EAX : %x EBX : %x ECX : %x\n", [reg_eax+4], [reg_ebx+4], [reg_ecx+4]
+        DEBUGF  1, "K : EDX : %x ESI : %x EDI : %x\n", [reg_edx+4], [reg_esi+4], [reg_edi+4]
+        DEBUGF  1, "K : EBP : %x EIP : %x ESP : %x\n", [reg_ebp+4], [reg_eip+4], ebx
+        DEBUGF  1, "K : Flags : %x CS : %x (%s)\n", [reg_eflags+4], eax, edi
+        ret
+;-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
     DEBUGF  1, "K : EBP : %x EIP : %x ", [esp - 20 + 0x20], [esp + 4 + 0x20]
+  restore  reg_ss
-    mov eax, [esp + 8 + 0x20]
-    mov edi, msg_sel_app
-    mov ebx, [esp + 16 + 0x20]
+  restore  reg_esp3
-    cmp eax, app_code
+  restore  reg_eflags
-    je	@f
+  restore  reg_cs
-    mov edi, msg_sel_ker
+  restore  reg_eip
-    mov ebx, [esp - 16 + 0x20]
-@@:
+  restore  reg_eax
-    DEBUGF  1, "ESP : %x\nK : Flags : %x CS : %x (%s)\n", ebx, [esp + 12 + 0x20], eax, edi
+  restore  reg_ecx
-    ret
+  restore  reg_edx
-     out    0xa0,al
+        out     0xa0,al
-     out   0x20, al
+        out     0x20, al
-     ret
+        ret
-irqD:
-     save_ring3_context
-     mov   ax, app_data  ;os_data
-     mov   ds, ax
+irqD:
-     mov   es, ax
-     mov   dx,0xf0
+        push  eax
-     mov   al,0
+        mov   al,0
-     out   dx,al
-     mov   dx,0xa0
+        out   0xf0,al
-     mov   al,0x20
+        mov   al,0x20
-     out   dx,al
+        out   0xa0,al
-     mov   dx,0x20
+        out   0x20,al
-     out   dx,al
-     restore_ring3_context
         pop   eax
+        iret
      iret
 irqh 2,3,4,5,7,8,9,10,11
 irqhandler:

Subversion Repositories Kolibri OS

(root)/kernel/trunk/core/sys32.inc – Rev 1038 → 1056