2006-02-23 18:16:44 +01:00
|
|
|
/*
|
2007-08-29 19:52:32 +02:00
|
|
|
* This file is part of the flashrom project.
|
2006-02-23 18:16:44 +01:00
|
|
|
*
|
|
|
|
* Copyright 2000 Silicon Integrated System Corporation
|
|
|
|
*
|
2007-08-29 19:52:32 +02:00
|
|
|
* 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.
|
2006-02-23 18:16:44 +01:00
|
|
|
*
|
2007-08-29 19:52:32 +02:00
|
|
|
* 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.
|
2006-02-23 18:16:44 +01:00
|
|
|
*
|
2007-08-29 19:52:32 +02:00
|
|
|
* 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
2006-02-23 18:16:44 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <stdio.h>
|
2006-03-14 20:58:14 +01:00
|
|
|
#include <stdlib.h>
|
2006-02-23 18:16:44 +01:00
|
|
|
#include "flash.h"
|
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
// I need that Berkeley bit-map printer
|
|
|
|
void print_lhf00l04_status(uint8_t status)
|
2006-02-23 18:16:44 +01:00
|
|
|
{
|
2006-03-14 20:58:14 +01:00
|
|
|
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:");
|
2006-02-23 18:16:44 +01:00
|
|
|
}
|
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
int probe_lhf00l04(struct flashchip *flash)
|
2006-02-23 18:16:44 +01:00
|
|
|
{
|
2007-05-23 19:20:56 +02:00
|
|
|
volatile uint8_t *bios = flash->virtual_memory;
|
2006-03-14 20:58:14 +01:00
|
|
|
uint8_t id1, id2;
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
#if 0
|
2007-05-23 19:20:56 +02:00
|
|
|
/* Enter ID mode */
|
2007-05-09 12:17:44 +02:00
|
|
|
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
|
|
|
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
|
|
|
*(volatile uint8_t *)(bios + 0x5555) = 0x90;
|
2006-03-14 20:58:14 +01:00
|
|
|
#endif
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
*bios = 0xff;
|
|
|
|
myusec_delay(10);
|
|
|
|
*bios = 0x90;
|
|
|
|
myusec_delay(10);
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2007-05-09 12:17:44 +02:00
|
|
|
id1 = *(volatile uint8_t *)bios;
|
|
|
|
id2 = *(volatile uint8_t *)(bios + 0x01);
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2007-05-23 19:20:56 +02:00
|
|
|
/* Leave ID mode */
|
2007-05-09 12:17:44 +02:00
|
|
|
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
|
|
|
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
|
|
|
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
2006-03-14 20:58:14 +01:00
|
|
|
|
|
|
|
myusec_delay(10);
|
|
|
|
|
|
|
|
printf_debug("%s: id1 0x%x, id2 0x%x\n", __FUNCTION__, id1, id2);
|
|
|
|
|
2007-05-24 21:17:29 +02:00
|
|
|
if (id1 != flash->manufacture_id || id2 != flash->model_id)
|
2007-05-24 10:48:10 +02:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
map_flash_registers(flash);
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2007-05-24 10:48:10 +02:00
|
|
|
return 1;
|
2006-02-23 18:16:44 +01:00
|
|
|
}
|
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
uint8_t wait_lhf00l04(volatile uint8_t *bios)
|
2006-02-23 18:16:44 +01:00
|
|
|
{
|
2006-03-14 20:58:14 +01:00
|
|
|
uint8_t status;
|
|
|
|
uint8_t id1, id2;
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
*bios = 0x70;
|
|
|
|
if ((*bios & 0x80) == 0) { // it's busy
|
2007-05-09 12:17:44 +02:00
|
|
|
while ((*bios & 0x80) == 0) ;
|
2006-03-14 20:58:14 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
status = *bios;
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
// put another command to get out of status register mode
|
|
|
|
|
|
|
|
*bios = 0x90;
|
2006-02-23 18:16:44 +01:00
|
|
|
myusec_delay(10);
|
2006-03-14 20:58:14 +01:00
|
|
|
|
2007-05-09 12:17:44 +02:00
|
|
|
id1 = *(volatile uint8_t *)bios;
|
|
|
|
id2 = *(volatile uint8_t *)(bios + 0x01);
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
// this is needed to jam it out of "read id" mode
|
2007-05-09 12:17:44 +02:00
|
|
|
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
|
|
|
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
|
|
|
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2007-08-23 18:08:21 +02:00
|
|
|
return status;
|
2006-02-23 18:16:44 +01:00
|
|
|
}
|
2007-08-23 18:08:21 +02:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
int erase_lhf00l04_block(struct flashchip *flash, int offset)
|
|
|
|
{
|
2007-05-23 19:20:56 +02:00
|
|
|
volatile uint8_t *bios = flash->virtual_memory + offset;
|
|
|
|
volatile uint8_t *wrprotect = flash->virtual_registers + offset + 2;
|
2006-03-14 20:58:14 +01:00
|
|
|
uint8_t status;
|
|
|
|
|
|
|
|
// clear status register
|
|
|
|
*bios = 0x50;
|
|
|
|
printf("Erase at %p\n", bios);
|
2007-05-23 19:20:56 +02:00
|
|
|
status = wait_lhf00l04(flash->virtual_memory);
|
2006-03-14 20:58:14 +01:00
|
|
|
print_lhf00l04_status(status);
|
|
|
|
// 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));
|
|
|
|
|
|
|
|
// now start it
|
2007-05-09 12:17:44 +02:00
|
|
|
*(volatile uint8_t *)(bios) = 0x20;
|
|
|
|
*(volatile uint8_t *)(bios) = 0xd0;
|
2006-03-14 20:58:14 +01:00
|
|
|
myusec_delay(10);
|
|
|
|
// now let's see what the register is
|
2007-05-23 19:20:56 +02:00
|
|
|
status = wait_lhf00l04(flash->virtual_memory);
|
2006-03-14 20:58:14 +01:00
|
|
|
print_lhf00l04_status(status);
|
|
|
|
printf("DONE BLOCK 0x%x\n", offset);
|
2007-08-23 18:08:21 +02:00
|
|
|
|
|
|
|
return 0;
|
2006-03-14 20:58:14 +01:00
|
|
|
}
|
2007-08-23 18:08:21 +02:00
|
|
|
|
2006-02-23 18:16:44 +01:00
|
|
|
int erase_lhf00l04(struct flashchip *flash)
|
|
|
|
{
|
2006-03-14 20:58:14 +01:00
|
|
|
int i;
|
|
|
|
unsigned int total_size = flash->total_size * 1024;
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
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_lhf00l04_block(flash, i);
|
|
|
|
printf("DONE ERASE\n");
|
2007-08-23 18:08:21 +02:00
|
|
|
|
|
|
|
return 0;
|
2006-03-14 20:58:14 +01:00
|
|
|
}
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2007-05-09 12:17:44 +02:00
|
|
|
void write_page_lhf00l04(volatile uint8_t *bios, uint8_t *src,
|
|
|
|
volatile uint8_t *dst, int page_size)
|
2006-03-14 20:58:14 +01:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < page_size; i++) {
|
|
|
|
/* transfer data from source to destination */
|
|
|
|
*dst = 0x40;
|
|
|
|
*dst++ = *src++;
|
|
|
|
wait_lhf00l04(bios);
|
|
|
|
}
|
2006-02-23 18:16:44 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
int write_lhf00l04(struct flashchip *flash, uint8_t *buf)
|
|
|
|
{
|
|
|
|
int i;
|
2007-05-09 12:17:44 +02:00
|
|
|
int total_size = flash->total_size * 1024;
|
|
|
|
int page_size = flash->page_size;
|
2007-05-23 19:20:56 +02:00
|
|
|
volatile uint8_t *bios = flash->virtual_memory;
|
2006-02-23 18:16:44 +01:00
|
|
|
|
2006-03-14 20:58:14 +01:00
|
|
|
erase_lhf00l04(flash);
|
|
|
|
if (*bios != 0xff) {
|
|
|
|
printf("ERASE FAILED\n");
|
|
|
|
return -1;
|
|
|
|
}
|
2006-02-23 18:16:44 +01:00
|
|
|
printf("Programming Page: ");
|
|
|
|
for (i = 0; i < total_size / page_size; i++) {
|
|
|
|
printf("%04d at address: 0x%08x", i, i * page_size);
|
2006-03-14 20:58:14 +01:00
|
|
|
write_page_lhf00l04(bios, buf + i * page_size,
|
2007-05-09 12:17:44 +02:00
|
|
|
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");
|
2006-02-23 18:16:44 +01:00
|
|
|
}
|
|
|
|
printf("\n");
|
2007-08-23 17:20:38 +02:00
|
|
|
protect_jedec(bios);
|
2007-08-23 18:08:21 +02:00
|
|
|
|
|
|
|
return 0;
|
2006-02-23 18:16:44 +01:00
|
|
|
}
|