1
0
mirror of git://projects.qi-hardware.com/xburst-tools.git synced 2024-11-25 17:55:55 +02:00

fix-nand.patch

NAND stuff wasn't going to do anything until the controller in
the CPU was reset.  NAND code was cleaned and other minor meddlings

Signed-off-by: Andy Green <andy@openmoko.com>
This commit is contained in:
Andy Green 2008-08-13 00:42:35 +01:00
parent fdb05a1e8b
commit f26f60b0ac
6 changed files with 263 additions and 43 deletions

View File

@ -35,6 +35,7 @@ SECTIONS
src/start.o (.text)
src/lowlevel_init.o(.text)
src/start_kboot.o (.text)
src/start_kboot.o (.rodata)
*(.text)
*(.rodata)
}

View File

@ -19,6 +19,9 @@
* MA 02111-1307 USA
*/
/* NOTE this stuff runs in steppingstone context! */
/*
* #include <config.h>
* #include <version.h>

View File

@ -15,7 +15,11 @@
* Author: Harald Welte <laforge@openmoko.org>
*/
/* NOTE this stuff runs in steppingstone context! */
#include "nand_read.h"
#include "kboot.h"
#define NAND_CMD_READ0 0
#define NAND_CMD_READSTART 0x30
@ -67,6 +71,14 @@ static int is_bad_block(unsigned long i)
NFCMD = NAND_CMD_READSTART;
nand_wait();
data = (NFDATA & 0xff);
#ifdef DEBUG
serial_putc(2, '$');
serial_putc(2, '0');
serial_putc(2, 'x');
print32((unsigned int)data);
serial_putc(2, ' ');
#endif
if (data != 0xff)
return 1;
@ -103,38 +115,65 @@ 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 bad_count = 0;
int i, j;
int bad_count = 0;
if ((start_addr & NAND_BLOCK_MASK) || (size & NAND_BLOCK_MASK))
return -1; /* invalid alignment */
if ((start_addr & NAND_BLOCK_MASK) || (size & NAND_BLOCK_MASK))
return -1; /* invalid alignment */
/* chip Enable */
nand_select();
nand_clear_RnB();
for (i=0; i<10; i++);
/* chip Enable */
nand_select();
nand_clear_RnB();
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)) {
i += NAND_BLOCK_SIZE;
size += NAND_BLOCK_SIZE;
if(bad_count++ == 4) {
return -1;
for (i = 0; i < 10; i++)
;
for (i = start_addr; i < (start_addr + size);) {
#ifdef DEBUG
serial_putc(2, 'i');
serial_putc(2, '0');
serial_putc(2, 'x');
print32((unsigned int)i);
serial_putc(2, ' ');
#endif
if (i % NAND_BLOCK_SIZE == 0) {
if (is_bad_block(i) ||
is_bad_block(i + NAND_PAGE_SIZE)) {
#ifdef DEBUG
serial_putc(2, '?');
#endif
i += NAND_BLOCK_SIZE;
size += NAND_BLOCK_SIZE;
if (bad_count++ == 4) {
#ifdef DEBUG
serial_putc(2, '+');
serial_putc(2, '\n');
#endif
return -1;
}
serial_putc(2, '\n');
continue;
}
}
j = nand_read_page_ll(buf, i);
#ifdef DEBUG
serial_putc(2, 'j');
serial_putc(2, '0');
serial_putc(2, 'x');
print32((unsigned int)j);
serial_putc(2, ' ');
#endif
i += j;
buf += j;
#if DEBUG
serial_putc(2, '\n');
#endif
}
continue;
}
}
j = nand_read_page_ll(buf, i);
i += j;
/* buf += j;*/
}
/* chip Disable */
nand_deselect();
/* chip Disable */
nand_deselect();
return 0;
return 0;
}

154
qiboot/src/phase2.c Normal file
View File

