diff options
Diffstat (limited to 'drivers/eeprom')
| -rw-r--r-- | drivers/eeprom/eeprom_i2c.c | 12 | ||||
| -rw-r--r-- | drivers/eeprom/eeprom_spi.c | 14 |
2 files changed, 2 insertions, 24 deletions
diff --git a/drivers/eeprom/eeprom_i2c.c b/drivers/eeprom/eeprom_i2c.c index ca8af3da5..4210f06f9 100644 --- a/drivers/eeprom/eeprom_i2c.c +++ b/drivers/eeprom/eeprom_i2c.c | |||
| @@ -42,14 +42,6 @@ | |||
| 42 | # include "debug.h" | 42 | # include "debug.h" |
| 43 | #endif // DEBUG_EEPROM_OUTPUT | 43 | #endif // DEBUG_EEPROM_OUTPUT |
| 44 | 44 | ||
| 45 | static inline void init_i2c_if_required(void) { | ||
| 46 | static int done = 0; | ||
| 47 | if (!done) { | ||
| 48 | i2c_init(); | ||
| 49 | done = 1; | ||
| 50 | } | ||
| 51 | } | ||
| 52 | |||
| 53 | static inline void fill_target_address(uint8_t *buffer, const void *addr) { | 45 | static inline void fill_target_address(uint8_t *buffer, const void *addr) { |
| 54 | uintptr_t p = (uintptr_t)addr; | 46 | uintptr_t p = (uintptr_t)addr; |
| 55 | for (int i = 0; i < EXTERNAL_EEPROM_ADDRESS_SIZE; ++i) { | 47 | for (int i = 0; i < EXTERNAL_EEPROM_ADDRESS_SIZE; ++i) { |
| @@ -58,7 +50,7 @@ static inline void fill_target_address(uint8_t *buffer, const void *addr) { | |||
| 58 | } | 50 | } |
| 59 | } | 51 | } |
| 60 | 52 | ||
| 61 | void eeprom_driver_init(void) {} | 53 | void eeprom_driver_init(void) { i2c_init(); } |
| 62 | 54 | ||
| 63 | void eeprom_driver_erase(void) { | 55 | void eeprom_driver_erase(void) { |
| 64 | #if defined(CONSOLE_ENABLE) && defined(DEBUG_EEPROM_OUTPUT) | 56 | #if defined(CONSOLE_ENABLE) && defined(DEBUG_EEPROM_OUTPUT) |
| @@ -80,7 +72,6 @@ void eeprom_read_block(void *buf, const void *addr, size_t len) { | |||
| 80 | uint8_t complete_packet[EXTERNAL_EEPROM_ADDRESS_SIZE]; | 72 | uint8_t complete_packet[EXTERNAL_EEPROM_ADDRESS_SIZE]; |
| 81 | fill_target_address(complete_packet, addr); | 73 | fill_target_address(complete_packet, addr); |
| 82 | 74 | ||
| 83 | init_i2c_if_required(); | ||
| 84 | i2c_transmit(EXTERNAL_EEPROM_I2C_ADDRESS((uintptr_t)addr), complete_packet, EXTERNAL_EEPROM_ADDRESS_SIZE, 100); | 75 | i2c_transmit(EXTERNAL_EEPROM_I2C_ADDRESS((uintptr_t)addr), complete_packet, EXTERNAL_EEPROM_ADDRESS_SIZE, 100); |
| 85 | i2c_receive(EXTERNAL_EEPROM_I2C_ADDRESS((uintptr_t)addr), buf, len, 100); | 76 | i2c_receive(EXTERNAL_EEPROM_I2C_ADDRESS((uintptr_t)addr), buf, len, 100); |
| 86 | 77 | ||
| @@ -98,7 +89,6 @@ void eeprom_write_block(const void *buf, void *addr, size_t len) { | |||
| 98 | uint8_t * read_buf = (uint8_t *)buf; | 89 | uint8_t * read_buf = (uint8_t *)buf; |
| 99 | uintptr_t target_addr = (uintptr_t)addr; | 90 | uintptr_t target_addr = (uintptr_t)addr; |
| 100 | 91 | ||
| 101 | init_i2c_if_required(); | ||
| 102 | while (len > 0) { | 92 | while (len > 0) { |
| 103 | uintptr_t page_offset = target_addr % EXTERNAL_EEPROM_PAGE_SIZE; | 93 | uintptr_t page_offset = target_addr % EXTERNAL_EEPROM_PAGE_SIZE; |
| 104 | int write_length = EXTERNAL_EEPROM_PAGE_SIZE - page_offset; | 94 | int write_length = EXTERNAL_EEPROM_PAGE_SIZE - page_offset; |
diff --git a/drivers/eeprom/eeprom_spi.c b/drivers/eeprom/eeprom_spi.c index 7b6416eaf..182731d82 100644 --- a/drivers/eeprom/eeprom_spi.c +++ b/drivers/eeprom/eeprom_spi.c | |||
| @@ -55,14 +55,6 @@ | |||
| 55 | # include "debug.h" | 55 | # include "debug.h" |
| 56 | #endif // CONSOLE_ENABLE | 56 | #endif // CONSOLE_ENABLE |
| 57 | 57 | ||
| 58 | static void init_spi_if_required(void) { | ||
| 59 | static int done = 0; | ||
| 60 | if (!done) { | ||
| 61 | spi_init(); | ||
| 62 | done = 1; | ||
| 63 | } | ||
| 64 | } | ||
| 65 | |||
| 66 | static bool spi_eeprom_start(void) { return spi_start(EXTERNAL_EEPROM_SPI_SLAVE_SELECT_PIN, EXTERNAL_EEPROM_SPI_LSBFIRST, EXTERNAL_EEPROM_SPI_MODE, EXTERNAL_EEPROM_SPI_CLOCK_DIVISOR); } | 58 | static bool spi_eeprom_start(void) { return spi_start(EXTERNAL_EEPROM_SPI_SLAVE_SELECT_PIN, EXTERNAL_EEPROM_SPI_LSBFIRST, EXTERNAL_EEPROM_SPI_MODE, EXTERNAL_EEPROM_SPI_CLOCK_DIVISOR); } |
| 67 | 59 | ||
| 68 | static spi_status_t spi_eeprom_wait_while_busy(int timeout) { | 60 | static spi_status_t spi_eeprom_wait_while_busy(int timeout) { |
| @@ -91,7 +83,7 @@ static void spi_eeprom_transmit_address(uintptr_t addr) { | |||
| 91 | 83 | ||
| 92 | //---------------------------------------------------------------------------------------------------------------------- | 84 | //---------------------------------------------------------------------------------------------------------------------- |
| 93 | 85 | ||
| 94 | void eeprom_driver_init(void) {} | 86 | void eeprom_driver_init(void) { spi_init(); } |
| 95 | 87 | ||
| 96 | void eeprom_driver_erase(void) { | 88 | void eeprom_driver_erase(void) { |
| 97 | #if defined(CONSOLE_ENABLE) && defined(DEBUG_EEPROM_OUTPUT) | 89 | #if defined(CONSOLE_ENABLE) && defined(DEBUG_EEPROM_OUTPUT) |
| @@ -110,8 +102,6 @@ void eeprom_driver_erase(void) { | |||
| 110 | } | 102 | } |
| 111 | 103 | ||
| 112 | void eeprom_read_block(void *buf, const void *addr, size_t len) { | 104 | void eeprom_read_block(void *buf, const void *addr, size_t len) { |
| 113 | init_spi_if_required(); | ||
| 114 | |||
| 115 | //------------------------------------------------- | 105 | //------------------------------------------------- |
| 116 | // Wait for the write-in-progress bit to be cleared | 106 | // Wait for the write-in-progress bit to be cleared |
| 117 | bool res = spi_eeprom_start(); | 107 | bool res = spi_eeprom_start(); |
| @@ -154,8 +144,6 @@ void eeprom_read_block(void *buf, const void *addr, size_t len) { | |||
| 154 | } | 144 | } |
| 155 | 145 | ||
| 156 | void eeprom_write_block(const void *buf, void *addr, size_t len) { | 146 | void eeprom_write_block(const void *buf, void *addr, size_t len) { |
| 157 | init_spi_if_required(); | ||
| 158 | |||
| 159 | bool res; | 147 | bool res; |
| 160 | uint8_t * read_buf = (uint8_t *)buf; | 148 | uint8_t * read_buf = (uint8_t *)buf; |
| 161 | uintptr_t target_addr = (uintptr_t)addr; | 149 | uintptr_t target_addr = (uintptr_t)addr; |
