Fixed flash utility for STM32F4

[fw/stlink] / example / blink_flash / main.c

diff --git a/example/blink_flash/main.c b/example/blink_flash/main.c
index d27ef7f9babf941879869fe13875c4e8dcdc30a0..4385b0971b00500ab182f9f572a53fceacbeee70 100644 (file)
--- a/example/blink_flash/main.c
+++ b/example/blink_flash/main.c
@@ -69,6 +69,37 @@ static inline void switch_leds_off(void)
   GPIO_LOW(LD_GPIO_PORT, LD_BLUE_GPIO_PIN);
 }
 
+#elif CONFIG_STM32F4_DISCOVERY
+
+//#define GPIOD 0x40020C00 /* port D */
+# define GPIOD_MODER (GPIOD + 0x00) /* port mode register */
+# define GPIOD_ODR (GPIOD + 0x14) /* port output data register */
+
+# define LED_GREEN (1 << 12) /* port B, pin 12 */
+# define LED_ORANGE (1 << 13) /* port B, pin 13 */
+# define LED_RED (1 << 14) /* port B, pin 14 */
+# define LED_BLUE (1 << 15) /* port B, pin 15 */
+
+void _tmain(void) {
+       main();
+}
+static inline void setup_leds(void)
+{
+  *(volatile uint32_t*)GPIOD_MODER |= (1 << (12 * 2)) | (1 << (13 * 2)) |
+       (1 << (13 * 2)) | (1 << (14 * 2)) | (1 << (15 * 2));
+}
+
+
+static inline void switch_leds_on(void)
+{
+  *(volatile uint32_t*)GPIOD_ODR = LED_GREEN | LED_RED ;
+}
+
+static inline void switch_leds_off(void)
+{
+  *(volatile uint32_t*)GPIOD_ODR = 0;
+}
+
 #endif /* otherwise, error */