util/flashrom/msys_doc.c

   1 /*
   2  * msys_doc.c: driver for programming m-systems doc devices
   3  *
   4  *
   5  * Copyright 2003   Niki W. Waibel <niki.waibel@gmx.net>
   6  *
   7  *      This program is free software; you can redistribute it and/or modify
   8  *      it under the terms of the GNU General Public License as published by
   9  *      the Free Software Foundation; either version 2 of the License, or
  10  *      (at your option) any later version.
  11  *
  12  *      This program is distributed in the hope that it will be useful,
  13  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *      GNU General Public License for more details.
  16  *
  17  *      You should have received a copy of the GNU General Public License
  18  *      along with this program; if not, write to the Free Software
  19  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20  */
  21
  22
  23
  24 #include <stdio.h>
  25 #include <unistd.h>
  26 #include "flash.h"
  27 #include "msys_doc.h"
  28
  29
  30
  31
  32
  33 static int doc_wait(volatile char *bios, int timeout);
  34 static unsigned char doc_read_chipid(volatile char *bios);
  35 static unsigned char doc_read_docstatus(volatile char *bios);
  36 static unsigned char doc_read_cdsncontrol(volatile char *bios);
  37 static void doc_write_cdsncontrol(volatile char *bios, unsigned char data);
  38
  39
  40
  41
  42
  43 int probe_md2802(struct flashchip *flash)
  44 {
  45         volatile char *bios = flash->virt_addr;
  46         unsigned char chipid;
  47 #ifndef MSYSTEMS_DOC_NO_55AA_CHECKING
  48         unsigned char id_0x55, id_0xAA;
  49 #endif                          /* !MSYSTEMS_DOC_NO_55AA_CHECKING */
  50         int i, toggle_a, toggle_b;
  51
  52         printf("%s:\n", __FUNCTION__);
  53         printf("%s: *******************************\n", __FUNCTION__);
  54         printf("%s: * THIS IS A PRE ALPHA VERSION *\n", __FUNCTION__);
  55         printf("%s: * IN THE DEVELOPEMENT *********\n", __FUNCTION__);
  56         printf("%s: * PROCESS RIGHT NOW. **********\n", __FUNCTION__);
  57         printf("%s: *******************************\n", __FUNCTION__);
  58         printf("%s: * IF YOU ARE NOT A DEVELOPER **\n", __FUNCTION__);
  59         printf("%s: * THEN DO NOT TRY TO READ OR **\n", __FUNCTION__);
  60         printf("%s: * WRITE TO THIS DEVICE ********\n", __FUNCTION__);
  61         printf("%s: *******************************\n", __FUNCTION__);
  62         printf("%s:\n", __FUNCTION__);
  63
  64         printf("%s: switching off reset mode ...\n", __FUNCTION__);
  65         doc_write(0x85, bios, DOCControl);
  66         doc_write(0x85, bios, DOCControl);
  67         doc_read_4nop(bios);
  68         if (doc_wait(bios, 5000))
  69                 return (-1);
  70         printf("%s: switching off reset mode ... done\n", __FUNCTION__);
  71         printf("%s:\n", __FUNCTION__);
  72
  73         printf("%s: switching off write protection ...\n", __FUNCTION__);
  74         doc_write_cdsncontrol(bios, doc_read_cdsncontrol(bios) & (~0x08));
  75         printf("%s: switching off write protection ... done\n",
  76                __FUNCTION__);
  77         printf("%s:\n", __FUNCTION__);
  78
  79
  80         chipid = doc_read_chipid(bios);
  81 #ifndef MSYSTEMS_DOC_NO_55AA_CHECKING
  82         id_0x55 = doc_read(bios, IPL_0x0000);
  83         id_0xAA = doc_read(bios, IPL_0x0001);
  84 #endif                          /* !MSYSTEMS_DOC_NO_55AA_CHECKING */
  85         printf("%s: IPL_0x0000: 0x%02x\n", __FUNCTION__, id_0x55);
  86         printf("%s: IPL_0x0001: 0x%02x\n", __FUNCTION__, id_0xAA);
  87         printf("%s: IPL_0x0002: 0x%02x\n", __FUNCTION__,
  88                doc_read(bios, IPL_0x0002));
  89         printf("%s: IPL_0x0003: 0x%02x\n", __FUNCTION__,
  90                doc_read(bios, IPL_0x0003));
  91         printf("%s:\n", __FUNCTION__);
  92         printf("%s: ChipID: 0x%02x\n", __FUNCTION__, chipid);
  93         printf("%s: DOCStatus: 0x%02x\n", __FUNCTION__,
  94                doc_read_docstatus(bios));
  95         printf("%s: FloorSelect: 0x%02x\n", __FUNCTION__,
  96                doc_read(bios, FloorSelect));
  97         printf("%s: CDSNControl: 0x%02x\n", __FUNCTION__,
  98                doc_read_cdsncontrol(bios));
  99         printf("%s: CDSNDeviceSelect: 0x%02x\n", __FUNCTION__,
 100                doc_read(bios, CDSNDeviceSelect));
 101         printf("%s: ECCConfiguration: 0x%02x\n", __FUNCTION__,
 102                doc_read(bios, ECCConfiguration));
 103         printf("%s: CDSNSlowIO: 0x%02x\n", __FUNCTION__,
 104                doc_read(bios, CDSNSlowIO));
 105         printf("%s: ECCSyndrome0: 0x%02x\n", __FUNCTION__,
 106                doc_read(bios, ECCSyndrome0));
 107         printf("%s: ECCSyndrome1: 0x%02x\n", __FUNCTION__,
 108                doc_read(bios, ECCSyndrome1));
 109         printf("%s: ECCSyndrome2: 0x%02x\n", __FUNCTION__,
 110                doc_read(bios, ECCSyndrome2));
 111         printf("%s: ECCSyndrome3: 0x%02x\n", __FUNCTION__,
 112                doc_read(bios, ECCSyndrome3));
 113         printf("%s: ECCSyndrome4: 0x%02x\n", __FUNCTION__,
 114                doc_read(bios, ECCSyndrome4));
 115         printf("%s: ECCSyndrome5: 0x%02x\n", __FUNCTION__,
 116                doc_read(bios, ECCSyndrome5));
 117         printf("%s: AliasResolution: 0x%02x\n", __FUNCTION__,
 118                doc_read(bios, AliasResolution));
 119         printf("%s: ConfigurationInput: 0x%02x\n", __FUNCTION__,
 120                doc_read(bios, ConfigurationInput));
 121         printf("%s: ReadPipelineInitialization: 0x%02x\n", __FUNCTION__,
 122                doc_read(bios, ReadPipelineInitialization));
 123         printf("%s: LastDataRead: 0x%02x\n", __FUNCTION__,
 124                doc_read(bios, LastDataRead));
 125         printf("%s:\n", __FUNCTION__);
 126
 127         printf("%s: checking ECCConfiguration toggle bit\n", __FUNCTION__);
 128         printf("%s:", __FUNCTION__);
 129         toggle_a = toggle_b = 0;
 130         for (i = 0; i < 10; i++) {
 131                 unsigned char toggle = doc_toggle(bios);
 132
 133                 printf(" 0x%02x", toggle);
 134
 135                 if (i % 2)
 136                         toggle_a += toggle;
 137                 else
 138                         toggle_b += toggle;
 139         }                       /* for(i=0; i<10; i++) */
 140         printf("\n%s: toggle result: %d/%d\n", __FUNCTION__, toggle_a,
 141                toggle_b);
 142
 143         if (chipid == flash->model_id
 144             && ((toggle_a == 5 && toggle_b == 0)
 145                 || (toggle_a == 0 && toggle_b == 5))
 146 #ifndef MSYSTEMS_DOC_NO_55AA_CHECKING
 147             && id_0x55 == 0x55 && id_0xAA == 0xaa
 148 #endif                          /* !MSYSTEMS_DOC_NO_55AA_CHECKING */
 149             ) {
 150                 return (1);
 151         }
 152
 153         return (0);
 154 }                               /* int probe_md2802(struct flashchip *flash) */
 155
 156
 157
 158 int read_md2802(struct flashchip *flash, unsigned char *buf)
 159 {
 160
 161         return (0);
 162 }                               /* int read_md2802(struct flashchip *flash, unsigned char *buf) */
 163
 164
 165
 166 int erase_md2802(struct flashchip *flash)
 167 {
 168         volatile char *bios = flash->virt_addr;
 169
 170         return (1);
 171         *(volatile char *) (bios + 0x5555) = 0xAA;
 172         *(volatile char *) (bios + 0x2AAA) = 0x55;
 173         *(volatile char *) (bios + 0x5555) = 0x80;
 174
 175         *(volatile char *) (bios + 0x5555) = 0xAA;
 176         *(volatile char *) (bios + 0x2AAA) = 0x55;
 177         *(volatile char *) (bios + 0x5555) = 0x10;
 178 }                               /* int erase_md2802(struct flashchip *flash) */
 179
 180
 181
 182 int write_md2802(struct flashchip *flash, unsigned char *buf)
 183 {
 184         int i;
 185         int total_size = flash->total_size * 1024, page_size =
 186             flash->page_size;
 187         volatile unsigned char *bios = flash->virt_addr;
 188
 189         return (1);
 190         erase_md2802(flash);
 191         if (*bios != (unsigned char) 0xff) {
 192                 printf("ERASE FAILED\n");
 193                 return -1;
 194         }
 195         printf("Programming Page: ");
 196         for (i = 0; i < total_size / page_size; i++) {
 197                 printf("%04d at address: 0x%08x", i, i * page_size);
 198                 //write_page_md2802(bios, buf + i * page_size, bios + i * page_size, page_size);
 199                 printf
 200                     ("\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");
 201         }
 202         printf("\n");
 203         //protect_md2802(bios);
 204
 205         return 0;
 206 }                               /* int write_md2802(struct flashchip *flash, char *buf) */
 207
 208
 209
 210
 211
 212
 213 /*
 214         wait timeout msec for doc to become ready
 215         return:
 216                 0: ready
 217                 -1: timeout expired
 218 */
 219 static int doc_wait(volatile char *bios, int timeout)
 220 {
 221         int i = 20;
 222
 223         doc_read_4nop(bios);
 224
 225         while (_doc_busy(bios) && (i != 0)) {
 226                 usleep(timeout * 1000 / 20);
 227                 i--;
 228         }
 229
 230         doc_read_2nop(bios);
 231
 232         if (_doc_busy(bios)) {
 233                 doc_read_2nop(bios);
 234                 return (-1);
 235         }
 236
 237         return (0);
 238 }                               /* static int doc_wait(volatile char *bios, int timeout) */
 239
 240
 241
 242 static unsigned char doc_read_docstatus(volatile char *bios)
 243 {
 244         doc_read(bios, CDSNSlowIO);
 245         doc_read_2nop(bios);
 246
 247         return (doc_read(bios, _DOCStatus));
 248 }                               /* static unsigned char doc_read_docstatus(volatile char *bios) */
 249
 250
 251
 252 static unsigned char doc_read_chipid(volatile char *bios)
 253 {
 254         doc_read(bios, CDSNSlowIO);
 255         doc_read_2nop(bios);
 256
 257         return (doc_read(bios, _ChipID));
 258 }                               /* static unsigned char doc_read_chipid(volatile char *bios) */
 259
 260
 261
 262 static unsigned char doc_read_cdsncontrol(volatile char *bios)
 263 {
 264         unsigned char value;
 265
 266         /* the delays might be necessary when reading the busy bit,
 267            but because a read to this reg reads the busy bit
 268            anyway we better do this delays... */
 269         doc_read_4nop(bios);
 270         value = doc_read(bios, _CDSNControl);
 271         doc_read_2nop(bios);
 272
 273         return (value);
 274 }                               /* static unsigned char doc_read_chipid(volatile char *bios) */
 275
 276
 277
 278 static void doc_write_cdsncontrol(volatile char *bios, unsigned char data)
 279 {
 280         doc_write(data, bios, _CDSNControl);
 281         doc_read_4nop(bios);
 282 }                               /* static void doc_write_chipid(volatile char *bios, unsigned char data) */