at24md.c

浏览该文件的文档.

 
#include <xwos/standard.h>
#include <string.h>
#include <xwcd/ds/device.h>
#include <xwcd/ds/soc/gpio.h>
#include <xwcd/ds/i2c/peripheral.h>
#include <xwcd/peripheral/i2c/eeprom/device.h>
#include <xwcd/peripheral/i2c/eeprom/driver.h>
 
static __xwbsp_code
xwer_t at24md_putc(struct xwds_eeprom * eeprom, xwu8_t data, xwsq_t addr, xwtm_t to);
 
static __xwbsp_code
xwer_t at24md_getc(struct xwds_eeprom * eeprom, xwu8_t * buf, xwsq_t addr, xwtm_t to);
 
static __xwbsp_code
xwer_t at24md_pgwrite(struct xwds_eeprom * eeprom,
                      xwu8_t * data, xwsz_t * size, xwsq_t pgidx,
                      xwtm_t to);
 
static __xwbsp_code
xwer_t at24md_pgread(struct xwds_eeprom * eeprom,
                     xwu8_t * buf, xwsz_t * size, xwsq_t pgidx,
                     xwtm_t to);
 
__xwbsp_rodata
const struct xwds_eeprom_driver at24md_drv = {
        .i2cp = {
                .base = {
                        .name = "xwds.eeprom",
                        .probe = NULL,
                        .remove = NULL,
                        .start = xwds_eeprom_drv_start,
                        .stop = xwds_eeprom_drv_stop,
#if defined(XWCDCFG_ds_PM) && (1 == XWCDCFG_ds_PM)
                        .suspend = xwds_eeprom_drv_suspend,
                        .resume =  xwds_eeprom_drv_resume,
#endif
                },
        },
        .putc = at24md_putc,
        .getc = at24md_getc,
        .pgwrite = at24md_pgwrite,
        .pgread = at24md_pgread,
};
 
static __xwbsp_code
xwer_t at24md_putc(struct xwds_eeprom * eeprom, xwu8_t data, xwsq_t addr, xwtm_t to)
{
        struct xwds_i2cm * bus;
        struct xwds_i2c_msg msg;
        xwer_t rc;
        xwu8_t txdata[3];
        xwu16_t i2cpaddr;
 
        i2cpaddr = eeprom->i2cp.addr;
        bus = eeprom->i2cp.bus;
        txdata[0] = (xwu8_t)((addr >> (xwsq_t)8) & (xwu8_t)0xFF);
        txdata[1] = (xwu8_t)(addr & (xwu8_t)0xFF);
        txdata[2] = data;
        msg.addr = ((i2cpaddr & (xwu16_t)0x0078) |
                    ((xwu16_t)(addr >> 16U) & (xwu16_t)0x7));
        msg.flag = ((xwu16_t)XWDS_I2C_F_START | (xwu16_t)XWDS_I2C_F_STOP);
        msg.data = txdata;
        msg.size = sizeof(txdata);
        rc = xwds_i2cm_xfer(bus, &msg, 1U, to);
        return rc;
}
 
static __xwbsp_code
xwer_t at24md_getc(struct xwds_eeprom * eeprom, xwu8_t * buf, xwsq_t addr, xwtm_t to)
{
        struct xwds_i2cm * bus;
        struct xwds_i2c_msg msg[2];
        xwer_t rc;
        xwu8_t txdata[2];
        xwu16_t i2cpaddr;
 
        i2cpaddr = eeprom->i2cp.addr;
        bus = eeprom->i2cp.bus;
        txdata[0] = (xwu8_t)((addr >> (xwsq_t)8) & (xwu8_t)0xFF);
        txdata[1] = (xwu8_t)(addr & (xwu8_t)0xFF);
        msg[0].addr = ((i2cpaddr & (xwu16_t)0x0078) |
                       ((xwu16_t)(addr >> 16U) & (xwu16_t)0x7));
        msg[0].flag = (xwu16_t)XWDS_I2C_F_START;
        msg[0].data = txdata;
        msg[0].size = 2U;
        msg[1].addr = msg[0].addr;
        msg[1].flag = ((xwu16_t)XWDS_I2C_F_START | (xwu16_t)XWDS_I2C_F_RD |
                       (xwu16_t)XWDS_I2C_F_STOP);
        msg[1].data = buf;
        msg[1].size = 1U;
        rc = xwds_i2cm_xfer(bus, msg, 2U, to);
        return rc;
}
 
