Переглянути джерело

Working code to call the PXE stack from within the ISR.

tags/v0.9.3
Michael Brown 17 роки тому
джерело
коміт
027fed72c1

+ 70
- 0
src/arch/i386/drivers/net/undiisr.S Переглянути файл

@@ -0,0 +1,70 @@
1
+#define PXENV_UNDI_ISR 0x0014
2
+#define PXENV_UNDI_ISR_IN_START 1
3
+#define PXENV_UNDI_ISR_OUT_OURS 0
4
+#define PXENV_UNDI_ISR_OUT_NOT_OURS 1
5
+
6
+#define IRQ_PIC_CUTOFF 8
7
+#define ICR_EOI_NON_SPECIFIC 0x20
8
+#define PIC1_ICR 0x20
9
+#define PIC2_ICR 0xa0
10
+	
11
+	.text
12
+	.arch i386
13
+	.section ".text16", "ax", @progbits
14
+	.section ".data16", "aw", @progbits
15
+	.code16
16
+
17
+	.section ".text16"
18
+	.globl undiisr
19
+undiisr:
20
+	
21
+	/* Preserve registers */
22
+	pushw	%ds
23
+	pushw	%es
24
+	pusha
25
+	
26
+	/* Issue UNDI API call */
27
+	movw	%cs:rm_ds, %ax
28
+	movw	%ax, %ds
29
+	movw	%ax, %es
30
+	movw	$undinet_params, %di
31
+	movw	$PXENV_UNDI_ISR, %bx
32
+	movw	$PXENV_UNDI_ISR_IN_START, funcflag
33
+	pushw	%es
34
+	pushw	%di
35
+	pushw	%bx
36
+	lcall	*undinet_entry_point
37
+	addw	$6, %sp
38
+	cmpw	$PXENV_UNDI_ISR_OUT_OURS, funcflag
39
+	jne	chain
40
+	
41
+ack:	/* Record interrupt occurence */
42
+	incb	undiisr_trigger_count
43
+	/* Send EOI */
44
+	movb	$ICR_EOI_NON_SPECIFIC, %al
45
+	cmpb	$IRQ_PIC_CUTOFF, undiisr_irq
46
+	jb	1f
47
+	outb	%al, $PIC2_ICR
48
+1:	outb	%al, $PIC1_ICR
49
+	jmp	exit
50
+	
51
+chain:	/* Chain to next handler */
52
+	pushfw
53
+	lcall	*undiisr_next_handler
54
+	
55
+exit:	/* Restore registers and return */
56
+	popa
57
+	popw	%es
58
+	popw	%ds
59
+	iret
60
+
61
+	.section ".data16"
62
+undinet_params:
63
+status:			.word	0
64
+funcflag:		.word	0
65
+bufferlength:		.word	0
66
+framelength:		.word	0
67
+frameheaderlength:	.word	0
68
+frame:			.word	0, 0
69
+prottype:		.byte	0
70
+pkttype:		.byte	0

+ 22
- 19
src/arch/i386/drivers/net/undinet.c Переглянути файл

@@ -146,7 +146,7 @@ static union u_PXENV_ANY __data16 ( undinet_params );
146 146
  * Used as the indirection vector for all UNDI API calls.  Resides in
147 147
  * base memory.
148 148
  */
149
-static SEGOFF16_t __data16 ( undinet_entry_point );
149
+SEGOFF16_t __data16 ( undinet_entry_point );
150 150
 #define undinet_entry_point __use_data16 ( undinet_entry_point )
151 151
 
152 152
 /**
@@ -245,17 +245,21 @@ static int undinet_call ( struct undi_nic *undinic, unsigned int function,
245 245
 /**
246 246
  * UNDI interrupt service routine
247 247
  *
248
- * The UNDI ISR simply increments a counter (@c trigger_count) and
249
- * exits.
248
+ * The UNDI ISR increments a counter (@c trigger_count) and exits.
250 249
  */
