mirror of
git://projects.qi-hardware.com/iris.git
synced 2025-04-21 12:27:27 +03:00
booting from nand works
This commit is contained in:
Bas Wijnen
269
source/nand.ccp
269
source/nand.ccp
@@ -16,74 +16,29 @@
|
||||
// You should have received a copy of the GNU General Public License
|
||||
// along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
|
||||
#define DELAY Iris::schedule
|
||||
|
||||
#include "devices.hh"
|
||||
#define ARCH
|
||||
#include "arch.hh"
|
||||
#define debug Iris::debug
|
||||
#include "nand.hh"
|
||||
|
||||
// The following defines are taken from mtd/nand.h in the Linux source.
|
||||
extern "C":
|
||||
extern char file_start, file_mid, file_end
|
||||
|
||||
// Standard NAND flash commands
|
||||
#define CMD_READ0 0
|
||||
#define CMD_READSTART 0x30
|
||||
Iris::Num start ():
|
||||
//kdebug ("starting nand operation in 10 seconds\n")
|
||||
//Iris::sleep (10 * HZ)
|
||||
|
||||
#define CMD_READID 0x90
|
||||
map_emc ()
|
||||
map_gpio ()
|
||||
|
||||
#define CMD_RESET 0xff
|
||||
// Arbitrary addresses where the pages are mapped.
|
||||
command = (volatile char *)0x15000
|
||||
address = (volatile char *)0x16000
|
||||
data = (volatile char *)0x17000
|
||||
|
||||
#define CMD_SEQIN 0x80
|
||||
#define CMD_PAGEPROG 0x10
|
||||
|
||||
#define CMD_ERASE1 0x60
|
||||
#define CMD_ERASE2 0xd0
|
||||
|
||||
#define CMD_RNDIN 0x85
|
||||
|
||||
#define CMD_RNDOUT 5
|
||||
#define CMD_RNDOUTSTART 0xE0
|
||||
|
||||
#define CMD_STATUS 0x70
|
||||
|
||||
// Status bits
|
||||
#define STATUS_FAIL 0x01
|
||||
#define STATUS_READY 0x40
|
||||
#define STATUS_WRITABLE 0x80
|
||||
|
||||
static volatile char *command
|
||||
static volatile char *address
|
||||
static volatile char *data
|
||||
|
||||
static unsigned page_bits
|
||||
static unsigned redundant_bits
|
||||
static unsigned block_bits
|
||||
static unsigned word_size
|
||||
|
||||
static void unbusy ():
|
||||
while !(gpio_get_port (2) & (1 << 30)):
|
||||
Iris::schedule ()
|
||||
Iris::schedule ()
|
||||
|
||||
static void addr (unsigned d):
|
||||
unbusy ()
|
||||
*address = d
|
||||
unbusy ()
|
||||
|
||||
static void cmd (unsigned d):
|
||||
unbusy ()
|
||||
*command = d
|
||||
unbusy ()
|
||||
|
||||
static void wdata (unsigned d):
|
||||
unbusy ()
|
||||
*data = d
|
||||
unbusy ()
|
||||
|
||||
static unsigned rdata ():
|
||||
unbusy ()
|
||||
unsigned ret = *data
|
||||
unbusy ()
|
||||
return ret
|
||||
|
||||
static void reset ():
|
||||
Iris::Page data_page = Iris::my_memory.create_page ()
|
||||
Iris::Page command_page = Iris::my_memory.create_page ()
|
||||
Iris::Page address_page = Iris::my_memory.create_page ()
|
||||
@@ -101,196 +56,27 @@ static void reset ():
|
||||
Iris::free_cap (command_page)
|
||||
Iris::free_cap (address_page)
|
||||
|
||||
// Set up.
|
||||
gpio_as_nand ()
|
||||
EMC_NFCSR = EMC_NFCSR_NFE1 | EMC_NFCSR_NFCE1
|
||||
|
||||
// Reset nand.
|
||||
cmd (CMD_RESET)
|
||||
|
||||
cmd (CMD_READID)
|
||||
addr (0)
|
||||
unsigned d = rdata ()
|
||||
//unsigned maker = d
|
||||
d = rdata ()
|
||||
//unsigned device = d
|
||||
d = rdata ()
|
||||
//unsigned internal_chip_number = 1 << (d & 0x3)
|
||||
//unsigned cell_type = 2 << ((d >> 2) & 0x3)
|
||||
//unsigned simultaneously_programmed_pages = 1 << ((d >> 4) & 0x3)
|
||||
//bool can_interleave_program_between_chips = d & 0x40
|
||||
//bool can_cache_program = d & 0x80
|
||||
d = rdata ()
|
||||
page_bits = 10 + (d & 3)
|
||||
Iris::debug ("page bits: %d\n", page_bits)
|
||||
redundant_bits = (d & 4 ? 4 : 3)
|
||||
Iris::debug ("redundant bits: %d\n", redundant_bits)
|
||||
block_bits = 16 + ((d >> 4) & 3)
|
||||
Iris::debug ("block bits: %d\n", block_bits)
|
||||
word_size = (d & 0x40 ? 16 : 8)
|
||||
Iris::debug ("word size: %d\n", word_size)
|
||||
//unsigned serial_access_minimum = (d & 0x80 ? 25 : 50)
|
||||
d = rdata ()
|
||||
//unsigned num_planes = 1 << ((d >> 2) & 3)
|
||||
//unsigned plane_bits = 26 + ((d >> 4) & 7)
|
||||
|
||||
static bool read (unsigned a, char *buffer):
|
||||
unsigned column = a & ((1 << page_bits) - 1)
|
||||
unsigned row = a >> page_bits
|
||||
//Iris::debug ("reading: %x/%x/%x: ", a, row, column)
|
||||
// Read oob information first.
|
||||
char error[12]
|
||||
// Spare space (starts at 1 << page_bits)
|
||||
// 0: unused
|
||||
// 2: detect valid data (at least 1 byte == 0 means valid)
|
||||
// 5: unused
|
||||
// 6: 9-byte ecc of 1st 512 bytes
|
||||
// 15: 9-byte ecc of 2nd 512 bytes
|
||||
// 24: 9-byte ecc of 3rd 512 bytes
|
||||
// 33: 9-byte ecc of 4th 512 bytes
|
||||
// 42: unused
|
||||
// 64: end of space
|
||||
unsigned col = (1 << page_bits) + 2
|
||||
cmd (CMD_READ0)
|
||||
addr (col)
|
||||
addr (col >> 8)
|
||||
addr (row)
|
||||
addr (row >> 8)
|
||||
addr (row >> 16)
|
||||
cmd (CMD_READSTART)
|
||||
bool valid = false
|
||||
for unsigned t = 0; t < 3; ++t:
|
||||
if rdata () == 0:
|
||||
valid = true
|
||||
break
|
||||
if !valid:
|
||||
return false
|
||||
col = (1 << page_bits) + 6 + 9 * (column >> 9)
|
||||
cmd (CMD_RNDOUT)
|
||||
addr (col)
|
||||
addr (col >> 8)
|
||||
cmd (CMD_RNDOUTSTART)
|
||||
for unsigned t = 0; t < 9; ++t:
|
||||
error[t] = rdata ()
|
||||
cmd (CMD_RNDOUT)
|
||||
addr (column)
|
||||
addr (column >> 8)
|
||||
cmd (CMD_RNDOUTSTART)
|
||||
EMC_NFECR = EMC_NFECR_ECCE | EMC_NFECR_RS | EMC_NFECR_RS_DECODING | EMC_NFECR_ERST
|
||||
for unsigned t = 0; t < 0x200; ++t:
|
||||
buffer[t] = rdata ()
|
||||
EMC_NFPAR (0) = ((unsigned *)error)[0]
|
||||
EMC_NFPAR (1) = ((unsigned *)error)[1]
|
||||
EMC_NFPAR (2) = error[9]
|
||||
EMC_NFECR = EMC_NFECR_ECCE | EMC_NFECR_RS | EMC_NFECR_RS_DECODING | EMC_NFECR_PRDY
|
||||
while !(EMC_NFINTS & EMC_NFINTS_DECF):
|
||||
Iris::schedule ()
|
||||
unsigned errs = (EMC_NFINTS & EMC_NFINTS_ERRCNT_MASK) >> EMC_NFINTS_ERRCNT_BIT
|
||||
for unsigned i = 0; i < errs; ++i:
|
||||
Iris::debug ("correcting %x on %x\n", EMC_NFERR (i) & 0xff, EMC_NFERR (i) >> 16)
|
||||
buffer[EMC_NFERR (i) >> 16] ^= EMC_NFERR (i) & 0xff
|
||||
|
||||
static void write (unsigned a, char *buffer):
|
||||
kdebug_line ()
|
||||
unsigned row = a >> page_bits
|
||||
kdebug_line ()
|
||||
//Iris::debug ("writing: %x/%x: ", a, row)
|
||||
cmd (CMD_SEQIN)
|
||||
kdebug_line ()
|
||||
addr (0)
|
||||
kdebug_line ()
|
||||
addr (0)
|
||||
kdebug_line ()
|
||||
addr (row)
|
||||
kdebug_line ()
|
||||
addr (row >> 8)
|
||||
kdebug_line ()
|
||||
addr (row >> 16)
|
||||
kdebug_line ()
|
||||
char ecc[4][12]
|
||||
for unsigned i = 0; i < 0x4; ++i:
|
||||
kdebug_line ()
|
||||
EMC_NFECR = EMC_NFECR_ECCE | EMC_NFECR_RS | EMC_NFECR_RS_ENCODING | EMC_NFECR_ERST
|
||||
Iris::debug ("writing data from %x\n", (unsigned)buffer + i * 0x200)
|
||||
for unsigned j = 0; j < 0x200; ++j:
|
||||
wdata (buffer[i * 0x200 + j])
|
||||
kdebug_line ()
|
||||
while !(EMC_NFINTS & EMC_NFINTS_ENCF):
|
||||
Iris::schedule ()
|
||||
kdebug_line ()
|
||||
((unsigned *)ecc[i])[0] = EMC_NFPAR (0)
|
||||
kdebug_line ()
|
||||
((unsigned *)ecc[i])[1] = EMC_NFPAR (1)
|
||||
kdebug_line ()
|
||||
ecc[i][9] = EMC_NFPAR (2)
|
||||
kdebug_line ()
|
||||
// Spare space (starts at 1 << page_bits)
|
||||
// 0: unused
|
||||
// 2: detect valid data (at least 1 byte == 0 means valid)
|
||||
// 5: unused
|
||||
// 6: 9-byte ecc of 1st 512 bytes
|
||||
// 15: 9-byte ecc of 2nd 512 bytes
|
||||
// 24: 9-byte ecc of 3rd 512 bytes
|
||||
// 33: 9-byte ecc of 4th 512 bytes
|
||||
// 42: unused
|
||||
// 64: end of space
|
||||
for unsigned i = 0; i < 6; ++i:
|
||||
wdata (0)
|
||||
kdebug_line ()
|
||||
for unsigned i = 0; i < 4; ++i:
|
||||
for unsigned j = 0; j < 9; ++j:
|
||||
wdata (ecc[i][j])
|
||||
kdebug_line ()
|
||||
cmd (CMD_PAGEPROG)
|
||||
kdebug_line ()
|
||||
Iris::debug ("nand program %d done\n", a)
|
||||
|
||||
static void erase (unsigned a):
|
||||
unsigned row = a >> page_bits
|
||||
cmd (CMD_ERASE1)
|
||||
addr (row)
|
||||
addr (row >> 8)
|
||||
addr (row >> 16)
|
||||
cmd (CMD_ERASE2)
|
||||
Iris::debug ("nand erase %d done\n", a)
|
||||
|
||||
extern "C":
|
||||
extern char file_start, file_end
|
||||
|
||||
Iris::Num start ():
|
||||
//kdebug ("starting nand operation in 10 seconds\n")
|
||||
//Iris::sleep (10 * HZ)
|
||||
map_emc ()
|
||||
map_gpio ()
|
||||
|
||||
// Arbitrary addresses where the pages are mapped.
|
||||
command = (volatile char *)0x15000
|
||||
address = (volatile char *)0x16000
|
||||
data = (volatile char *)0x17000
|
||||
|
||||
reset ()
|
||||
|
||||
|
||||
#if 0
|
||||
#if 1
|
||||
erase (0)
|
||||
kdebug_line ()
|
||||
char *source = &file_start
|
||||
kdebug_line ()
|
||||
unsigned a = 0x0000
|
||||
kdebug_line ()
|
||||
while source < &file_end:
|
||||
kdebug_line ()
|
||||
unsigned a = 0
|
||||
while source < &file_mid:
|
||||
write (a, source)
|
||||
a += 0x800
|
||||
source += 0x800
|
||||
source = &file_mid
|
||||
a = 0x4000
|
||||
while source < &file_end:
|
||||
write (a, source)
|
||||
a += 0x800
|
||||
source += 0x800
|
||||
kdebug_line ()
|
||||
#endif
|
||||
|
||||
char buffer[0x800]
|
||||
|
||||
kdebug_line ()
|
||||
char buffer[0x200]
|
||||
// Send nand contents to serial port.
|
||||
for unsigned a = 0; a < 0x2000; a += 0x200:
|
||||
for unsigned a = 0; a < 0x400; a += 0x200:
|
||||
read (a, buffer)
|
||||
for unsigned s = 0; s < 0x8; ++s:
|
||||
for unsigned t = 0; t < 0x40; ++t:
|
||||
@@ -303,9 +89,12 @@ Iris::Num start ():
|
||||
|
||||
asm volatile ("\t.set noreorder\n"
|
||||
"\t.globl file_start\n"
|
||||
"\t.globl file_mid\n"
|
||||
"\t.globl file_end\n"
|
||||
"\t.text\n"
|
||||
"file_start:\n"
|
||||
"\t.incbin \"mips/nanonote/nand-boot.raw\"\n"
|
||||
"file_mid:\n"
|
||||
"\t.incbin \"iris-sd.raw\"\n"
|
||||
"file_end:\n"
|
||||
".set reorder")
|
||||
|
||||
Reference in New Issue
Block a user