eeprom.c

Go to the documentation of this file.

#include "eeprom.h"

#warning TODO:Test and complete this module for arm platform.
#if !CPU_ARM

#include <cfg/macros.h>  // MIN()
#include <cfg/debug.h>
#include <cfg/module.h>  // MOD_CHECK()

#include <cpu/attr.h>
#include <drv/i2c.h>

#include <drv/wdt.h>

#include <cpu/byteorder.h> // cpu_to_be16()

#include <string.h>  // memset()

#define EEPROM_ID  0xA0

#define EEPROM_ADDR(x) (EEPROM_ID | (((uint8_t)((x) & 0x07)) << 1))


static const EepromInfo mem_info[] =
{
    {
        /* 24XX16 */
        .has_dev_addr = false,
        .blk_size = 0x10,
        .e2_size = 0x800,
    },
    {
        /* 24XX256 */
        .has_dev_addr = true,
        .blk_size = 0x40,
        .e2_size = 0x8000,
    },
    {
        /* 24XX512 */
        .has_dev_addr = true,
        .blk_size = 0x80,
        .e2_size = 0x10000,
    },
    /* Add other memories here */
};

STATIC_ASSERT(countof(mem_info) == EEPROM_CNT);


static size_t eeprom_writeRaw(struct KFile *_fd, const void *buf, size_t size)
{
    Eeprom *fd = EEPROM_CAST(_fd);
    e2dev_addr_t dev_addr;
    uint8_t addr_buf[2];
    uint8_t addr_len;
    size_t wr_len = 0;

    e2blk_size_t blk_size = mem_info[fd->type].blk_size;

    STATIC_ASSERT(countof(addr_buf) <= sizeof(e2addr_t));

    /* clamp size to memory limit (otherwise may roll back) */
    ASSERT(_fd->seek_pos + size <= (kfile_off_t)_fd->size);
    size = MIN((kfile_off_t)size, _fd->size - _fd->seek_pos);

    if (mem_info[fd->type].has_dev_addr)
    {
        dev_addr = fd->addr;
        addr_len = 2;
    }
    else
    {
        dev_addr = (e2dev_addr_t)((fd->fd.seek_pos >> 8) & 0x07);
        addr_len = 1;
    }

    while (size)
    {
        /*
         * Split write in multiple sequential mode operations that
         * don't cross page boundaries.
         */
        size_t count = MIN(size, (size_t)(blk_size - (fd->fd.seek_pos & (blk_size - 1))));

        if (mem_info[fd->type].has_dev_addr)
        {
            addr_buf[0] = (fd->fd.seek_pos >> 8) & 0xFF;
            addr_buf[1] = (fd->fd.seek_pos & 0xFF);
        }
        else
        {
            dev_addr = (e2dev_addr_t)((fd->fd.seek_pos >> 8) & 0x07);
            addr_buf[0] = (fd->fd.seek_pos & 0xFF);
        }


        if (!(i2c_start_w(EEPROM_ADDR(dev_addr))
            && i2c_send(addr_buf, addr_len)
            && i2c_send(buf, count)))
        {
            i2c_stop();
            return wr_len;
        }

        i2c_stop();

        /* Update count and addr for next operation */
        size -= count;
        fd->fd.seek_pos += count;
        buf = ((const char *)buf) + count;
        wr_len += count;
    }

    return wr_len;
}

static size_t eeprom_writeVerify(struct KFile *_fd, const void *_buf, size_t size)
{
    Eeprom *fd = EEPROM_CAST(_fd);
    int retries = 5;
    size_t wr_len = 0;

    while (retries--)
    {
        wr_len = eeprom_writeRaw(_fd, _buf, size);
        /* rewind to verify what we have just written */
        kfile_seek(_fd, -(kfile_off_t)wr_len, KSM_SEEK_CUR);
        if (wr_len == size
         && eeprom_verify(fd, _buf, wr_len))
        {
            /* Forward to go after what we have written*/
            kfile_seek(_fd, wr_len, KSM_SEEK_CUR);
            return wr_len;
        }
    }
    return wr_len;
}


