| /* |
| * jedec.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 <stdio.h> |
| #include "flash.h" |
| #include "jedec.h" |
| |
| int probe_jedec(struct flashchip *flash) |
| { |
| volatile unsigned char *bios = flash->virt_addr; |
| unsigned char id1, id2; |
| |
| /* 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 1; |
| |
| return 0; |
| } |
| |
| int erase_sector_jedec(volatile unsigned char *bios, unsigned int page) |
| { |
| volatile unsigned char *Temp; |
| |
| /* Issue the Sector Erase command */ |
| Temp = bios + 0x5555; /* set up address to be BASE:5555h */ |
| *Temp = 0xAA; /* write data 0xAA to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x2AAA; /* set up address to be BASE:2AAAh */ |
| *Temp = 0x55; /* write data 0x55 to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x5555; /* set up address to be BASE:5555h */ |
| *Temp = 0x80; /* write data 0x80 to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x5555; /* set up address to be BASE:5555h */ |
| *Temp = 0xAA; /* write data 0xAA to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x2AAA; /* set up address to be BASE:2AAAh */ |
| *Temp = 0x55; /* write data 0x55 to the address */ |
| myusec_delay(10); |
| Temp = bios + page; /* set up address to be the current sector */ |
| *Temp = 0x30; /* write data 0x30 to the address */ |
| myusec_delay(10); |
| |
| /* wait for Toggle bit ready */ |
| toggle_ready_jedec(bios); |
| |
| return (0); |
| } |
| |
| int erase_chip_jedec(struct flashchip *flash) |
| { |
| volatile unsigned char *bios = flash->virt_addr; |
| volatile unsigned char *Temp; |
| |
| /* Issue the JEDEC Chip Erase command */ |
| Temp = bios + 0x5555; /* set up address to be BASE:5555h */ |
| *Temp = 0xAA; /* write data 0xAA to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x2AAA; /* set up address to be BASE:2AAAh */ |
| *Temp = 0x55; /* write data 0x55 to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x5555; /* set up address to be BASE:5555h */ |
| *Temp = 0x80; /* write data 0x80 to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x5555; /* set up address to be BASE:5555h */ |
| *Temp = 0xAA; /* write data 0xAA to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x2AAA; /* set up address to be BASE:2AAAh */ |
| *Temp = 0x55; /* write data 0x55 to the address */ |
| myusec_delay(10); |
| Temp = bios + 0x5555; /* set up address to be BASEy:5555h */ |
| *Temp = 0x10; /* write data 0x10 to the address */ |
| myusec_delay(10); |
| |
| toggle_ready_jedec(bios); |
| |
| return (0); |
| } |
| |
| void write_page_write_jedec(volatile unsigned char *bios, unsigned char *src, |
| volatile unsigned char *dst, int page_size) |
| { |
| int i; |
| |
| /* Issue JEDEC Data Unprotect comand */ |
| *(volatile char *) (bios + 0x5555) = 0xAA; |
| *(volatile char *) (bios + 0x2AAA) = 0x55; |
| *(volatile char *) (bios + 0x5555) = 0xA0; |
| |
| for (i = 0; i < page_size; i++) { |
| /* transfer data from source to destination */ |
| *dst++ = *src++; |
| } |
| |
| usleep(100); |
| toggle_ready_jedec(dst - 1); |
| } |
| |
| int write_byte_program_jedec(volatile unsigned char *bios, unsigned char *src, |
| volatile unsigned char *dst) |
| { |
| volatile unsigned char *Temp; |
| |
| /* transfer data from source to destination */ |
| if (*src == 0xFF) { |
| /* If the data is 0xFF, don't program it */ |
| return 0; |
| } |
| /* Issue JEDEC Byte Program command */ |
| Temp = bios + 0x5555; |
| *Temp = 0xAA; |
| Temp = bios + 0x2AAA; |
| *Temp = 0x55; |
| Temp = bios + 0x5555; |
| *Temp = 0xA0; |
| *dst = *src; |
| toggle_ready_jedec(bios); |
| |
| return 0; |
| } |
| |
| int write_sector_jedec(volatile unsigned char *bios, unsigned char *src, |
| volatile unsigned char *dst, unsigned int page_size) |
| { |
| int i; |
| |
| for (i = 0; i < page_size; i++) { |
| write_byte_program_jedec(bios, src, dst); |
| dst++, src++; |
| } |
| |
| return (0); |
| } |
| |
| int write_jedec(struct flashchip *flash, unsigned char *buf) |
| { |
| int i; |
| int total_size = flash->total_size * 1024; |
| int page_size = flash->page_size; |
| volatile unsigned char *bios = flash->virt_addr; |
| |
| erase_chip_jedec(flash); |
| if (*bios != (unsigned char) 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_write_jedec(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_jedec(bios); |
| |
| return (0); |
| } |