summaryrefslogtreecommitdiff
path: root/recipes/linux/gumstix-kernel-2.6.21/smc91x-fail-if-no-chip.patch
blob: 17ead87f12b828addcd273f43c11a697e9fb528f (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
--- linux-2.6.21/drivers/net/gumstix-smc91x.c-orig	2008-02-24 22:06:30.000000000 -0800
+++ linux-2.6.21/drivers/net/gumstix-smc91x.c	2008-02-25 08:12:57.000000000 -0800
@@ -90,18 +90,42 @@
 	pxa_gpio_mode(GPIO49_nPWE_MD);
 
 	pxa_gpio_mode(GPIO78_nCS_2_MD);
-	// If either if statement fails, then we'll drop out and turn_off_eth1,
+
+  // First look for smc91x0
+	// If either if statement fails, then we'll drop out and turn_off_eth0,
+	// if both succeed, then we'll skip that and just proceed
+  // to test for 2 smc91x chips
+	if(request_mem_region(gumstix_smc91x0_resources[0].start, SMC_IO_EXTENT, "smc91x0 probe"))
+	{
+		ioaddr = ioremap(gumstix_smc91x0_resources[0].start, SMC_IO_EXTENT);
+		val = ioread16(ioaddr + BANK_SELECT);
+		iounmap(ioaddr);
+		release_mem_region(gumstix_smc91x0_resources[0].start, SMC_IO_EXTENT);
+		if ((val & 0xFF00) == 0x3300) {
+			goto proceed;
+		}
+	}
+
+  printk(KERN_ERR "%s: smc91x chip not found, returning -ENXIO\n", __FUNCTION__);
+  return -ENXIO;
+
+proceed:
+  printk(KERN_ERR "%s: smc91x chip found\n", __FUNCTION__);
+
+  // Now look for a second smc91x
+	// If either if statement fails, then we'll drop out and return -ENXIO
 	// if both succeed, then we'll skip that and just proceed with 2 cards
-	if(request_mem_region(gumstix_smc91x1_resources[0].start, SMC_IO_EXTENT, "smc91x probe"))
+	if(request_mem_region(gumstix_smc91x1_resources[0].start, SMC_IO_EXTENT, "smc91x1 probe"))
 	{
 		ioaddr = ioremap(gumstix_smc91x1_resources[0].start, SMC_IO_EXTENT);
 		val = ioread16(ioaddr + BANK_SELECT);
 		iounmap(ioaddr);
 		release_mem_region(gumstix_smc91x1_resources[0].start, SMC_IO_EXTENT);
 		if ((val & 0xFF00) == 0x3300) {
-			goto proceed;
+			goto proceed1;
 		}
 	}
+  
 
 turn_off_eth1:
 	// This is apparently not an SMC91C111
@@ -110,7 +134,8 @@
 	smc91x_devices[1] = NULL;
 	pxa_gpio_mode(78 | GPIO_IN);
 	
-proceed:
+proceed1:
+  printk(KERN_ERR "%s: found %d smc91x chip(s)\n", __FUNCTION__,num_devices);
 	pxa_gpio_mode(GPIO15_nCS_1_MD);
 
 	if(smc91x_devices[1]) pxa_gpio_mode(GPIO_GUMSTIX_ETH1_RST_MD);