From 7ded8116d90081851e0ddb1b4bdd77b645f6535c Mon Sep 17 00:00:00 2001 From: Uros Majstorovic Date: Wed, 1 Dec 2021 01:20:10 +0100 Subject: i2c added 16 bit register read/write --- fw/fe310/eos/i2c.c | 71 +++++++++++++++++++++++++++++++++++----------- fw/fe310/eos/i2c.h | 14 +++++---- fw/fe310/eos/i2c/bq25895.c | 22 +++++++++----- fw/fe310/eos/i2c/ov2640.c | 4 +-- 4 files changed, 79 insertions(+), 32 deletions(-) (limited to 'fw/fe310/eos') diff --git a/fw/fe310/eos/i2c.c b/fw/fe310/eos/i2c.c index 37c5cf8..972deae 100644 --- a/fw/fe310/eos/i2c.c +++ b/fw/fe310/eos/i2c.c @@ -10,33 +10,31 @@ #include "i2c.h" int eos_i2c_init(uint8_t wakeup_cause) { - GPIO_REG(GPIO_IOF_SEL) &= ~IOF0_I2C0_MASK; - + eos_i2c_stop(); + eos_i2c_speed(EOS_I2C_SPEED); return EOS_OK; } -int eos_i2c_start(uint32_t baud_rate) { +int eos_i2c_start(void) { if (eos_i2s_running()) return EOS_ERR_BUSY; - eos_i2c_set_baud_rate(baud_rate); - GPIO_REG(GPIO_IOF_EN) |= IOF0_I2C0_MASK; + GPIO_REG(GPIO_IOF_EN) |= IOF0_I2C0_MASK; + I2C0_REGB(I2C_CONTROL) |= I2C_CONTROL_EN; return EOS_OK; } void eos_i2c_stop(void) { - if (eos_i2s_running()) return; - GPIO_REG(GPIO_IOF_EN) &= ~IOF0_I2C0_MASK; + GPIO_REG(GPIO_IOF_EN) &= ~IOF0_I2C0_MASK; + I2C0_REGB(I2C_CONTROL) &= ~I2C_CONTROL_EN; } -void eos_i2c_set_baud_rate(uint32_t baud_rate) { +void eos_i2c_speed(uint32_t baud_rate) { unsigned long clock_rate = PRCI_get_cpu_freq(); uint16_t prescaler = (clock_rate / (baud_rate * 5)) - 1; - I2C0_REGB(I2C_CONTROL) &= ~I2C_CONTROL_EN; I2C0_REGB(I2C_PRESCALE_LOW) = prescaler & 0xFF; I2C0_REGB(I2C_PRESCALE_HIGH) = (prescaler >> 8) & 0xFF; - I2C0_REGB(I2C_CONTROL) |= I2C_CONTROL_EN; } @@ -60,7 +58,7 @@ static int i2c_addr(uint8_t addr, uint8_t rw_flag) { return i2c_write(I2C_CMD_START, ((addr & 0x7F) << 1) | (rw_flag & 0x1)); } -int eos_i2c_read(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len) { +int eos_i2c_read8(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len) { int rv; int i; @@ -83,7 +81,33 @@ int eos_i2c_read(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len) { return EOS_OK; } -int eos_i2c_write(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len) { +int eos_i2c_read16(uint8_t addr, uint16_t reg, uint8_t *buffer, uint16_t len) { + int rv; + int i; + + rv = i2c_addr(addr, I2C_WRITE); + if (rv) return rv; + + rv = i2c_write(0, reg >> 8); + if (rv) return rv; + + rv = i2c_write(0, reg & 0xff); + if (rv) return rv; + + rv = i2c_addr(addr, I2C_READ); + if (rv) return rv; + + for (i=0; i> 8); + if (rv) return rv; + + rv = i2c_write(0, reg & 0xff); + if (rv) return rv; + + for (i=0; i +#define EOS_I2C_SPEED 100000 + int eos_i2c_init(uint8_t wakeup_cause); -int eos_i2c_start(uint32_t baud_rate); +int eos_i2c_start(void); void eos_i2c_stop(void); -void eos_i2c_set_baud_rate(uint32_t baud_rate); -int eos_i2c_read(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len); -int eos_i2c_write(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len); -int eos_i2c_read8(uint8_t addr, uint8_t reg, uint8_t *data); -int eos_i2c_write8(uint8_t addr, uint8_t reg, uint8_t data); +void eos_i2c_speed(uint32_t baud_rate); +int eos_i2c_read8(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len); +int eos_i2c_read16(uint8_t addr, uint16_t reg, uint8_t *buffer, uint16_t len); +int eos_i2c_write8(uint8_t addr, uint8_t reg, uint8_t *buffer, uint16_t len); +int eos_i2c_write16(uint8_t addr, uint16_t reg, uint8_t *buffer, uint16_t len); diff --git a/fw/fe310/eos/i2c/bq25895.c b/fw/fe310/eos/i2c/bq25895.c index ab2268b..f8923c6 100644 --- a/fw/fe310/eos/i2c/bq25895.c +++ b/fw/fe310/eos/i2c/bq25895.c @@ -7,29 +7,37 @@ #include "i2c.h" #include "i2c/bq25895.h" +static int reg_read(uint8_t reg, uint8_t *data) { + return eos_i2c_read8(BQ25895_ADDR, reg, data, 1); +} + +static int reg_write(uint8_t reg, uint8_t data) { + return eos_i2c_write8(BQ25895_ADDR, reg, &data, 1); +} + int eos_bq25895_init(uint8_t wakeup_cause) { int rst = (wakeup_cause == EOS_PWR_WAKE_RST); int i, rv = EOS_OK; uint8_t data = 0; - rv = eos_i2c_start(100000); + rv = eos_i2c_start(); if (rv) return rv; if (rst) { - rv = eos_i2c_write8(BQ25895_ADDR, 0x14, 0x80); // reset + rv = reg_write(0x14, 0x80); // reset if (rv) printf("I2C ERROR 0x14\n"); - rv = eos_i2c_write8(BQ25895_ADDR, 0x14, 0x00); // disable watchdog + rv = reg_write(0x14, 0x00); // disable watchdog if (rv) printf("I2C ERROR 0x14\n"); - rv = eos_i2c_write8(BQ25895_ADDR, 0x07, 0x8d); // disable watchdog + rv = reg_write(0x07, 0x8d); // disable watchdog if (rv) printf("I2C ERROR 0x07\n"); - rv = eos_i2c_write8(BQ25895_ADDR, 0x00, 0x28); // 2.1A input current + rv = reg_write(0x00, 0x28); // 2.1A input current if (rv) printf("I2C ERROR 0x00\n"); - rv = eos_i2c_write8(BQ25895_ADDR, 0x02, 0x30); // enable ICO, disaable MaxCharge and D+/D- + rv = reg_write(0x02, 0x30); // enable ICO, disaable MaxCharge and D+/D- if (rv) printf("I2C ERROR 0x02\n"); } printf("BQ25895:\n"); for (i=0; i<0x15; i++) { - rv = eos_i2c_read8(BQ25895_ADDR, i, &data); + rv = reg_read(i, &data); if (!rv) printf("REG%02x: %02x\n", i, data); } eos_i2c_stop(); diff --git a/fw/fe310/eos/i2c/ov2640.c b/fw/fe310/eos/i2c/ov2640.c index 1a29463..6e54f10 100644 --- a/fw/fe310/eos/i2c/ov2640.c +++ b/fw/fe310/eos/i2c/ov2640.c @@ -339,11 +339,11 @@ static const uint8_t saturation_regs[NUM_SATURATION_LEVELS + 1][5] = { }; static int reg_read(int8_t reg, uint8_t *data) { - return eos_i2c_read8(OV2640_ADDR, reg, data); + return eos_i2c_read8(OV2640_ADDR, reg, data, 1); } static int reg_write(uint8_t reg, uint8_t data) { - return eos_i2c_write8(OV2640_ADDR, reg, data); + return eos_i2c_write8(OV2640_ADDR, reg, &data, 1); } static int regarr_write(const uint8_t (*regs)[2]) { -- cgit v1.2.3