static __xwbsp_code
xwer_t at24md_pgwrite(struct xwds_eeprom * eeprom,
                      xwu8_t * data, xwsz_t * size, xwsq_t pgidx,
                      xwtm_t to)
{
        struct xwds_i2cm * bus;
        const struct xwds_eeprom_parameter * parameter;
        struct xwds_i2c_msg msg;
        xwer_t rc;
        xwu16_t i2cpaddr;
        xwsq_t addr;
        xwsz_t wrsz = *size;
        xwu8_t txdata[wrsz + 2];
 
        i2cpaddr = eeprom->i2cp.addr;
        bus = eeprom->i2cp.bus;
        parameter = &eeprom->parameter;
        addr = ((pgidx * parameter->page_size) & (xwsq_t)0x7FFFF);
        txdata[0] = (xwu8_t)((addr >> (xwsq_t)8) & (xwu8_t)0xFF);
        txdata[1] = (xwu8_t)(addr & (xwu8_t)0xFF);
        memcpy(&txdata[2], data, wrsz);
        msg.addr = ((i2cpaddr & (xwu16_t)0x0078) |
                    ((xwu16_t)(addr >> 16U) & (xwu16_t)0x7));
        msg.flag = ((xwu16_t)XWDS_I2C_F_START | (xwu16_t)XWDS_I2C_F_STOP);
        msg.data = txdata;
        msg.size = wrsz + 2U;
        rc = xwds_i2cm_xfer(bus, &msg, 1U, to);
        if (rc < 0) {
                *size = 0;
        }
        return rc;
}
 
static __xwbsp_code
xwer_t at24md_pgread(struct xwds_eeprom * eeprom,
                     xwu8_t * buf, xwsz_t * size, xwsq_t pgidx,
                     xwtm_t to)
{
        struct xwds_i2cm * bus;
        const struct xwds_eeprom_parameter * parameter;
        struct xwds_i2c_msg msg[2];
        xwer_t rc;
        xwu16_t i2cpaddr;
        xwsq_t addr;
        xwsz_t rdsz = *size;
        xwu8_t txdata[2];
 
        i2cpaddr = eeprom->i2cp.addr;
        bus = eeprom->i2cp.bus;
        parameter = &eeprom->parameter;
        addr = ((pgidx * parameter->page_size) & (xwsq_t)0x7FFFF);
        txdata[0] = (xwu8_t)((addr >> (xwsq_t)8) & (xwu8_t)0xFF);
        txdata[1] = (xwu8_t)(addr & (xwu8_t)0xFF);
        msg[0].addr = ((i2cpaddr & (xwu16_t)0x0078) |
                       ((xwu16_t)(addr >> 16U) & (xwu16_t)0x7));
        msg[0].flag = (xwu16_t)XWDS_I2C_F_START;
        msg[0].data = txdata;
        msg[0].size = 2U;
        msg[1].addr = msg[0].addr;
        msg[1].flag = ((xwu16_t)XWDS_I2C_F_START | (xwu16_t)XWDS_I2C_F_RD |
                       (xwu16_t)XWDS_I2C_F_STOP);
        msg[1].data = buf;
        msg[1].size = rdsz;
        rc = xwds_i2cm_xfer(bus, msg, 2U, to);
        if (XWOK == rc) {
                *size = msg[1].size;
        } else {
                *size = 0;
        }
        return rc;
}