git.gag.com Git - fw/altos/blob - src/stm32f1/ao_eeprom.c

   1 /*
   2  * Copyright © 2024 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation, either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with this program; if not, write to the Free Software Foundation, Inc.,
  16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  17  */
  18
  19 #include <ao.h>
  20 #include <ao_flash.h>
  21
  22 extern uint8_t  __eeprom_base[2048];
  23
  24 uint8_t
  25 ao_eeprom_read(ao_pos_t pos, void *v, uint16_t len)
  26 {
  27         memcpy(v, &__eeprom_base[pos], len);
  28         return 1;
  29 }
  30
  31 uint8_t
  32 ao_eeprom_write(ao_pos_t pos, void *v, uint16_t len)
  33 {
  34         bool hsi_on = (stm_rcc.cr & (1UL << STM_RCC_CR_HSIRDY)) != 0;
  35
  36         if (!hsi_on) {
  37                 stm_rcc.cr |= (1UL << STM_RCC_CR_HSION);
  38                 while (!(stm_rcc.cr & (1 << STM_RCC_CR_HSIRDY)))
  39                         ao_arch_nop();
  40
  41         }
  42         ao_flash_bytes(&__eeprom_base[pos], v, len);
  43
  44         if (!hsi_on) {
  45                 stm_rcc.cr &= ~(1UL << STM_RCC_CR_HSION);
  46         }
  47
  48         return 1;
  49 }
  50