static size_t eeprom_read(struct KFile *_fd, void *_buf, size_t size)
{
    Eeprom *fd = EEPROM_CAST(_fd);
    uint8_t addr_buf[2];
    uint8_t addr_len;
    size_t rd_len = 0;
    uint8_t *buf = (uint8_t *)_buf;

    STATIC_ASSERT(countof(addr_buf) <= sizeof(e2addr_t));

    /* clamp size to memory limit (otherwise may roll back) */
    ASSERT(_fd->seek_pos + size <= (kfile_off_t)_fd->size);
    size = MIN((kfile_off_t)size, _fd->size - _fd->seek_pos);

    e2dev_addr_t dev_addr;
    if (mem_info[fd->type].has_dev_addr)
    {
        dev_addr = fd->addr;
        addr_len = 2;
        addr_buf[0] = (fd->fd.seek_pos >> 8) & 0xFF;
        addr_buf[1] = (fd->fd.seek_pos & 0xFF);
    }
    else
    {
        dev_addr = (e2dev_addr_t)((fd->fd.seek_pos >> 8) & 0x07);
        addr_len = 1;
        addr_buf[0] = (fd->fd.seek_pos & 0xFF);
    }


    if (!(i2c_start_w(EEPROM_ADDR(dev_addr))
       && i2c_send(addr_buf, addr_len)
       && i2c_start_r(EEPROM_ADDR(dev_addr))))
    {
        i2c_stop();
        return 0;
    }

    while (size--)
    {
        /*
         * The last byte read does not have an ACK
         * to stop communication.
         */
        int c = i2c_get(size);

        if (c == EOF)
            break;

        *buf++ = c;
        fd->fd.seek_pos++;
        rd_len++;
    }

    return rd_len;
}

bool eeprom_verify(Eeprom *fd, const void *buf, size_t count)
{
    uint8_t verify_buf[16];
    bool result = true;

    /* Save seek position */
    kfile_off_t prev_seek = fd->fd.seek_pos;

    while (count && result)
    {
        /* Split read in smaller pieces */
        size_t size = MIN(count, sizeof verify_buf);

        /* Read back buffer */
        if (eeprom_read(&fd->fd, verify_buf, size))
        {
            if (memcmp(buf, verify_buf, size) != 0)
            {
                TRACEMSG("Data mismatch!");
                result = false;
            }
        }
        else
        {
            TRACEMSG("Read error!");
            result = false;
        }

        /* Update count and addr for next operation */
        count -= size;
        buf = ((const char *)buf) + size;
    }

    /* Restore previous seek position */
    fd->fd.seek_pos = prev_seek;
    return result;
}

bool eeprom_erase(Eeprom *fd, e2addr_t addr, e2_size_t count)
{
    e2blk_size_t blk_size = mem_info[fd->type].blk_size;
    uint8_t buf[blk_size];
    kfile_off_t prev_off = fd->fd.seek_pos;
    bool res = true;
    size_t size;

    memset(buf, 0xFF, blk_size);


    kfile_seek(&fd->fd, addr, KSM_SEEK_SET);

    /*
     * Optimization: this first write id used to realign
     * current address to block boundaries.
     */

    wdt_reset();
    size = MIN(count, (e2_size_t)(blk_size - (addr & (blk_size - 1))));
    if (kfile_write(&fd->fd, buf, size) != size)
    {
        fd->fd.seek_pos = prev_off;
        return false;
    }
    count -= size;

    /* Clear all */
    while (count)
    {
        /* Long operation, reset watchdog */
        wdt_reset();

        size = MIN(count, (e2_size_t)sizeof buf);
        if (kfile_write(&fd->fd, buf, size) != size)
        {
            res = false;
            break;
        }

        count -= size;
    }
    fd->fd.seek_pos = prev_off;
    return res;
}


void eeprom_init(Eeprom *fd, EepromType type, e2dev_addr_t addr, bool verify)
{
    MOD_CHECK(i2c);
    ASSERT(type < EEPROM_CNT);

    memset(fd, 0, sizeof(*fd));
    DB(fd->fd._type = KFT_EEPROM);

    fd->type = type;
    fd->addr = addr;
    fd->fd.size = mem_info[fd->type].e2_size;

    // Setup eeprom programming functions.
    fd->fd.read = eeprom_read;
    if (verify)
        fd->fd.write = eeprom_writeVerify;
    else
        fd->fd.write = eeprom_writeRaw;
    fd->fd.close = kfile_genericClose;

    fd->fd.seek = kfile_genericSeek;
}

#endif