aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorJakob Odersky <jodersky@gmail.com>2015-05-14 12:26:41 +0200
committerJakob Odersky <jodersky@gmail.com>2015-05-14 12:27:10 +0200
commite4031ca37046ada989cc92abe79329f64f885e3c (patch)
treec3b351a63c8b8781eb59899208670e8d73e9ffb5
parentc7560bb66b3ca3b3abc4dff2a62f3ef865646dda (diff)
downloadpx4-firmware-e4031ca37046ada989cc92abe79329f64f885e3c.tar.gz
px4-firmware-e4031ca37046ada989cc92abe79329f64f885e3c.tar.bz2
px4-firmware-e4031ca37046ada989cc92abe79329f64f885e3c.zip
cleanup leds
-rw-r--r--src/drivers/boards/trifle/board_config.h7
-rw-r--r--src/drivers/boards/trifle/internal.h6
-rw-r--r--src/drivers/boards/trifle/up_boot.c5
-rw-r--r--src/drivers/boards/trifle/up_leds.c189
4 files changed, 20 insertions, 187 deletions
diff --git a/src/drivers/boards/trifle/board_config.h b/src/drivers/boards/trifle/board_config.h
index 9004142aa..5ebae1973 100644
--- a/src/drivers/boards/trifle/board_config.h
+++ b/src/drivers/boards/trifle/board_config.h
@@ -2,8 +2,15 @@
#define BOARD_CONFIG_H
#include <nuttx/config.h>
+#include <stdbool.h>
//totally random
#define UDID_START 0x2000000
+#define GPIO_LED0 (PIN_PORTC | PIN5 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
+
+__EXPORT void led_init(void);
+
+__EXPORT void led_set(int led, bool value);
+
#endif
diff --git a/src/drivers/boards/trifle/internal.h b/src/drivers/boards/trifle/internal.h
deleted file mode 100644
index 7f239dce7..000000000
--- a/src/drivers/boards/trifle/internal.h
+++ /dev/null
@@ -1,6 +0,0 @@
-#ifndef INTERNAL_H
-#define INTERNAL_H
-
-void led_init(void);
-
-#endif
diff --git a/src/drivers/boards/trifle/up_boot.c b/src/drivers/boards/trifle/up_boot.c
index 1d760df39..a51931fb2 100644
--- a/src/drivers/boards/trifle/up_boot.c
+++ b/src/drivers/boards/trifle/up_boot.c
@@ -41,7 +41,7 @@
#include <debug.h>
#include <arch/board/board.h>
-#include "internal.h"
+#include "board_config.h"
/************************************************************************************
@@ -68,5 +68,6 @@
__EXPORT void kinetis_boardinitialize(void)
{
- led_init();
+ led_init();
+ led_set(0, true);
}
diff --git a/src/drivers/boards/trifle/up_leds.c b/src/drivers/boards/trifle/up_leds.c
index 7cb25f86e..d500011f1 100644
--- a/src/drivers/boards/trifle/up_leds.c
+++ b/src/drivers/boards/trifle/up_leds.c
@@ -1,189 +1,20 @@
-/****************************************************************************
- * configs/kwikstik-k40/src/up_leds.c
- * arch/arm/src/board/up_leds.c
- *
- * Copyright (C) 2011, 2013 Gregory Nutt. All rights reserved.
- * Author: Gregory Nutt <gnutt@nuttx.org>
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- *
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in
- * the documentation and/or other materials provided with the
- * distribution.
- * 3. Neither the name NuttX nor the names of its contributors may be
- * used to endorse or promote products derived from this software
- * without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
- * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
- * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
- * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
- * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
- * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
- * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
- * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
- * POSSIBILITY OF SUCH DAMAGE.
- *
- ****************************************************************************/
-
-/****************************************************************************
- * Included Files
- ****************************************************************************/
-
-#include <nuttx/config.h>
-
-#include <arch/board/board.h>
-#include <stdbool.h>
-#include <debug.h>
+#include "board_config.h"
#include "kinetis_internal.h"
-#include "internal.h"
-
-/****************************************************************************
- * Definitions
- ****************************************************************************/
-
-/* CONFIG_DEBUG_LEDS enables debug output from this file (needs CONFIG_DEBUG
- * with CONFIG_DEBUG_VERBOSE too)
- */
-
-#ifdef CONFIG_DEBUG_LEDS
-# define leddbg lldbg
-# define ledvdbg llvdbg
-#else
-# define leddbg(x...)
-# define ledvdbg(x...)
-#endif
-
-/****************************************************************************
- * Private Data
- ****************************************************************************/
-
-/****************************************************************************
- * Private Functions
- ****************************************************************************/
-
-/****************************************************************************
- * Public Functions
- ****************************************************************************/
-
-/****************************************************************************
- * Name: board_led_initialize
- *
- * Description:
- * Initialize LED GPIOs so that LEDs can be controlled.
- *
- ****************************************************************************/
-//#ifdef CONFIG_ARCH_LEDS
-
-#define GPIO_LED0 (PIN_PORTC | PIN5 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED1 (PIN_PORTD | PIN1 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED2 (PIN_PORTC | PIN0 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED3 (PIN_PORTB | PIN0 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED4 (PIN_PORTB | PIN1 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED5 (PIN_PORTB | PIN3 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED6 (PIN_PORTB | PIN2 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED7 (PIN_PORTD | PIN5 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-#define GPIO_LED8 (PIN_PORTD | PIN6 | GPIO_HIGHDRIVE | GPIO_OUTPUT_ONE)
-
-/* Delay used to blink all leds once (to verify that system is up) */
-#define LED_DELAY_LOOPS 1000000
+void
+led_init(void)
+{
+ kinetis_pinconfig(GPIO_LED0);
+}
-static void set_led(int led, bool value)
+void led_set(int led, bool value)
{
switch(led) {
- case LED_STARTED:
- kinetis_gpiowrite(GPIO_LED0, value);
- break;
- case LED_HEAPALLOCATE:
- kinetis_gpiowrite(GPIO_LED1, value);
- break;
- case LED_IRQSENABLED:
- kinetis_gpiowrite(GPIO_LED2, value);
- break;
- case LED_STACKCREATED:
- kinetis_gpiowrite(GPIO_LED3, value);
- break;
- case LED_INIRQ:
- kinetis_gpiowrite(GPIO_LED4, value);
- break;
- case LED_SIGNAL:
- kinetis_gpiowrite(GPIO_LED5, value);
- break;
- case LED_ASSERTION:
- kinetis_gpiowrite(GPIO_LED6, value);
- break;
- case LED_PANIC:
- kinetis_gpiowrite(GPIO_LED7, value);
+ case 0:
+ kinetis_gpiowrite(led, value);
break;
default:
- kinetis_gpiowrite(GPIO_LED8, value);
- break;
- }
-}
-
-__EXPORT void led_init(void)
-{
- volatile unsigned long counter = 0;
-
- kinetis_pinconfig(GPIO_LED0);
- kinetis_pinconfig(GPIO_LED1);
- kinetis_pinconfig(GPIO_LED2);
- kinetis_pinconfig(GPIO_LED3);
- kinetis_pinconfig(GPIO_LED4);
- kinetis_pinconfig(GPIO_LED5);
- kinetis_pinconfig(GPIO_LED6);
- kinetis_pinconfig(GPIO_LED7);
- kinetis_pinconfig(GPIO_LED8);
-
- set_led(LED_STARTED, true);
- set_led(LED_HEAPALLOCATE, true);
- set_led(LED_IRQSENABLED, true);
- set_led(LED_STACKCREATED, true);
- set_led(LED_INIRQ, true);
- set_led(LED_SIGNAL, true);
- set_led(LED_ASSERTION, true);
- set_led(LED_PANIC, true);
- kinetis_gpiowrite(GPIO_LED8, true);
-
- counter = 0;
- while(counter < LED_DELAY_LOOPS) {
- ++counter;
+ return;
}
-
- set_led(LED_HEAPALLOCATE, false);
- set_led(LED_IRQSENABLED, false);
- set_led(LED_STACKCREATED, false);
- set_led(LED_INIRQ, false);
- set_led(LED_SIGNAL, false);
- set_led(LED_ASSERTION, false);
- set_led(LED_PANIC, false);
- kinetis_gpiowrite(GPIO_LED8, false);
-
- counter = 0;
- while(counter < LED_DELAY_LOOPS) {
- ++counter;
- }
-}
-
-/*
-static void led_on(int led)
-{
- set_led(led, true);
}
-
-static void led_off(int led)
-{
- set_led(led, false);
- }*/
-
-//#endif /* CONFIG_ARCH_LEDS */