tmk_core/common/arm_atsam/eeprom.c

   1 /* Copyright 2017 Fred Sundvik
   2  *
   3  * This program is free software: you can redistribute it and/or modify
   4  * it under the terms of the GNU General Public License as published by
   5  * the Free Software Foundation, either version 2 of the License, or
   6  * (at your option) any later version.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15  */
  16
  17 #include "eeprom.h"
  18
  19 #define EEPROM_SIZE 32
  20
  21 static uint8_t buffer[EEPROM_SIZE];
  22
  23 uint8_t eeprom_read_byte(const uint8_t *addr) {
  24         uintptr_t offset = (uintptr_t)addr;
  25         return buffer[offset];
  26 }
  27
  28 void eeprom_write_byte(uint8_t *addr, uint8_t value) {
  29         uintptr_t offset = (uintptr_t)addr;
  30         buffer[offset] = value;
  31 }
  32
  33 uint16_t eeprom_read_word(const uint16_t *addr) {
  34         const uint8_t *p = (const uint8_t *)addr;
  35         return eeprom_read_byte(p) | (eeprom_read_byte(p+1) << 8);
  36 }
  37
  38 uint32_t eeprom_read_dword(const uint32_t *addr) {
  39         const uint8_t *p = (const uint8_t *)addr;
  40         return eeprom_read_byte(p) | (eeprom_read_byte(p+1) << 8)
  41                 | (eeprom_read_byte(p+2) << 16) | (eeprom_read_byte(p+3) << 24);
  42 }
  43
  44 void eeprom_read_block(void *buf, const void *addr, uint32_t len) {
  45         const uint8_t *p = (const uint8_t *)addr;
  46         uint8_t *dest = (uint8_t *)buf;
  47         while (len--) {
  48                 *dest++ = eeprom_read_byte(p++);
  49         }
  50 }
  51
  52 void eeprom_write_word(uint16_t *addr, uint16_t value) {
  53         uint8_t *p = (uint8_t *)addr;
  54         eeprom_write_byte(p++, value);
  55         eeprom_write_byte(p, value >> 8);
  56 }
  57
  58 void eeprom_write_dword(uint32_t *addr, uint32_t value) {
  59         uint8_t *p = (uint8_t *)addr;
  60         eeprom_write_byte(p++, value);
  61         eeprom_write_byte(p++, value >> 8);
  62         eeprom_write_byte(p++, value >> 16);
  63         eeprom_write_byte(p, value >> 24);
  64 }
  65
  66 void eeprom_write_block(const void *buf, void *addr, uint32_t len) {
  67         uint8_t *p = (uint8_t *)addr;
  68         const uint8_t *src = (const uint8_t *)buf;
  69         while (len--) {
  70                 eeprom_write_byte(p++, *src++);
  71         }
  72 }
  73
  74 void eeprom_update_byte(uint8_t *addr, uint8_t value) {
  75         eeprom_write_byte(addr, value);
  76 }
  77
  78 void eeprom_update_word(uint16_t *addr, uint16_t value) {
  79         uint8_t *p = (uint8_t *)addr;
  80         eeprom_write_byte(p++, value);
  81         eeprom_write_byte(p, value >> 8);
  82 }
  83
  84 void eeprom_update_dword(uint32_t *addr, uint32_t value) {
  85         uint8_t *p = (uint8_t *)addr;
  86         eeprom_write_byte(p++, value);
  87         eeprom_write_byte(p++, value >> 8);
  88         eeprom_write_byte(p++, value >> 16);
  89         eeprom_write_byte(p, value >> 24);
  90 }
  91
  92 void eeprom_update_block(const void *buf, void *addr, uint32_t len) {
  93         uint8_t *p = (uint8_t *)addr;
  94         const uint8_t *src = (const uint8_t *)buf;
  95         while (len--) {
  96                 eeprom_write_byte(p++, *src++);
  97         }
  98 }