2 * Copyright © 2013 Keith Packard <keithp@keithp.com>
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.
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.
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.
23 ao_flash_pecr_is_locked(void)
25 return (stm_flash.pecr & (1 << STM_FLASH_PECR_PELOCK)) != 0;
29 ao_flash_pgr_is_locked(void)
31 return (stm_flash.pecr & (1 << STM_FLASH_PECR_PRGLOCK)) != 0;
35 ao_flash_pecr_unlock(void)
37 if (!ao_flash_pecr_is_locked())
40 /* Unlock Data EEPROM and FLASH_PECR register */
41 stm_flash.pekeyr = STM_FLASH_PEKEYR_PEKEY1;
42 stm_flash.pekeyr = STM_FLASH_PEKEYR_PEKEY2;
43 if (ao_flash_pecr_is_locked())
44 ao_panic(AO_PANIC_FLASH);
48 ao_flash_pgr_unlock(void)
50 if (!ao_flash_pgr_is_locked())
53 /* Unlock program memory */
54 stm_flash.prgkeyr = STM_FLASH_PRGKEYR_PRGKEY1;
55 stm_flash.prgkeyr = STM_FLASH_PRGKEYR_PRGKEY2;
56 if (ao_flash_pgr_is_locked())
57 ao_panic(AO_PANIC_FLASH);
63 stm_flash.pecr |= (1 << STM_FLASH_PECR_OPTLOCK) | (1 << STM_FLASH_PECR_PRGLOCK) | (1 << STM_FLASH_PECR_PELOCK);
67 ao_flash_wait_bsy(void)
69 while (stm_flash.sr & (1 << STM_FLASH_SR_BSY))
73 static void __attribute__ ((section(".ramtext"),noinline))
74 _ao_flash_erase_page(uint32_t *page)
76 stm_flash.pecr |= (1 << STM_FLASH_PECR_ERASE) | (1 << STM_FLASH_PECR_PROG);
84 ao_flash_erase_page(uint32_t *page)
86 ao_arch_block_interrupts();
87 ao_flash_pecr_unlock();
88 ao_flash_pgr_unlock();
90 _ao_flash_erase_page(page);
93 ao_arch_release_interrupts();
96 static void __attribute__ ((section(".ramtext"), noinline))
97 _ao_flash_half_page(uint32_t *dst, uint32_t *src)
101 stm_flash.pecr |= (1 << STM_FLASH_PECR_FPRG);
102 stm_flash.pecr |= (1 << STM_FLASH_PECR_PROG);
106 for (i = 0; i < 32; i++) {
110 while (stm_flash.sr & (1 << STM_FLASH_SR_BSY))
115 ao_flash_page(uint32_t *page, uint32_t *src)
119 ao_flash_erase_page(page);
121 ao_arch_block_interrupts();
122 ao_flash_pecr_unlock();
123 ao_flash_pgr_unlock();
124 for (h = 0; h < 2; h++) {
125 _ao_flash_half_page(page, src);
130 ao_arch_release_interrupts();