| 1 | ; |
|---|
| 2 | ; Process a PXE interrupt |
|---|
| 3 | ; |
|---|
| 4 | section .text16 |
|---|
| 5 | |
|---|
| 6 | PXEIRQ_MAX equ 100 ; Max spurious interrupts in a timer tick |
|---|
| 7 | |
|---|
| 8 | global pxe_isr |
|---|
| 9 | pxe_isr: |
|---|
| 10 | cld |
|---|
| 11 | pusha |
|---|
| 12 | push ds |
|---|
| 13 | push es |
|---|
| 14 | push fs |
|---|
| 15 | push gs |
|---|
| 16 | |
|---|
| 17 | xor ax,ax |
|---|
| 18 | mov ds,ax |
|---|
| 19 | mov es,ax |
|---|
| 20 | |
|---|
| 21 | mov bx,PXENV_UNDI_ISR |
|---|
| 22 | mov di,pxenv_undi_isr_buf |
|---|
| 23 | |
|---|
| 24 | mov cx,pxenv_undi_isr_buf.size/2 |
|---|
| 25 | push di |
|---|
| 26 | rep stosw |
|---|
| 27 | pop di |
|---|
| 28 | |
|---|
| 29 | mov byte [pxenv_undi_isr_buf.funcflag],PXENV_UNDI_ISR_IN_START |
|---|
| 30 | |
|---|
| 31 | call pxenv |
|---|
| 32 | mov ax,[__jiffies] |
|---|
| 33 | jc .notus |
|---|
| 34 | |
|---|
| 35 | cmp word [pxenv_undi_isr_buf.funcflag],PXENV_UNDI_ISR_OUT_OURS |
|---|
| 36 | jne .notus |
|---|
| 37 | |
|---|
| 38 | ; Its ours - set the flag for the return to PM. |
|---|
| 39 | ; We need to EOI this ourselves, so that the |
|---|
| 40 | ; leftover BC doesn't get control. |
|---|
| 41 | mov byte [pxe_irq_pending],1 |
|---|
| 42 | inc dword [pxe_irq_count] |
|---|
| 43 | |
|---|
| 44 | cmp byte [pxe_irq_vector], 8 |
|---|
| 45 | mov al,0x20 ; Non-specific EOI |
|---|
| 46 | jb .pri_pic |
|---|
| 47 | |
|---|
| 48 | out 0xA0, al ; Secondary PIC |
|---|
| 49 | .pri_pic: |
|---|
| 50 | out 0x20,al ; Primary PIC |
|---|
| 51 | |
|---|
| 52 | mov [pxeirq_last],ax |
|---|
| 53 | mov word [pxeirq_deadman],PXEIRQ_MAX |
|---|
| 54 | |
|---|
| 55 | .exit: |
|---|
| 56 | pop gs |
|---|
| 57 | pop fs |
|---|
| 58 | pop es |
|---|
| 59 | pop ds |
|---|
| 60 | popa |
|---|
| 61 | iret |
|---|
| 62 | |
|---|
| 63 | .notus: |
|---|
| 64 | cmp ax,[pxeirq_last] |
|---|
| 65 | jne .reset_timeout |
|---|
| 66 | dec word [pxeirq_deadman] |
|---|
| 67 | jz .timeout |
|---|
| 68 | |
|---|
| 69 | .chain: |
|---|
| 70 | pop gs |
|---|
| 71 | pop fs |
|---|
| 72 | pop es |
|---|
| 73 | pop ds |
|---|
| 74 | popa |
|---|
| 75 | jmp 0:0 |
|---|
| 76 | global pxe_irq_chain |
|---|
| 77 | pxe_irq_chain equ $-4 |
|---|
| 78 | |
|---|
| 79 | .reset_timeout: |
|---|
| 80 | mov [pxeirq_last],ax |
|---|
| 81 | mov word [pxeirq_deadman],PXEIRQ_MAX |
|---|
| 82 | jmp .chain |
|---|
| 83 | |
|---|
| 84 | ; Too many spurious interrupts, shut off the interrupts |
|---|
| 85 | ; and go to polling mode |
|---|
| 86 | .timeout: |
|---|
| 87 | mov al,[pxe_irq_vector] |
|---|
| 88 | mov dx,21h |
|---|
| 89 | movzx cx,al |
|---|
| 90 | shl cx,7-3 |
|---|
| 91 | add dx,cx |
|---|
| 92 | and al,7 |
|---|
| 93 | xchg ax,cx |
|---|
| 94 | mov ch,1 |
|---|
| 95 | shl ch,cl |
|---|
| 96 | in al,dx |
|---|
| 97 | or al,ch |
|---|
| 98 | out dx,al |
|---|
| 99 | or byte [pxe_need_poll],1 |
|---|
| 100 | jmp .exit |
|---|
| 101 | |
|---|
| 102 | |
|---|
| 103 | ; Emulate a PXE interrupt from the polling thread |
|---|
| 104 | global pxe_poll |
|---|
| 105 | pxe_poll: |
|---|
| 106 | pushf |
|---|
| 107 | cli |
|---|
| 108 | cld |
|---|
| 109 | pusha |
|---|
| 110 | push ds |
|---|
| 111 | push es |
|---|
| 112 | push fs |
|---|
| 113 | push gs |
|---|
| 114 | |
|---|
| 115 | mov bx,PXENV_UNDI_ISR |
|---|
| 116 | mov di,pxenv_undi_isr_buf |
|---|
| 117 | |
|---|
| 118 | mov cx,pxenv_undi_isr_buf.size/2 |
|---|
| 119 | push di |
|---|
| 120 | rep stosw |
|---|
| 121 | pop di |
|---|
| 122 | |
|---|
| 123 | mov byte [pxenv_undi_isr_buf.funcflag],PXENV_UNDI_ISR_IN_START |
|---|
| 124 | |
|---|
| 125 | call pxenv |
|---|
| 126 | jc .notus |
|---|
| 127 | |
|---|
| 128 | cmp word [pxenv_undi_isr_buf.funcflag],PXENV_UNDI_ISR_OUT_OURS |
|---|
| 129 | jne .notus |
|---|
| 130 | |
|---|
| 131 | ; Its ours - set the flag for the return to PM. |
|---|
| 132 | ; We need to EOI this ourselves, so that the |
|---|
| 133 | ; leftover BC doesn't get control. |
|---|
| 134 | mov byte [pxe_irq_pending],1 |
|---|
| 135 | |
|---|
| 136 | .notus: |
|---|
| 137 | pop gs |
|---|
| 138 | pop fs |
|---|
| 139 | pop es |
|---|
| 140 | pop ds |
|---|
| 141 | popa |
|---|
| 142 | popf |
|---|
| 143 | ret |
|---|
| 144 | |
|---|
| 145 | section .bss16 |
|---|
| 146 | alignb 4 |
|---|
| 147 | pxenv_undi_isr_buf: |
|---|
| 148 | .status: resw 1 |
|---|
| 149 | .funcflag: resw 1 |
|---|
| 150 | .bufferlength: resw 1 |
|---|
| 151 | .framelen: resw 1 |
|---|
| 152 | .framehdrlen: resw 1 |
|---|
| 153 | .frame: resw 2 |
|---|
| 154 | .prottype: resb 1 |
|---|
| 155 | .pkttype: resb 1 |
|---|
| 156 | .size equ $-pxenv_undi_isr_buf |
|---|
| 157 | |
|---|
| 158 | alignb 4 |
|---|
| 159 | pxeirq_last resw 1 |
|---|
| 160 | pxeirq_deadman resw 1 |
|---|
| 161 | |
|---|
| 162 | global pxe_irq_count |
|---|
| 163 | pxe_irq_count resd 1 ; PXE IRQ counter |
|---|
| 164 | global pxe_irq_vector |
|---|
| 165 | pxe_irq_vector resb 1 ; PXE IRQ vector |
|---|
| 166 | global pxe_irq_pending |
|---|
| 167 | pxe_irq_pending resb 1 ; IRQ pending flag |
|---|
| 168 | global pxe_need_poll |
|---|
| 169 | pxe_need_poll resb 1 ; Bit 0 = need polling |
|---|
| 170 | ; Bit 1 = polling active |
|---|
| 171 | |
|---|
| 172 | section .text16 |
|---|
