diff options
Diffstat (limited to 'sst_fwhub.c')
| -rw-r--r-- | sst_fwhub.c | 178 |
1 files changed, 178 insertions, 0 deletions
diff --git a/sst_fwhub.c b/sst_fwhub.c new file mode 100644 index 0000000..7ab6bdb --- /dev/null +++ b/sst_fwhub.c @@ -0,0 +1,178 @@ +/* + * adapted from the Intel FW hub stuff for 82802ax 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. + * + * + * $Id$ + */ + +#include <errno.h> +#include <fcntl.h> +#include <sys/mman.h> +#include <sys/io.h> +#include <unistd.h> +#include <stdio.h> +#include <stdlib.h> + +#include "flash.h" +#include "jedec.h" +#include "sst_fwhub.h" + +// I need that Berkeley bit-map printer +void print_sst_fwhub_status(unsigned char status) +{ + printf("%s", status & 0x80 ? "Ready:" : "Busy:"); + printf("%s", status & 0x40 ? "BE SUSPEND:" : "BE RUN/FINISH:"); + printf("%s", status & 0x20 ? "BE ERROR:" : "BE OK:"); + printf("%s", status & 0x10 ? "PROG ERR:" : "PROG OK:"); + printf("%s", status & 0x8 ? "VP ERR:" : "VPP OK:"); + printf("%s", status & 0x4 ? "PROG SUSPEND:" : "PROG RUN/FINISH:"); + printf("%s", status & 0x2 ? "WP|TBL#|WP#,ABORT:" : "UNLOCK:"); +} + +/* probe_jedec works fine for probing */ + +int probe_sst_fwhub(struct flashchip *flash) +{ + volatile unsigned char *bios = flash->virt_addr; + unsigned char id1, id2; + size_t size = flash->total_size * 1024; + /* Issue JEDEC Product ID Entry command */ + *(volatile char *) (bios + 0x5555) = 0xAA; + myusec_delay(10); + *(volatile char *) (bios + 0x2AAA) = 0x55; + myusec_delay(10); + *(volatile char *) (bios + 0x5555) = 0x90; + myusec_delay(10); + + /* Read product ID */ + id1 = *(volatile unsigned char *) bios; + id2 = *(volatile unsigned char *) (bios + 0x01); + + /* Issue JEDEC Product ID Exit command */ + *(volatile char *) (bios + 0x5555) = 0xAA; + myusec_delay(10); + *(volatile char *) (bios + 0x2AAA) = 0x55; + myusec_delay(10); + *(volatile char *) (bios + 0x5555) = 0xF0; + myusec_delay(10); + + printf("%s: id1 0x%x, id2 0x%x\n", __FUNCTION__, id1, id2); + if (id1 != flash->manufacture_id || id2 != flash->model_id) + return 0; + + myusec_delay(10); + + + + // we need to mmap the write-protect space. + bios = mmap(0, size, PROT_WRITE | PROT_READ, MAP_SHARED, + flash->fd_mem, (off_t) (0 - 0x400000 - size)); + if (bios == MAP_FAILED) { + // it's this part but we can't map it ... + perror("Error MMAP /dev/mem"); + exit(1); + } + + flash->virt_addr_2 = bios; + return 1; +} + +unsigned char wait_sst_fwhub(volatile unsigned char *bios) +{ + + + + toggle_ready_jedec(bios); + return 0; +} + +int erase_sst_fwhub_block(struct flashchip *flash, int offset) +{ + volatile unsigned char *bios = flash->virt_addr + offset; + volatile unsigned char *wrprotect = + flash->virt_addr_2 + offset + 2; + unsigned char status; + + // clear status register + printf("Erase at %p\n", bios); + // clear write protect + printf("write protect is at %p\n", (wrprotect)); + printf("write protect is 0x%x\n", *(wrprotect)); + *(wrprotect) = 0; + printf("write protect is 0x%x\n", *(wrprotect)); + + erase_block_jedec(flash->virt_addr, offset); + status = wait_sst_fwhub(flash->virt_addr); + //print_sst_fwhub_status(status); + printf("DONE BLOCK 0x%x\n", offset); + return (0); +} + +int erase_sst_fwhub(struct flashchip *flash) +{ + int i; + unsigned int total_size = flash->total_size * 1024; + + printf("total_size is %d; flash->page_size is %d\n", + total_size, flash->page_size); + for (i = 0; i < total_size; i += flash->page_size) + erase_sst_fwhub_block(flash, i); + printf("DONE ERASE\n"); + return (0); +} + +void write_page_sst_fwhub(volatile char *bios, char *src, volatile char *dst, + int page_size) +{ + int i; + + for (i = 0; i < page_size; i++) { + /* transfer data from source to destination */ + write_byte_program_jedec(bios, src, dst); + src++; + dst++; + } + +} + +int write_sst_fwhub(struct flashchip *flash, unsigned char *buf) +{ + int i; + int total_size = flash->total_size * 1024, page_size = + flash->page_size; + volatile unsigned char *bios = flash->virt_addr; + + erase_sst_fwhub(flash); + if (*bios != 0xff) { + printf("ERASE FAILED\n"); + return -1; + } + printf("Programming Page: "); + for (i = 0; i < total_size / page_size; i++) { + printf("%04d at address: 0x%08x", i, i * page_size); + write_page_sst_fwhub(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("\n"); + protect_sst_fwhub(bios); + return (0); +} |
