util/flashrom/w39v040c.c

   1 /*
   2  * This file is part of the flashrom project.
   3  *
   4  * Copyright (C) 2008 Peter Stuge <peter@stuge.se>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  19  */
  20
  21 #include <stdio.h>
  22 #include "flash.h"
  23
  24 int probe_w39v040c(struct flashchip *flash)
  25 {
  26         volatile uint8_t *bios = flash->virtual_memory;
  27         uint8_t id1, id2, lock;
  28
  29         *(volatile uint8_t *)(bios + 0x5555) = 0xAA;
  30         myusec_delay(10);
  31         *(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
  32         myusec_delay(10);
  33         *(volatile uint8_t *)(bios + 0x5555) = 0x90;
  34         myusec_delay(10);
  35
  36         id1 = *(volatile uint8_t *)bios;
  37         id2 = *(volatile uint8_t *)(bios + 1);
  38         lock = *(volatile uint8_t *)(bios + 0xfff2);
  39
  40         *(volatile uint8_t *)(bios + 0x5555) = 0xAA;
  41         myusec_delay(10);
  42         *(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
  43         myusec_delay(10);
  44         *(volatile uint8_t *)(bios + 0x5555) = 0xF0;
  45         myusec_delay(40);
  46
  47         printf_debug("%s: id1 0x%x, id2 0x%x", __func__, id1, id2);
  48         if (!oddparity(id1))
  49                 printf_debug(", id1 parity violation");
  50         printf_debug("\n");
  51         if (flash->manufacture_id == id1 && flash->model_id == id2) {
  52                 printf("%s: Boot block #TBL is %slocked, rest of chip #WP is %slocked.\n",
  53                         __func__, lock & 0x4 ? "" : "un", lock & 0x8 ? "" : "un");
  54                 return 1;
  55         }
  56
  57         return 0;
  58 }
  59
  60 int erase_w39v040c(struct flashchip *flash)
  61 {
  62         int i;
  63         unsigned int total_size = flash->total_size * 1024;
  64         volatile uint8_t *bios = flash->virtual_memory;
  65
  66         for (i = 0; i < total_size; i += flash->page_size)
  67                 erase_sector_jedec(flash->virtual_memory, i);
  68
  69         for (i = 0; i < total_size; i++)
  70                 if (0xff != bios[i]) {
  71                         printf("ERASE FAILED at 0x%08x!  Expected=0xff, Read=0x%02x\n", i, bios[i]);
  72                         return -1;
  73                 }
  74
  75         return 0;
  76 }
  77
  78 int write_w39v040c(struct flashchip *flash, uint8_t *buf)
  79 {
  80         int i;
  81         int total_size = flash->total_size * 1024;
  82         int page_size = flash->page_size;
  83         volatile uint8_t *bios = flash->virtual_memory;
  84
  85         if (flash->erase(flash))
  86                 return -1;
  87
  88         printf("Programming page: ");
  89         for (i = 0; i < total_size / page_size; i++) {
  90                 printf("%04d at address: 0x%08x", i, i * page_size);
  91                 write_sector_jedec(bios, buf + i * page_size,
  92                                    bios + i * page_size, page_size);
  93                 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");
  94         }
  95         printf("\n");
  96
  97         return 0;
  98 }