git.gag.com Git - fw/openalt/blob - i2c/eeprom_working.c

   1 #include "FreeRTOS.h"
   2
   3 #include <string.h>
   4
   5 #include "i2c.h"
   6 #include "eeprom.h"
   7
   8 //
   9 //
  10 //
  11 static U32 rwAddress;
  12 static U8 deviceAddress = EEPROM_ADDRESS;
  13
  14 //
  15 //
  16 //
  17 void eepromInit (void)
  18 {
  19 }
  20
  21 int eepromSetAddress (U32 address)
  22 {
  23   int r = 0;
  24
  25   if (address >= EEPROM_SIZE)
  26     r = -1;
  27
  28   address %= EEPROM_SIZE;
  29
  30   if ((rwAddress = address) >= 65536)
  31     deviceAddress |= 0x02;
  32   else
  33     deviceAddress &= ~0x02;
  34
  35   return r;
  36 }
  37
  38 static int eepromSetAddressEx (U32 address, U8 *buffer)
  39 {
  40   int r;
  41
  42   if ((r = eepromSetAddress (address)))
  43     return r;
  44
  45   buffer [0] = rwAddress >> 8;
  46   buffer [1] = rwAddress;
  47
  48   return 0;
  49 }
  50
  51 U32 eepromGetAddress (void)
  52 {
  53   return rwAddress;
  54 }
  55
  56 //
  57 //
  58 //
  59 int eepromRead (U8 *buffer, U32 bufferLength)
  60 {
  61   int r;
  62
  63   buffer [0] = rwAddress >> 8;
  64   buffer [1] = rwAddress;
  65
  66   if (!(r = i2cWriteReadBuffer (deviceAddress, buffer, sizeof (U16), bufferLength)))
  67     eepromSetAddress (eepromGetAddress () + bufferLength);
  68
  69   return r;
  70 }
  71
  72 int eepromReadAddress (U32 address, U8 *buffer, U32 bufferLength)
  73 {
  74   int r;
  75
  76   if ((r = eepromSetAddress (address)))
  77     return r;
  78
  79   return eepromRead (buffer, bufferLength);
  80 }
  81
  82 //
  83 //
  84 //
  85 int eepromWrite (U8 *buffer, U32 bufferLength)
  86 {
  87   int r;
  88
  89   buffer [0] = rwAddress >> 8;
  90   buffer [1] = rwAddress;
  91
  92   if (!(r = i2cWriteBuffer (deviceAddress, buffer, bufferLength + 2)))
  93     eepromSetAddress (eepromGetAddress () + bufferLength);
  94
  95   return r;
  96 }
  97
  98 int eepromWriteAddress (U32 address, U8 *buffer, U32 bufferLength)
  99 {
 100   int r;
 101
 102   if ((r = eepromSetAddress (address)))
 103     return r;
 104
 105   return eepromWrite (buffer, bufferLength);
 106 }
 107
 108 //
 109 //
 110 //
 111 int eepromFillAddress (U32 address, U32 bufferLength, U8 fillValue)
 112 {
 113   int r;
 114   U32 l;
 115   U32 i;
 116   U8 buffer [EEPROM_PAGESIZE + 2];
 117
 118   memset (buffer, fillValue, sizeof (buffer));
 119
 120   l = (EEPROM_PAGESIZE - ((address + EEPROM_PAGESIZE) % EEPROM_PAGESIZE)) % EEPROM_PAGESIZE;
 121   l = MIN (l, bufferLength);
 122
 123   if (l)
 124   {
 125     if ((r = eepromSetAddressEx (address, buffer)))
 126       return r;
 127
 128     if ((r = i2cWriteBuffer (deviceAddress, buffer, l + 2)))
 129       return r;
 130   }
 131
 132   address += l;
 133   bufferLength -= l;
 134   l = bufferLength - (bufferLength % EEPROM_PAGESIZE);
 135
 136   for (i = 0; i < l; i += EEPROM_PAGESIZE, address += (sizeof (buffer) - 2), bufferLength -= (sizeof (buffer) - 2))
 137   {
 138     if ((r = eepromSetAddressEx (address, buffer)))
 139       return r;
 140
 141     if ((r = i2cWriteBuffer (deviceAddress, buffer, sizeof (buffer))))
 142       return r;
 143   }
 144
 145   if (bufferLength)
 146   {
 147     if ((r = eepromSetAddressEx (address, buffer)))
 148       return r;
 149
 150     if ((r = i2cWriteBuffer (deviceAddress, buffer, bufferLength + 2)))
 151       return r;
 152   }
 153
 154   return 0;
 155 }
 156