src/glut/dos/PC_HW/pc_irq.S

   1 /*
   2  * PC/HW routine collection v1.0 for DOS/DJGPP
   3  *
   4  *  Copyright (C) 2002 - Borca Daniel
   5  *  Email : dborca@yahoo.com
   6  *  Web   : http://www.geocities.com/dborca
   7  */
   8
   9
  10                 .file   "pc_irq.S"
  11
  12                 .text
  13
  14 #define IRQ_STACK_SIZE  16384
  15
  16 #define IRQ_WRAPPER_LEN (__irq_wrapper_1-__irq_wrapper_0)
  17 #define IRQ_OLD         (__irq_old_0-__irq_wrapper_0)
  18 #define IRQ_HOOK        (__irq_hook_0-__irq_wrapper_0)
  19 #define IRQ_STACK       (__irq_stack_0-__irq_wrapper_0)
  20
  21                 .balign 4
  22 common:
  23                 movw    $0x0400, %ax
  24                 int     $0x31
  25
  26                 movl    %ss:8(%ebp), %ebx
  27                 cmpl    $15, %ebx
  28                 jbe     0f
  29         fail:
  30                 orl     $-1, %eax
  31                 popl    %edi
  32                 popl    %ebx
  33                 leave
  34                 ret
  35
  36         0:
  37                 movl    %ebx, %edi
  38                 imull   $IRQ_WRAPPER_LEN, %edi
  39                 addl    $__irq_wrapper_0, %edi
  40
  41                 cmpb    $7, %bl
  42                 jbe     1f
  43                 movb    %dl, %dh
  44                 subb    $8, %dh
  45         1:
  46                 addb    %dh, %bl
  47                 ret
  48
  49                 .balign 4
  50                 .global _pc_install_irq
  51 _pc_install_irq:
  52                 pushl   %ebp
  53                 movl    %esp, %ebp
  54                 pushl   %ebx
  55                 pushl   %edi
  56
  57                 call    common
  58
  59                 cmpl    $0, IRQ_HOOK(%edi)
  60                 jne     fail
  61
  62                 pushl   $IRQ_WRAPPER_LEN
  63                 pushl   %edi
  64                 call    __go32_dpmi_lock_code
  65                 addl    $8, %esp
  66                 testl   %eax, %eax
  67                 jnz     fail
  68
  69                 pushl   $IRQ_STACK_SIZE
  70                 call    _pc_malloc
  71                 popl    %edx
  72                 testl   %eax, %eax
  73                 jz      fail
  74                 addl    %edx, %eax
  75                 movl    %eax, IRQ_STACK(%edi)
  76
  77                 movl    %ss:12(%ebp), %eax
  78                 movl    %eax, IRQ_HOOK(%edi)
  79
  80                 movw    $0x0204, %ax
  81                 int     $0x31
  82                 movl    %edx, IRQ_OLD(%edi)
  83                 movw    %cx, IRQ_OLD+4(%edi)
  84                 movw    $0x0205, %ax
  85                 movl    %edi, %edx
  86                 movl    %cs, %ecx
  87                 int     $0x31
  88
  89         done:
  90                 xorl    %eax, %eax
  91                 popl    %edi
  92                 popl    %ebx
  93                 leave
  94                 ret
  95
  96                 .balign 4
  97                 .global _pc_remove_irq
  98 _pc_remove_irq:
  99                 pushl   %ebp
 100                 movl    %esp, %ebp
 101                 pushl   %ebx
 102                 pushl   %edi
 103
 104                 call    common
 105
 106                 cmpl    $0, IRQ_HOOK(%edi)
 107                 je      fail
 108
 109                 movl    $0, IRQ_HOOK(%edi)
 110
 111                 movw    $0x0205, %ax
 112                 movl    IRQ_OLD(%edi), %edx
 113                 movl    IRQ_OLD+4(%edi), %ecx
 114                 int     $0x31
 115
 116                 movl    IRQ_STACK(%edi), %eax
 117                 subl    $IRQ_STACK_SIZE, %eax
 118                 pushl   %eax
 119                 call    _free
 120                 popl    %eax
 121
 122                 jmp     done
 123
 124 #define WRAPPER(x)                                                         ; \
 125                 .balign 4                                                  ; \
 126 __irq_wrapper_##x:                                                         ; \
 127                 pushal                                                     ; \
 128                 pushl   %ds                                                ; \
 129                 pushl   %es                                                ; \
 130                 pushl   %fs                                                ; \
 131                 pushl   %gs                                                ; \
 132                 movl    %ss, %ebx                                          ; \
 133                 movl    %esp, %esi                                         ; \
 134                 movl    %cs:___djgpp_ds_alias, %ss                         ; \
 135                 movl    %cs:__irq_stack_##x, %esp                          ; \
 136                 pushl   %ss                                                ; \
 137                 pushl   %ss                                                ; \
 138                 popl    %es                                                ; \
 139                 popl    %ds                                                ; \
 140                 movl    ___djgpp_dos_sel, %fs                              ; \
 141                 pushl   %fs                                                ; \
 142                 popl    %gs                                                ; \
 143                 call    *__irq_hook_##x                                    ; \
 144                 movl    %ebx, %ss                                          ; \
 145                 movl    %esi, %esp                                         ; \
 146                 testl   %eax, %eax                                         ; \
 147                 popl    %gs                                                ; \
 148                 popl    %fs                                                ; \
 149                 popl    %es                                                ; \
 150                 popl    %ds                                                ; \
 151                 popal                                                      ; \
 152                 jz      __irq_ignore_##x                                   ; \
 153 __irq_bypass_##x:                                                          ; \
 154                 ljmp    *%cs:__irq_old_##x                                 ; \
 155 __irq_ignore_##x:                                                          ; \
 156                 iret                                                       ; \
 157                 .balign 4                                                  ; \
 158 __irq_old_##x:                                                             ; \
 159                 .long   0, 0                                               ; \
 160 __irq_hook_##x:                                                            ; \
 161                 .long   0                                                  ; \
 162 __irq_stack_##x:                                                           ; \
 163                 .long   0
 164
 165                 WRAPPER(0);
 166                 WRAPPER(1);
 167                 WRAPPER(2);
 168                 WRAPPER(3);
 169                 WRAPPER(4);
 170                 WRAPPER(5);
 171                 WRAPPER(6);
 172                 WRAPPER(7);
 173                 WRAPPER(8);
 174                 WRAPPER(9);
 175                 WRAPPER(10);
 176                 WRAPPER(11);
 177                 WRAPPER(12);
 178                 WRAPPER(13);
 179                 WRAPPER(14);
 180                 WRAPPER(15);