/* * (C) Copyright 2001 * Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com * * See file CREDITS for list of people who contributed to this * project. * * 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., 59 Temple Place, Suite 330, Boston, * MA 02111-1307 USA * */#include <common.h>#include <command.h>#define EEPROM_CAP              0x50000358#define EEPROM_DATA             0x5000035cunsigned int eepromReadLong(int offs){  unsigned int value;  volatile unsigned short ret;  int count;  *(unsigned short *)EEPROM_CAP = offs;  count = 0;  for (;;)    {      count++;      ret = *(unsigned short *)EEPROM_CAP;      if ((ret & 0x8000) != 0)	break;    }  value = *(unsigned long *)EEPROM_DATA;  return value;}unsigned char eepromReadByte(int offs){  unsigned int valueLong;  unsigned char *ptr;  valueLong = eepromReadLong(offs & ~3);  ptr = (unsigned char *)&valueLong;  return ptr[offs & 3];}void eepromWriteLong(int offs, unsigned int value){  volatile unsigned short ret;  int count;  count = 0;  *(unsigned long *)EEPROM_DATA = value;  *(unsigned short *)EEPROM_CAP = 0x8000 + offs;  for (;;)    {      count++;      ret = *(unsigned short *)EEPROM_CAP;      if ((ret & 0x8000) == 0)	break;    }}void eepromWriteByte(int offs, unsigned char valueByte){  unsigned int valueLong;  unsigned char *ptr;  valueLong = eepromReadLong(offs & ~3);  ptr = (unsigned char *)&valueLong;  ptr[offs & 3] = valueByte;  eepromWriteLong(offs & ~3, valueLong);}void i2c_read (uchar *addr, int alen, uchar *buffer, int len){  int i;  int len2, ptr;  /*  printf("\naddr=%x alen=%x buffer=%x len=%x", addr[0], addr[1], *(short *)addr, alen, buffer, len); /###* test-only */  ptr = *(short *)addr;  /*   * Read till lword boundary   */  len2 = 4 - (*(short *)addr & 0x0003);  for (i=0; i<len2; i++)    {      *buffer++ = eepromReadByte(ptr++);    }  /*   * Read all lwords   */  len2 = (len - len2) >> 2;  for (i=0; i<len2; i++)    {      *(unsigned int *)buffer = eepromReadLong(ptr);      buffer += 4;      ptr += 4;    }  /*   * Read last bytes   */  len2 = (*(short *)addr + len) & 0x0003;  for (i=0; i<len2; i++)    {      *buffer++ = eepromReadByte(ptr++);    }}void i2c_write (uchar *addr, int alen, uchar *buffer, int len){  int i;  int len2, ptr;  /*  printf("\naddr=%x alen=%x buffer=%x len=%x", addr[0], addr[1], *(short *)addr, alen, buffer, len); /###* test-only */  ptr = *(short *)addr;  /*   * Write till lword boundary   */  len2 = 4 - (*(short *)addr & 0x0003);  for (i=0; i<len2; i++)    {      eepromWriteByte(ptr++, *buffer++);    }  /*   * Write all lwords   */  len2 = (len - len2) >> 2;  for (i=0; i<len2; i++)    {      eepromWriteLong(ptr, *(unsigned int *)buffer);      buffer += 4;      ptr += 4;    }  /*   * Write last bytes   */  len2 = (*(short *)addr + len) & 0x0003;  for (i=0; i<len2; i++)    {      eepromWriteByte(ptr++, *buffer++);    }}