@ -0,0 +1,154 @@
#include "kboot.h"
#include <neo_gta02.h>
#include "blink_led.h"
#include <string.h>
#define __ARM__
#include <image.h>
#define u32 unsigned int
#define u16 unsigned short
#define u8 unsigned char
typedef unsigned int uint32_t;
#include <setup.h>
#include "nand_read.h"
/* See also ARM920T Technical reference Manual */
#define C1_MMU (1<<0) /* mmu off/on */
#define C1_ALIGN (1<<1) /* alignment faults off/on */
#define C1_DC (1<<2) /* dcache off/on */
#define C1_BIG_ENDIAN (1<<7) /* big endian off/on */
#define C1_SYS_PROT (1<<8) /* system protection */
#define C1_ROM_PROT (1<<9) /* ROM protection */
#define C1_IC (1<<12) /* icache off/on */
#define C1_HIGH_VECTORS (1<<13) /* location of vectors: low/high addresses */
size_t strlen(const char *s)
{
size_t n = 0;
while (*s++)
n++;
return n;
}
char *strcpy(char *dest, const char *src)
{
char * dest_orig = dest;
while (*src)
*dest++ = *src++;
return dest_orig;
}
unsigned int _ntohl(unsigned int n) {
return ((n & 0xff) << 24) | ((n & 0xff00) << 8) |
((n & 0xff0000) >> 8) | ((n & 0xff000000) >> 24);
}
void bootloader_second_phase(void)
{
image_header_t *hdr;
unsigned long i = 0;
int machid = 1304; /* GTA02 */
void (*theKernel)(int zero, int arch, uint params);
struct tag * params_base = (struct tag *)0x30000100; /* atags need to live here */
struct tag *params = params_base;
const char * cmdline = "rootfstype=ext2 root=/dev/mmcblk0p1 console=ttySAC2,115200 loglevel=8 init=/sbin/init ro";
const char *p = cmdline;
void * kernel_nand = (void *)(TEXT_BASE - 4 * 1024 * 1024);
puts("Checking kernel... ");
if (nand_read_ll(kernel_nand, 0x80000, 4096) < 0) {
puts ("Kernel header read failed\n");
goto unhappy;
}
hdr = (image_header_t *)kernel_nand;
if (_ntohl(hdr->ih_magic) != IH_MAGIC) {
puts("Unknown image magic ");
print32(hdr->ih_magic);
goto unhappy;
}
puts((const char *)hdr->ih_name);
puts("Fetching kernel...");
if (nand_read_ll(kernel_nand, 0x80000, ((32 * 1024) +
(_ntohl(hdr->ih_size) +
sizeof(hdr) + 2048)) &
~(2048 - 1)) < 0) {
puts ("Kernel body read failed\n");
goto unhappy;
}
puts(" Done");
theKernel = (void (*)(int, int, uint))
(((char *)hdr) + sizeof(image_header_t));
/* first tag */
params->hdr.tag = ATAG_CORE;
params->hdr.size = tag_size (tag_core);
params->u.core.flags = 0;
params->u.core.pagesize = 0;
params->u.core.rootdev = 0;
params = tag_next (params);
/* revision tag */
params->hdr.tag = ATAG_REVISION;
params->hdr.size = tag_size (tag_revision);
params->u.revision.rev = 0x350;
params = tag_next (params);
/* memory tags */
params->hdr.tag = ATAG_MEM;
params->hdr.size = tag_size (tag_mem32);
params->u.mem.start = 0x30000000;
params->u.mem.size = 128 * 1024 * 1024;
params = tag_next (params);
/* kernel commandline */
/* eat leading white space */
for (p = cmdline; *p == ' '; p++);
if (*p) {
params->hdr.tag = ATAG_CMDLINE;
params->hdr.size =
(sizeof (struct tag_header) + strlen (p) + 1 + 4) >> 2;
strcpy (params->u.cmdline.cmdline, p);
params = tag_next (params);
}
/* needs to always be the last tag */
params->hdr.tag = ATAG_NONE;
params->hdr.size = 0;
puts ("Running Linux...\n\n");
/* trash the cache */
/* turn off I/D-cache */
asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
i &= ~(C1_DC | C1_IC);
asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
/* flush I/D-cache */
i = 0;
asm ("mcr p15, 0, %0, c7, c7, 0": :"r" (i));
/* ooh that's it, we're gonna try boot this image! */
theKernel(0, machid, (unsigned int)params_base);
/* that didn't quite pan out */
unhappy:
while (1)
blue_on(1);
}

View File

@ -140,6 +140,19 @@ start_code:
str r1, [r0, #0x28] */
bl cpu_init_crit
/* reset nand controller, or it is dead to us */
mov r1, #0x4E000000
ldr r2, =0xfff0 @ initial value tacls=3,rph0=7,rph1=7
ldr r3, [r1, #0]
orr r3, r3, r2
str r3, [r1, #0]
ldr r3, [r1, #4]
orr r3, r3, #1 @ enable nand controller
str r3, [r1, #4]
/* >> CFG_VIDEO_LOGO_MAX_SIZE */
#define CFG_GBL_DATA_SIZE 128 /* size in bytes reserved for initial data */
stack_setup:

View File

@ -19,9 +19,15 @@
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
* MA 02111-1307 USA
*/
/* NOTE this stuff runs in steppingstone context! */
#include "blink_led.h"
#include "nand_read.h"
#include "kboot.h"
#include <neo_gta02.h>
/*
unsigned char buf[]={
0x0d,0xc0,0xa0,0xe1,0x00,0xd8,0x2d,0xe9,0x04,0xb0,0x4c,0xe2,0x4c,0x20,0x9f,0xe5,
@ -33,21 +39,20 @@ unsigned char buf[]={
0x10,0x00,0x00,0x56,0x18,0x00,0x00,0x56,0xff,0xff,0x00,0x00,0x14,0x00,0x00,0x56,
0x01,0x00,0x50,0xe2,0xfd,0xff,0xff,0x1a,0x0e,0xf0,0xa0,0xe1,0x0a};
*/
unsigned char buf[2*1024];
#define ADDR ((volatile unsigned *)&buf)
#define stringify(x) #x
static char * hello = "hello";
extern void bootloader_second_phase(void);
int start_kboot(void)
void start_kboot(void)
{
static int n = 0;
void (*p)(unsigned int) = print32;
void (*phase2)(void) = bootloader_second_phase + TEXT_BASE;
port_init();
serial_init(0x11, UART2);
puts("Openmoko KBOOT BUILD_HOST BUILD_VERSION BUILD_DATE\n");
#if 0
while(1) {
serial_putc(2, '0');
serial_putc(2, 'x');
@ -63,21 +68,26 @@ int start_kboot(void)
serial_putc(2, '\n');
// printk("Openmoko KBOOT "stringify(BUILD_HOST)" "stringify(BUILD_VERSION)" "stringify(BUILD_DATE)"\n");
blue_on(1);
n++;
}
/*2. test nand flash */
if(nand_read_ll(buf, 0x000, sizeof(buf))==-1)
#endif
/*
* pull the whole U-Boot image into SDRAM
*/
if (nand_read_ll((unsigned char *)TEXT_BASE, 0, 256 * 1024) < 0)
while(1)
blink_led();
asm volatile("mov pc, %0\n"
: /* output */
:"r"(ADDR) /* input */
);
serial_putc(2, '0');
serial_putc(2, 'x');
print32((unsigned int)bootloader_second_phase);
serial_putc(2, ' ');
serial_putc(2, '\n');
return 0;
(phase2)();
}