I2C EEProm library
Fork of eeprom by
Diff: eeprom.cpp
- Revision:
- 3:df82ebf4be54
- Parent:
- 2:c648c5e93d5e
- Child:
- 4:0f09fbac7613
--- a/eeprom.cpp Mon Oct 26 16:43:07 2015 +0000 +++ b/eeprom.cpp Sat Nov 14 14:27:06 2015 +0000 @@ -10,818 +10,807 @@ #define BIT_TEST(x,n) (x & (0x01<<n)) #define BIT_CLEAR(x,n) (x=x & ~(0x01<<n)) -EEPROM::EEPROM(PinName sda, PinName scl, uint8_t address, TypeEeprom type) : _i2c(sda, scl) +EEPROM::EEPROM(PinName sda, PinName scl, uint8_t address, TypeEeprom type) : _i2c(sda, scl) { - - _errnum = EEPROM_NoError; - _type = type; - - // Check address range - _address = address; - switch(type) { - case T24C01 : - case T24C02 : - if(address > 7) { - _errnum = EEPROM_BadAddress; - } - _address = _address << 1; - _page_write = 8; - _page_number = 1; - break; - case T24C04 : - if(address > 7) { - _errnum = EEPROM_BadAddress; - } - _address = (_address & 0xFE) << 1; - _page_write = 16; - _page_number = 2; - break; - case T24C08 : - if(address > 7) { - _errnum = EEPROM_BadAddress; - } - _address = (_address & 0xFC) << 1; - _page_write = 16; - _page_number = 4; - break; - case T24C16 : - _address = 0; - _page_write = 16; - _page_number = 8; - break; - case T24C32 : - case T24C64 : - - if(address > 7) { - _errnum = EEPROM_BadAddress; - } - - _address = _address << 1; - - - _page_write = 32; - _page_number = 1; - break; - case T24C128 : - case T24C256 : - if(address > 3) { - _errnum = EEPROM_BadAddress; - } - _address = _address << 1; - _page_write = 64; - _page_number = 1; - break; - case T24C512 : - if(address > 3) { - _errnum = EEPROM_BadAddress; - } - _address = _address << 1; - _page_write = 128; - _page_number = 1; - break; - case T24C1024 : - if(address > 7) { - _errnum = EEPROM_BadAddress; - } - _address = (_address & 0xFE) << 1; - _page_write = 128; - _page_number = 2; - break; - case T24C1025 : - if(address > 3) { - _errnum = EEPROM_BadAddress; - } - _address = _address << 1; - _page_write = 128; - _page_number = 2; - break; - } - - // Size in bytes - _size = _type; - if(_type == T24C1025) - _size = T24C1024; - - // Set I2C frequency - _i2c.frequency(100000); + + _errnum = EEPROM_NoError; + _type = type; + + // Check address range + _address = address; + switch(type) { + case T24C01 : + case T24C02 : + if(address > 7) { + _errnum = EEPROM_BadAddress; + } + _address = _address << 1; + _page_write = 8; + _page_number = 1; + break; + case T24C04 : + if(address > 7) { + _errnum = EEPROM_BadAddress; + } + _address = (_address & 0xFE) << 1; + _page_write = 16; + _page_number = 2; + break; + case T24C08 : + if(address > 7) { + _errnum = EEPROM_BadAddress; + } + _address = (_address & 0xFC) << 1; + _page_write = 16; + _page_number = 4; + break; + case T24C16 : + _address = 0; + _page_write = 16; + _page_number = 8; + break; + case T24C32 : + case T24C64 : + if(address > 7) { + _errnum = EEPROM_BadAddress; + } + _address = _address << 1; + _page_write = 32; + _page_number = 1; + break; + case T24C128 : + case T24C256 : + if(address > 3) { + _errnum = EEPROM_BadAddress; + } + _address = _address << 1; + _page_write = 64; + _page_number = 1; + break; + case T24C512 : + if(address > 3) { + _errnum = EEPROM_BadAddress; + } + _address = _address << 1; + _page_write = 128; + _page_number = 1; + break; + case T24C1024 : + if(address > 7) { + _errnum = EEPROM_BadAddress; + } + _address = (_address & 0xFE) << 1; + _page_write = 128; + _page_number = 2; + break; + case T24C1025 : + if(address > 3) { + _errnum = EEPROM_BadAddress; + } + _address = _address << 1; + _page_write = 128; + _page_number = 2; + break; + } + + // Size in bytes + _size = _type; + if(_type == T24C1025) + _size = T24C1024; + + // Set I2C frequency + _i2c.frequency(100000); } void EEPROM::write(uint16_t address, int8_t data) { - uint8_t page; - uint8_t addr; - uint8_t cmd[3]; - int len; - int ack; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address)) { - _errnum = EEPROM_OutOfRange; - return; - } - - // Compute page number - page = 0; - if(_type < T24C32) - page = (uint8_t) (address / 256); - - // Device address - addr = EEPROM_Address | _address | (page << 1); - - if(_type < T24C32) { - len = 2; - - // Word address - cmd[0] = (uint8_t) (address - page * 256); - - // Data - cmd[1] = (uint8_t) data; - } - else { - len = 3; - - // First word address (MSB) - cmd[0] = (uint8_t) (address >> 8); - - // Second word address (LSB) - cmd[1] = (uint8_t) address; - - // Data - cmd[2] = (uint8_t) data; - } - - // printf("len %d address %02x cmd[0] %02x cmd[1] %02x cmd[2] %02x\n",len,addr,cmd[0],cmd[1],cmd[2]); - - ack = _i2c.write((int)addr,(char *)cmd,len); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); + uint8_t page; + uint8_t addr; + uint8_t cmd[3]; + int len; + int ack; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address)) { + _errnum = EEPROM_OutOfRange; + return; + } + + // Compute page number + page = 0; + if(_type < T24C32) + page = (uint8_t) (address / 256); + + // Device address + addr = EEPROM_Address | _address | (page << 1); + + if(_type < T24C32) { + len = 2; + + // Word address + cmd[0] = (uint8_t) (address - page * 256); + + // Data + cmd[1] = (uint8_t) data; + } else { + len = 3; + + // First word address (MSB) + cmd[0] = (uint8_t) (address >> 8); + + // Second word address (LSB) + cmd[1] = (uint8_t) address; + + // Data + cmd[2] = (uint8_t) data; + } + +// printf("len %d address %02x cmd[0] %02x cmd[1] %02x cmd[2] %02x\n",len,addr,cmd[0],cmd[1],cmd[2]); + + ack = _i2c.write((int)addr,(char *)cmd,len); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); } void EEPROM::write(uint16_t address, int8_t data[], uint16_t length) { - uint8_t page; - uint8_t addr; - uint8_t blocs,remain; - uint8_t fpart,lpart; - uint8_t i,j,ind; - uint8_t cmd[129]; - int ack; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address)) { - _errnum = EEPROM_OutOfRange; - return; - } - - // Check length - if(!checkAddress(address + length - 1)) { - _errnum = EEPROM_OutOfRange; - return; - } - - // Compute blocs numbers - blocs = length / _page_write; - - // Compute remaining bytes - remain = length - blocs * _page_write; - - for(i = 0;i < blocs;i++) { - // Compute page number - page = 0; - if(_type < T24C32) - page = (uint8_t) (address / 256); - - // Device address - addr = EEPROM_Address | _address | (page << 1); - - if(_type < T24C32) { - // Word address - cmd[0] = (uint8_t) (address - page * 256); - - if((uint8_t) ((address + _page_write) / 256) == page) { // Data fit in the same page - // Add data - for(j = 0;j < _page_write;j++) - cmd[j + 1] = (uint8_t) data[i * _page_write + j]; - - // Write data - ack = _i2c.write((int)addr,(char *)cmd,_page_write + 1); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); - - // Increment address - address += _page_write; - } - else { // Data on 2 pages. We must split the write - // Number of bytes in current page - fpart = (page + 1) * 256 - address; - - // Add data for current page - for(j = 0;j < fpart;j++) - cmd[j + 1] = (uint8_t) data[i * _page_write + j]; - - // Write data for current page - ack = _i2c.write((int)addr,(char *)cmd,fpart + 1); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); - - // Increment address - address += fpart; - - if(page < _page_number - 1) { - // Increment page - page++; - - // Device address - addr = EEPROM_Address | _address | (page << 1); - - // Word address - cmd[0] = (uint8_t) (address - page * 256); - - // Data index - ind = i * _page_write + fpart; - - // Number of bytes in next page - lpart = _page_write - fpart; - - // Add data for next page - for(j = 0;j < lpart;j++) - cmd[j + 1] = (uint8_t) data[ind + j]; - - // Write data for next page - ack = _i2c.write((int)addr,(char *)cmd,lpart + 1); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); - - // Increment address - address += lpart; - } - } - } - else { - // First word address (MSB) - cmd[0] = (uint8_t) (address >> 8); - - // Second word address (LSB) - cmd[1] = (uint8_t) address; - - // Add data - for(j = 0;j < _page_write;j++) - cmd[j + 2] = (uint8_t) data[i * _page_write + j]; - - // Write data - ack = _i2c.write((int)addr,(char *)cmd,_page_write + 2); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); - - // Increment address - address += _page_write; - } - } - - // Compute page number - page = 0; - if(_type < T24C32) - page = (uint8_t) (address / 256); - - // Device address - addr = EEPROM_Address | _address | (page << 1); - - if(_type < T24C32) { - // Word address - cmd[0] = (uint8_t) (address - page * 256); - - if((uint8_t) ((address + remain) / 256) == page) { // Data fit in the same page - // Add data for the current page - for(j = 0;j < remain;j++) - cmd[j + 1] = (uint8_t) data[blocs * _page_write + j]; - - // Write data for the current page - ack = _i2c.write((int)addr,(char *)cmd,remain + 1); - if(ack != 0) { - _errnum = EEPROM_I2cError; + uint8_t page; + uint8_t addr; + uint8_t blocs,remain; + uint8_t fpart,lpart; + uint8_t i,j,ind; + uint8_t cmd[129]; + int ack; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address)) { + _errnum = EEPROM_OutOfRange; return; - } - - // Wait end of write - ready(); + } + + // Check length + if(!checkAddress(address + length - 1)) { + _errnum = EEPROM_OutOfRange; + return; } - else { // Data on 2 pages. We must split the write - // Number of bytes in current page - fpart = (page + 1) * 256 - address; - - // Add data for current page - for(j = 0;j < fpart;j++) - cmd[j + 1] = (uint8_t) data[blocs * _page_write + j]; - - // Write data for current page - ack = _i2c.write((int)addr,(char *)cmd,fpart + 1); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); - - // Increment address - address += fpart; - - if(page < _page_number - 1) { - // Increment page - page++; - + + // Compute blocs numbers + blocs = length / _page_write; + + // Compute remaining bytes + remain = length - blocs * _page_write; + + for(i = 0; i < blocs; i++) { + // Compute page number + page = 0; + if(_type < T24C32) + page = (uint8_t) (address / 256); + // Device address addr = EEPROM_Address | _address | (page << 1); - + + if(_type < T24C32) { + // Word address + cmd[0] = (uint8_t) (address - page * 256); + + if((uint8_t) ((address + _page_write) / 256) == page) { // Data fit in the same page + // Add data + for(j = 0; j < _page_write; j++) + cmd[j + 1] = (uint8_t) data[i * _page_write + j]; + + // Write data + ack = _i2c.write((int)addr,(char *)cmd,_page_write + 1); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + + // Increment address + address += _page_write; + } else { // Data on 2 pages. We must split the write + // Number of bytes in current page + fpart = (page + 1) * 256 - address; + + // Add data for current page + for(j = 0; j < fpart; j++) + cmd[j + 1] = (uint8_t) data[i * _page_write + j]; + + // Write data for current page + ack = _i2c.write((int)addr,(char *)cmd,fpart + 1); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + + // Increment address + address += fpart; + + if(page < _page_number - 1) { + // Increment page + page++; + + // Device address + addr = EEPROM_Address | _address | (page << 1); + + // Word address + cmd[0] = (uint8_t) (address - page * 256); + + // Data index + ind = i * _page_write + fpart; + + // Number of bytes in next page + lpart = _page_write - fpart; + + // Add data for next page + for(j = 0; j < lpart; j++) + cmd[j + 1] = (uint8_t) data[ind + j]; + + // Write data for next page + ack = _i2c.write((int)addr,(char *)cmd,lpart + 1); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + + // Increment address + address += lpart; + } + } + } else { + // First word address (MSB) + cmd[0] = (uint8_t) (address >> 8); + + // Second word address (LSB) + cmd[1] = (uint8_t) address; + + // Add data + for(j = 0; j < _page_write; j++) + cmd[j + 2] = (uint8_t) data[i * _page_write + j]; + + // Write data + ack = _i2c.write((int)addr,(char *)cmd,_page_write + 2); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + + // Increment address + address += _page_write; + } + } + + // Compute page number + page = 0; + if(_type < T24C32) + page = (uint8_t) (address / 256); + + // Device address + addr = EEPROM_Address | _address | (page << 1); + + if(_type < T24C32) { // Word address cmd[0] = (uint8_t) (address - page * 256); - - // Data index - ind = blocs * _page_write + fpart; - - // Number of bytes in next page - lpart = remain - fpart; - - // Add data for next page - for(j = 0;j < lpart;j++) - cmd[j + 1] = (uint8_t) data[ind + j]; - - // Write data for next page - ack = _i2c.write((int)addr,(char *)cmd,lpart + 1); + + if((uint8_t) ((address + remain) / 256) == page) { // Data fit in the same page + // Add data for the current page + for(j = 0; j < remain; j++) + cmd[j + 1] = (uint8_t) data[blocs * _page_write + j]; + + // Write data for the current page + ack = _i2c.write((int)addr,(char *)cmd,remain + 1); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + } else { // Data on 2 pages. We must split the write + // Number of bytes in current page + fpart = (page + 1) * 256 - address; + + // Add data for current page + for(j = 0; j < fpart; j++) + cmd[j + 1] = (uint8_t) data[blocs * _page_write + j]; + + // Write data for current page + ack = _i2c.write((int)addr,(char *)cmd,fpart + 1); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + + // Increment address + address += fpart; + + if(page < _page_number - 1) { + // Increment page + page++; + + // Device address + addr = EEPROM_Address | _address | (page << 1); + + // Word address + cmd[0] = (uint8_t) (address - page * 256); + + // Data index + ind = blocs * _page_write + fpart; + + // Number of bytes in next page + lpart = remain - fpart; + + // Add data for next page + for(j = 0; j < lpart; j++) + cmd[j + 1] = (uint8_t) data[ind + j]; + + // Write data for next page + ack = _i2c.write((int)addr,(char *)cmd,lpart + 1); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Wait end of write + ready(); + } + } + } else { + // Fist word address (MSB) + cmd[0] = (uint8_t) (address >> 8); + + // Second word address (LSB) + cmd[1] = (uint8_t) address; + + // Add data for the current page + for(j = 0; j < remain; j++) + cmd[j + 2] = (uint8_t) data[blocs * _page_write + j]; + + // Write data for the current page + ack = _i2c.write((int)addr,(char *)cmd,remain + 2); if(ack != 0) { - _errnum = EEPROM_I2cError; - return; + _errnum = EEPROM_I2cError; + return; } - + // Wait end of write ready(); - } } - } - else { - // Fist word address (MSB) - cmd[0] = (uint8_t) (address >> 8); - - // Second word address (LSB) - cmd[1] = (uint8_t) address; - // Add data for the current page - for(j = 0;j < remain;j++) - cmd[j + 2] = (uint8_t) data[blocs * _page_write + j]; - - // Write data for the current page - ack = _i2c.write((int)addr,(char *)cmd,remain + 2); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Wait end of write - ready(); - } - } void EEPROM::write(uint16_t address, int16_t data) { - int8_t cmd[2]; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + 1)) { - _errnum = EEPROM_OutOfRange; - return; - } - - memcpy(cmd,&data,2); - - write(address,cmd,2); - + int8_t cmd[2]; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + 1)) { + _errnum = EEPROM_OutOfRange; + return; + } + + memcpy(cmd,&data,2); + + write(address,cmd,2); + } void EEPROM::write(uint16_t address, int32_t data) { - int8_t cmd[4]; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + 3)) { - _errnum = EEPROM_OutOfRange; - return; - } - - memcpy(cmd,&data,4); - - write(address,cmd,4); + int8_t cmd[4]; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + 3)) { + _errnum = EEPROM_OutOfRange; + return; + } + + memcpy(cmd,&data,4); + + write(address,cmd,4); } void EEPROM::write(uint16_t address, float data) { - int8_t cmd[4]; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + 3)) { - _errnum = EEPROM_OutOfRange; - return; - } - - memcpy(cmd,&data,4); - - write(address,cmd,4); - + int8_t cmd[4]; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + 3)) { + _errnum = EEPROM_OutOfRange; + return; + } + + memcpy(cmd,&data,4); + + write(address,cmd,4); + } void EEPROM::write(uint16_t address, void *data, uint16_t size) { - int8_t *cmd = NULL; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + size - 1)) { - _errnum = EEPROM_OutOfRange; - return; - } - - cmd = (int8_t *)malloc(size); - if(cmd == NULL) { - _errnum = EEPROM_MallocError; - return; - } - - memcpy(cmd,data,size); - - write(address,cmd,size); - - free(cmd); - + int8_t *cmd = NULL; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + size - 1)) { + _errnum = EEPROM_OutOfRange; + return; + } + + cmd = (int8_t *)malloc(size); + if(cmd == NULL) { + _errnum = EEPROM_MallocError; + return; + } + + memcpy(cmd,data,size); + + write(address,cmd,size); + + free(cmd); + } void EEPROM::read(uint16_t address, int8_t& data) { - uint8_t page; - uint8_t addr; - uint8_t cmd[2]; - uint8_t len; - int ack; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address)) { - _errnum = EEPROM_OutOfRange; - return; - } - - // Compute page number - page = 0; - if(_type < T24C32) - page = (uint8_t) (address / 256); - - // Device address - addr = EEPROM_Address | _address | (page << 1); - - if(_type < T24C32) { - len = 1; - - // Word address - cmd[0] = (uint8_t) (address - page * 256); - } - else { - len = 2; - - // First word address (MSB) - cmd[0] = (uint8_t) (address >> 8); - - // Second word address (LSB) - cmd[1] = (uint8_t)address; - } - - // Write command - ack = _i2c.write((int)addr,(char *)cmd,len,true); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Read data - ack = _i2c.read((int)addr,(char *)&data,sizeof(data)); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - + uint8_t page; + uint8_t addr; + uint8_t cmd[2]; + uint8_t len; + int ack; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address)) { + _errnum = EEPROM_OutOfRange; + return; + } + + // Compute page number + page = 0; + if(_type < T24C32) + page = (uint8_t) (address / 256); + + // Device address + addr = EEPROM_Address | _address | (page << 1); + + if(_type < T24C32) { + len = 1; + + // Word address + cmd[0] = (uint8_t) (address - page * 256); + } else { + len = 2; + + // First word address (MSB) + cmd[0] = (uint8_t) (address >> 8); + + // Second word address (LSB) + cmd[1] = (uint8_t)address; + } + + // Write command + ack = _i2c.write((int)addr,(char *)cmd,len,true); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Read data + ack = _i2c.read((int)addr,(char *)&data,sizeof(data)); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + } void EEPROM::read(uint16_t address, int8_t *data, uint16_t size) { - uint8_t page; - uint8_t addr; - uint8_t cmd[2]; - uint8_t len; - int ack; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address)) { - _errnum = EEPROM_OutOfRange; - return; - } - - // Check size - if(!checkAddress(address + size - 1)) { - _errnum = EEPROM_OutOfRange; - return; - } - - // Compute page number - page = 0; - if(_type < T24C32) - page = (uint8_t) (address / 256); - - // Device address - addr = EEPROM_Address | _address | (page << 1); - - if(_type < T24C32) { - len = 1; - - // Word address - cmd[0] = (uint8_t) (address - page * 256); - } - else { - len = 2; - - // First word address (MSB) - cmd[0] = (uint8_t) (address >> 8); - - // Second word address (LSB) - cmd[1] = (uint8_t) address; - } - - // Write command - ack = _i2c.write((int)addr,(char *)cmd,len,true); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - - // Sequential read - ack = _i2c.read((int)addr,(char *)data,size); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - + uint8_t page; + uint8_t addr; + uint8_t cmd[2]; + uint8_t len; + int ack; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address)) { + _errnum = EEPROM_OutOfRange; + return; + } + + // Check size + if(!checkAddress(address + size - 1)) { + _errnum = EEPROM_OutOfRange; + return; + } + + // Compute page number + page = 0; + if(_type < T24C32) + page = (uint8_t) (address / 256); + + // Device address + addr = EEPROM_Address | _address | (page << 1); + + if(_type < T24C32) { + len = 1; + + // Word address + cmd[0] = (uint8_t) (address - page * 256); + } else { + len = 2; + + // First word address (MSB) + cmd[0] = (uint8_t) (address >> 8); + + // Second word address (LSB) + cmd[1] = (uint8_t) address; + } + + // Write command + ack = _i2c.write((int)addr,(char *)cmd,len,true); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + + // Sequential read + ack = _i2c.read((int)addr,(char *)data,size); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + } void EEPROM::read(int8_t& data) { - uint8_t addr; - int ack; - - // Check error - if(_errnum) - return; - - // Device address - addr = EEPROM_Address | _address; + uint8_t addr; + int ack; + + // Check error + if(_errnum) + return; - // Read data - ack = _i2c.read((int)addr,(char *)&data,sizeof(data)); - if(ack != 0) { - _errnum = EEPROM_I2cError; - return; - } - + // Device address + addr = EEPROM_Address | _address; + + // Read data + ack = _i2c.read((int)addr,(char *)&data,sizeof(data)); + if(ack != 0) { + _errnum = EEPROM_I2cError; + return; + } + } void EEPROM::read(uint16_t address, int16_t& data) { - int8_t cmd[2]; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + 1)) { - _errnum = EEPROM_OutOfRange; - return; - } - - read(address,cmd,2); - - memcpy(&data,cmd,2); - + int8_t cmd[2]; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + 1)) { + _errnum = EEPROM_OutOfRange; + return; + } + + read(address,cmd,2); + + memcpy(&data,cmd,2); + } void EEPROM::read(uint16_t address, int32_t& data) { - int8_t cmd[4]; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + 3)) { - _errnum = EEPROM_OutOfRange; - return; - } - - read(address,cmd,4); - - memcpy(&data,cmd,4); - + int8_t cmd[4]; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + 3)) { + _errnum = EEPROM_OutOfRange; + return; + } + + read(address,cmd,4); + + memcpy(&data,cmd,4); + } void EEPROM::read(uint16_t address, float& data) { - int8_t cmd[4]; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + 3)) { - _errnum = EEPROM_OutOfRange; - return; - } - - read(address,cmd,4); - - memcpy(&data,cmd,4); - + int8_t cmd[4]; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + 3)) { + _errnum = EEPROM_OutOfRange; + return; + } + + read(address,cmd,4); + + memcpy(&data,cmd,4); + } void EEPROM::read(uint16_t address, void *data, uint16_t size) { - int8_t *cmd = NULL; - - // Check error - if(_errnum) - return; - - // Check address - if(!checkAddress(address + size - 1)) { - _errnum = EEPROM_OutOfRange; - return; - } - - cmd = (int8_t *)malloc(size); - if(cmd == NULL) { - _errnum = EEPROM_MallocError; - return; - } - - read(address,cmd,size); - - memcpy(data,cmd,size); - - free(cmd); - + int8_t *cmd = NULL; + + // Check error + if(_errnum) + return; + + // Check address + if(!checkAddress(address + size - 1)) { + _errnum = EEPROM_OutOfRange; + return; + } + + cmd = (int8_t *)malloc(size); + if(cmd == NULL) { + _errnum = EEPROM_MallocError; + return; + } + + read(address,cmd,size); + + memcpy(data,cmd,size); + + free(cmd); + } void EEPROM::ready(void) { - int ack; - uint8_t addr; - uint8_t cmd; - - // Check error - if(_errnum) - return; - - // Device address - addr = EEPROM_Address | _address; - - cmd = 0; - /* - // Wait end of write - do { - ack = _i2c.write((int)addr,(char *)cmd,0); - } while(ack != 0); -*/ + int ack; + uint8_t addr; + uint8_t cmd; + + // Check error + if(_errnum) + return; + + // Device address + addr = EEPROM_Address | _address; + + cmd = 0; + /* + // Wait end of write + do { + ack = _i2c.write((int)addr,(char *)cmd,0); + } while(ack != 0); + */ wait_ms(5); } uint32_t EEPROM::getSize(void) { - return(_size); + return(_size); } uint8_t EEPROM::getError(void) { - return(_errnum); + return(_errnum); } bool EEPROM::checkAddress(uint16_t address) { - bool ret = true; - - switch(_type) { - case T24C01 : - if(address >= T24C01) - ret = false; - break; - case T24C02 : - if(address >= T24C02) - ret = false; - break; - case T24C04 : - if(address >= T24C04) - ret = false; - break; - case T24C08 : - if(address >= T24C08) - ret = false; - break; - case T24C16 : - if(address >= T24C16) - ret = false; - break; - case T24C32 : - if(address >= T24C32) - ret = false; - break; - case T24C64 : - if(address >= T24C64) - ret = false; - break; - case T24C128 : - if(address >= T24C128) - ret = false; - break; - case T24C256 : - if(address >= T24C256) - ret = false; - break; - case T24C512 : - if(address >= T24C512) - ret = false; - break; - case T24C1024 : - if(address >= T24C1024) - ret = false; - break; - case T24C1025 : - if(address >= T24C1025 - 1) - ret = false; - break; - } - - return(ret); -} \ No newline at end of file + bool ret = true; + + switch(_type) { + case T24C01 : + if(address >= T24C01) + ret = false; + break; + case T24C02 : + if(address >= T24C02) + ret = false; + break; + case T24C04 : + if(address >= T24C04) + ret = false; + break; + case T24C08 : + if(address >= T24C08) + ret = false; + break; + case T24C16 : + if(address >= T24C16) + ret = false; + break; + case T24C32 : + if(address >= T24C32) + ret = false; + break; + case T24C64 : + if(address >= T24C64) + ret = false; + break; + case T24C128 : + if(address >= T24C128) + ret = false; + break; + case T24C256 : + if(address >= T24C256) + ret = false; + break; + case T24C512 : + if(address >= T24C512) + ret = false; + break; + case T24C1024 : + if(address >= T24C1024) + ret = false; + break; + case T24C1025 : + if(address >= T24C1025 - 1) + ret = false; + break; + } + + return(ret); +} \ No newline at end of file