251
-extern void undinet_isr ( void );
250
+extern void undiisr ( void );
252 251
 
253
-/** Dummy chain vector */
254
-static struct segoff prev_handler[ IRQ_MAX + 1 ];
252
+/** IRQ number */
253
+uint8_t __data16 ( undiisr_irq );
254
+#define undiisr_irq __use_data16 ( undiisr_irq )
255
+
256
+/** IRQ chain vector */
257
+struct segoff __data16 ( undiisr_next_handler );
258
+#define undiisr_next_handler __use_data16 ( undiisr_next_handler )
255 259
 
256 260
 /** IRQ trigger count */
257
-static volatile uint8_t __text16 ( trigger_count ) = 0;
258
-#define trigger_count __use_text16 ( trigger_count )
261
+volatile uint8_t __data16 ( undiisr_trigger_count ) = 0;
262
+#define undiisr_trigger_count __use_data16 ( undiisr_trigger_count )
259 263
 
260 264
 /** Last observed trigger count */
261 265
 static unsigned int last_trigger_count = 0;
@@ -275,16 +279,12 @@ static unsigned int last_trigger_count = 0;
275 279
 static void undinet_hook_isr ( unsigned int irq ) {
276 280
 
277 281
 	assert ( irq <= IRQ_MAX );
282
+	assert ( undiisr_irq == 0 );
278 283
 
279
-	__asm__ __volatile__ ( TEXT16_CODE ( "\nundinet_isr:\n\t"
280
-					     "incb %%cs:%c0\n\t"
281
-					     "iret\n\t" )
282
-			       : : "p" ( & __from_text16 ( trigger_count ) ) );
283
-
284
+	undiisr_irq = irq;
284 285
 	hook_bios_interrupt ( IRQ_INT ( irq ),
285
-			      ( ( unsigned int ) undinet_isr ),
286
-			      &prev_handler[irq] );
287
-
286
+			      ( ( unsigned int ) undiisr ),
287
+			      &undiisr_next_handler );
288 288
 }
289 289
 
290 290
 /**
@@ -297,8 +297,9 @@ static void undinet_unhook_isr ( unsigned int irq ) {
297 297
 	assert ( irq <= IRQ_MAX );
298 298
 
299 299
 	unhook_bios_interrupt ( IRQ_INT ( irq ),
300
-				( ( unsigned int ) undinet_isr ),
301
-				&prev_handler[irq] );
300
+				( ( unsigned int ) undiisr ),
301
+				&undiisr_next_handler );
302
+	undiisr_irq = 0;
302 303
 }
303 304
 
304 305
 /**
@@ -310,7 +311,7 @@ static int undinet_isr_triggered ( void ) {
310 311
 	unsigned int this_trigger_count;
311 312
 
312 313
 	/* Read trigger_count.  Do this only once; it is volatile */
313
-	this_trigger_count = trigger_count;
314
+	this_trigger_count = undiisr_trigger_count;
314 315
 
315 316
 	if ( this_trigger_count == last_trigger_count ) {
316 317
 		/* Not triggered */
@@ -424,6 +425,7 @@ static void undinet_poll ( struct net_device *netdev ) {
424 425
 		if ( ! undinet_isr_triggered() )
425 426
 			return;
426 427
 
428
+#if 0
427 429
 		/* See if this was our interrupt */
428 430
 		memset ( &undi_isr, 0, sizeof ( undi_isr ) );
429 431
 		undi_isr.FuncFlag = PXENV_UNDI_ISR_IN_START;
@@ -443,6 +445,7 @@ static void undinet_poll ( struct net_device *netdev ) {
443 445
 		/* If this wasn't our interrupt, exit now */
444 446
 		if ( undi_isr.FuncFlag != PXENV_UNDI_ISR_OUT_OURS )
445 447
 			return;
448
+#endif
446 449
 		
447 450
 		/* Start ISR processing */
448 451
 		undinic->isr_processing = 1;

Завантаження…
Відмінити
Зберегти