try to debug the nand_read

qiboot/src/blink_led.c

@@ -20,36 +20,70 @@
  * MA 02111-1307 USA
  */
 #include "blink_led.h"
-#define GPBCON        (*(volatile unsigned *)0x56000010)
-#define GPBDAT        (*(volatile unsigned *)0x56000014)
-#define GPBDW         (*(volatile unsigned *)0x56000018)   
-#define LED3_ON()    (GPBDAT &= ~(0x1))  
-#define LED4_ON()    (GPBDAT &= ~(0x2))   
-#define LED3_OFF()     (GPBDAT |= (0x1))
-#define LED4_OFF()     (GPBDAT |= (0x2))
 
 int delay(int time)
 {
-	int i=0;
+  int i=0;
-	for(i=0;i<time;i++);
+  for(i=0;i<time;i++);
-	return 0;
+  return 0;
+}
+int set_GPB()
+{
+  GPBCON = 0x5;
+  GPBDW = 0xffff;
+  return 0;
+}
+
+int orange_on(int times)
+{
+  int count=0;
+  set_GPB();
+
+  for(count=0;count<times;count++)
+    {
+      ORANGE_ON();
+      delay(0xfffff);
+      ORANGE_OFF() ;
+      delay(0xfffff);
+    }
+
+  return 0;
+}
+
+int blue_on(int times)
+{
+  int count=0;
+  set_GPB();
+
+  for(count=0;count<times;count++)
+    {
+      BLUE_ON();
+      delay(0xfffff);
+      BLUE_OFF();
+      delay(0xfffff);
+    }
+
+  return 0;
 }
 
 int blink_led()
 {
-    GPBCON = 0x5;
+  set_GPB();
-    GPBDW = 0xffff;
-    while(1)
-    {
-	LED3_ON();
-	delay(0xfffff);
-	LED3_OFF() ;
-	delay(0xfffff);
 
-	LED4_ON();
+  while(1)
-	delay(0xfffff);
+    {
-	LED4_OFF();
+      ORANGE_ON();
-	delay(0xfffff);
+      delay(0xfffff);
+      ORANGE_OFF() ;
+      delay(0xfffff);
+
+      BLUE_ON();
+      delay(0xfffff);
+      BLUE_OFF();
+      delay(0xfffff);
     }
-    return 0;
+
+  return 0;
 }
+
+

qiboot/src/blink_led.h

@@ -23,6 +23,19 @@
 #ifndef __BLINK_LED_H
 #define __BLINK_LED_H
 
+#define GPBCON        (*(volatile unsigned *)0x56000010)
+#define GPBDAT        (*(volatile unsigned *)0x56000014)
+#define GPBDW         (*(volatile unsigned *)0x56000018)   
+#define ORANGE_OFF()    (GPBDAT &= ~(0x1))  
+#define BLUE_OFF()    (GPBDAT &= ~(0x2))   
+#define ORANGE_ON()     (GPBDAT |= (0x1))
+#define BLUE_ON()     (GPBDAT |= (0x2))
+
+#define ORANGE	1;
+#define BLUE	0;
+
+int orange_on(int times);
+int blue_on(int times);
 int blink_led();
 
 #endif /* __BLINK_LED_H */

qiboot/src/nand_read.c

@@ -19,6 +19,7 @@
 #include <linux/mtd/nand.h>
 */
 #include "nand_read.h"
+#include "blink_led.h"
 
 #define NAND_CMD_READ0 0
 #define NAND_CMD_READSTART 0x30
@@ -106,36 +107,35 @@ static int nand_read_page_ll(unsigned char *buf, unsigned long addr)
 /* low level nand read function */
 int nand_read_ll(unsigned char *buf, unsigned long start_addr, int size)
 {
-	int i, j;
+  int i, j;
 
-	if ((start_addr & NAND_BLOCK_MASK) || (size & NAND_BLOCK_MASK))
+  if ((start_addr & NAND_BLOCK_MASK) || (size & NAND_BLOCK_MASK))
-		return -1;	/* invalid alignment */
+    return -1;	/* invalid alignment */
 
-	/* chip Enable */
+  /* chip Enable */
-	nand_select();
+  nand_select();
-	nand_clear_RnB();
+  nand_clear_RnB();
-	for (i=0; i<10; i++);
+  for (i=0; i<10; i++);
 
-	for (i=start_addr; i < (start_addr + size);) {
+  for (i=start_addr; i < (start_addr + size);) {
+    if (i % NAND_BLOCK_SIZE == 0) {
+      if (is_bad_block(i) ||
+	  is_bad_block(i + NAND_PAGE_SIZE)) {
+	orange_on(1);    
+	i += NAND_BLOCK_SIZE;
+	size += NAND_BLOCK_SIZE;
+	continue;
+      }
+    }
+    blue_on(1);
+    j = nand_read_page_ll(buf, i);
+    i += j;
+    /*    buf += j;*/
+  }
 
-		if (i % NAND_BLOCK_SIZE == 0) {
+  /* chip Disable */
-			if (is_bad_block(i) ||
+  nand_deselect();
-			    is_bad_block(i + NAND_PAGE_SIZE)) {
+  
-				/* Bad block */
+  return 0;
-				i += NAND_BLOCK_SIZE;
-				size += NAND_BLOCK_SIZE;
-				continue;
-			}
-		}
-
-		j = nand_read_page_ll(buf, i);
-		i += j;
-		buf += j;
-	}
-
-	/* chip Disable */
-	nand_deselect();
-
-	return 0;
 }
 

qiboot/src/start_kboot.c

@@ -38,19 +38,15 @@ unsigned char buf[2048];
 
 int start_kboot()
 {
-    if(nand_read_ll(buf, 0x32000000, sizeof(buf))==-1) {
+  if(nand_read_ll(buf, 0x32000000, sizeof(buf))==-1) 
-	blink_led();
+    {
+      while(1){blink_led(1);}
     }
 
-  /* 
-     void (*fp)(void)=(void (*)(void))&buf;
-     (fp)();
-  */
-
   asm volatile("mov pc, %0\n"
        :              /* output */
        :"r"(ADDR)     /* input */
        );    
+
   return 0;
 }
-