4b5dc2ac480341086e4264284b9345d2e5da299c
[fw/altos] / src / stm / ao_boot_pin.c
1 /*
2  * Copyright © 2013 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_boot.h>
21 #include <ao_exti.h>
22
23 void
24 ao_boot_check_pin(void)
25 {
26         uint16_t v;
27
28         /* Enable power interface clock */
29         stm_rcc.apb1enr |= (1 << STM_RCC_APB1ENR_PWREN);
30
31         /* Enable the input pin */
32         ao_enable_input(&AO_BOOT_APPLICATION_GPIO, AO_BOOT_APPLICATION_PIN,
33                         AO_BOOT_APPLICATION_MODE);
34
35         for (v = 0; v < 100; v++)
36                 ao_arch_nop();
37
38         /* Read the value */
39         v = stm_gpio_get(&AO_BOOT_APPLICATION_GPIO, AO_BOOT_APPLICATION_PIN);
40
41         /* Reset the chip to turn off the port and the power interface clock */
42         ao_gpio_set_mode(&AO_BOOT_APPLICATION_GPIO, AO_BOOT_APPLICATION_PIN, 0);
43         ao_disable_port(&AO_BOOT_APPLICATION_GPIO);
44         stm_rcc.apb1enr &= ~(1 << STM_RCC_APB1ENR_PWREN);
45         if (v == AO_BOOT_APPLICATION_VALUE)
46                 ao_boot_chain(AO_BOOT_APPLICATION_BASE);
47 }