Add support for ST M29F400BT - part 2
Corresponding to coreboot v1 svn r589.
diff --git a/m29f400bt.c b/m29f400bt.c
new file mode 100644
index 0000000..2011ceb
--- /dev/null
+++ b/m29f400bt.c
@@ -0,0 +1,180 @@
+/*
+ * m29f400bt.c: driver for programming JEDEC standard flash parts
+ *
+ *
+ * Copyright 2000 Silicon Integrated System Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ *
+ * Reference:
+ *
+ * $Id$
+ */
+
+#include "flash.h"
+#include "m29f400bt.h"
+
+int probe_m29f400bt (struct flashchip * flash)
+{
+ volatile char * bios = flash->virt_addr;
+ unsigned char id1, id2;
+
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0x90;
+
+ myusec_delay(10);
+
+ id1 = *(volatile unsigned char *) bios;
+ id2 = *(volatile unsigned char *) (bios + 0x02);
+
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0xF0;
+
+ myusec_delay(10);
+
+ printf(__FUNCTION__ " id1 %x, id2 %x\n", id1, id2);
+ if (id1 == flash->manufacture_id && id2 == flash->model_id)
+ return 1;
+
+ return 0;
+}
+
+int erase_m29f400bt (struct flashchip * flash)
+{
+ volatile char * bios = flash->virt_addr;
+
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0x80;
+
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0x10;
+
+ myusec_delay(10);
+ toggle_ready_m29f400bt(bios);
+}
+
+int block_erase_m29f400bt (volatile char * bios ,volatile char * dst)
+{
+
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0x80;
+
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ //*(volatile char *) (bios + 0xAAA) = 0x10;
+ *dst = 0x30;
+
+ myusec_delay(10);
+ toggle_ready_m29f400bt(bios);
+}
+
+int write_m29f400bt (struct flashchip * flash, char * buf)
+{
+ int i;
+ int total_size = flash->total_size *1024, page_size = flash->page_size;
+ volatile char * bios = flash->virt_addr;
+
+ //erase_m29f400bt (flash);
+ printf ("Programming Page:\n ");
+ /*********************************
+ *Pages for M29F400BT:
+ * 16 0x7c000 0x7ffff TOP
+ * 8 0x7a000 0x7bfff
+ * 8 0x78000 0x79fff
+ * 32 0x70000 0x77fff
+ * 64 0x60000 0x6ffff
+ * 64 0x50000 0x5ffff
+ * 64 0x40000 0x4ffff
+ *---------------------------------
+ * 64 0x30000 0x3ffff
+ * 64 0x20000 0x2ffff
+ * 64 0x10000 0x1ffff
+ * 64 0x00000 0x0ffff BOTTOM
+ *********************************/
+ printf("total_size/page_size = %d\n",total_size/page_size);
+ for (i = 0; i < (total_size/page_size)-1; i++) {
+ printf("%04d at address: 0x%08x\n", i, i * page_size);
+ block_erase_m29f400bt(bios, bios + i * page_size);
+ write_page_m29f400bt(bios, buf + i * page_size, bios + i * page_size,
+ page_size);
+ printf ("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
+ }
+
+ printf("%04d at address: 0x%08x\n",7,0x70000);
+ block_erase_m29f400bt(bios , bios + 0x70000);
+ write_page_m29f400bt(bios,buf + 0x70000, bios + 0x70000, 32*1024);
+
+ printf("%04d at address: 0x%08x\n",8,0x78000);
+ block_erase_m29f400bt(bios , bios + 0x78000);
+ write_page_m29f400bt(bios,buf + 0x78000, bios + 0x78000, 8*1024);
+
+ printf("%04d at address: 0x%08x\n",9,0x7a000);
+ block_erase_m29f400bt(bios , bios + 0x7a000);
+ write_page_m29f400bt(bios,buf + 0x7a000, bios + 0x7a000, 8*1024);
+
+ printf("%04d at address: 0x%08x\n",10,0x7c000);
+ block_erase_m29f400bt(bios , bios + 0x7c000);
+ write_page_m29f400bt(bios,buf + 0x7c000, bios + 0x7c000, 16*1024);
+
+ printf("\n");
+ //protect_m29f400bt (bios);
+}
+
+int write_linuxbios_m29f400bt (struct flashchip * flash, char * buf)
+{
+ int i;
+ volatile char * bios = flash->virt_addr;
+
+ printf ("Programming Page:\n ");
+ /*********************************
+ *Pages for M29F400BT:
+ * 16 0x7c000 0x7ffff TOP
+ * 8 0x7a000 0x7bfff
+ * 8 0x78000 0x79fff
+ * 32 0x70000 0x77fff
+ * 64 0x60000 0x6ffff
+ * 64 0x50000 0x5ffff
+ * 64 0x40000 0x4ffff
+ *---------------------------------
+ * 64 0x30000 0x3ffff
+ * 64 0x20000 0x2ffff
+ * 64 0x10000 0x1ffff
+ * 64 0x00000 0x0ffff BOTTOM
+ *********************************/
+ printf("%04d at address: 0x%08x\n",7,0x00000);
+ block_erase_m29f400bt(bios , bios + 0x00000);
+ write_page_m29f400bt(bios,buf + 0x00000, bios + 0x00000, 64*1024);
+
+ printf("%04d at address: 0x%08x\n",7,0x10000);
+ block_erase_m29f400bt(bios , bios + 0x10000);
+ write_page_m29f400bt(bios,buf + 0x10000, bios + 0x10000, 64*1024);
+
+ printf("%04d at address: 0x%08x\n",7,0x20000);
+ block_erase_m29f400bt(bios , bios + 0x20000);
+ write_page_m29f400bt(bios,buf + 0x20000, bios + 0x20000, 64*1024);
+
+ printf("%04d at address: 0x%08x\n",7,0x30000);
+ block_erase_m29f400bt(bios , bios + 0x30000);
+ write_page_m29f400bt(bios,buf + 0x30000, bios + 0x30000, 64*1024);
+
+ printf("\n");
+ //protect_m29f400bt (bios);
+}
diff --git a/m29f400bt.h b/m29f400bt.h
new file mode 100644
index 0000000..a645870
--- /dev/null
+++ b/m29f400bt.h
@@ -0,0 +1,67 @@
+extern int probe_m29f400bt (struct flashchip * flash);
+extern int erase_m29f400bt (struct flashchip * flash);
+extern int block_erase_m29f400bt (volatile char * bios, volatile char * dst);
+extern int write_m29f400bt (struct flashchip * flash, char * buf);
+extern int write_linuxbios_m29f400bt (struct flashchip * flash, char * buf);
+
+extern __inline__ void toggle_ready_m29f400bt (volatile char * dst)
+{
+ unsigned int i = 0;
+ char tmp1, tmp2;
+
+ tmp1 = *dst & 0x40;
+
+ while (i++ < 0xFFFFFF) {
+ tmp2 = *dst & 0x40;
+ if (tmp1 == tmp2) {
+ break;
+ }
+ tmp1 = tmp2;
+ }
+}
+
+extern __inline__ void data_polling_m29f400bt (volatile char * dst, char data)
+{
+ unsigned int i = 0;
+ char tmp;
+
+ data &= 0x80;
+
+ while (i++ < 0xFFFFFF) {
+ tmp = *dst & 0x80;
+ if (tmp == data) {
+ break;
+ }
+ }
+}
+
+extern __inline__ void protect_m29f400bt (volatile char * bios)
+{
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0xA0;
+
+ usleep(200);
+}
+
+extern __inline__ void write_page_m29f400bt (volatile char * bios, char * src, volatile char * dst,
+ int page_size)
+{
+ int i;
+
+ for (i = 0; i < page_size; i++) {
+ *(volatile char *) (bios + 0xAAA) = 0xAA;
+ *(volatile char *) (bios + 0x555) = 0x55;
+ *(volatile char *) (bios + 0xAAA) = 0xA0;
+
+ /* transfer data from source to destination */
+ *dst = *src;
+ //*(volatile char *) (bios) = 0xF0;
+ //usleep(5);
+ toggle_ready_m29f400bt(dst);
+ printf("Value in the flash at address %p = %#x, want %#x\n",dst-bios, *dst, *src);
+ dst++;
+ src++;
+ }
+
+}