1 files changed, 83 insertions, 0 deletions
diff --git a/FreeRTOS/Demo/RISC-V_RV32_SiFive_HiFive1_FreedomStudio/freedom-metal/src/drivers/sifive_gpio-leds.c b/FreeRTOS/Demo/RISC-V_RV32_SiFive_HiFive1_FreedomStudio/freedom-metal/src/drivers/sifive_gpio-leds.c
new file mode 100644
index 000000000..68f72d5bd
--- /dev/null
+++ b/FreeRTOS/Demo/RISC-V_RV32_SiFive_HiFive1_FreedomStudio/freedom-metal/src/drivers/sifive_gpio-leds.c
@@ -0,0 +1,83 @@
+/* Copyright 2018 SiFive, Inc */
+/* SPDX-License-Identifier: Apache-2.0 */
+
+#include <metal/machine/platform.h>
+
+#ifdef METAL_SIFIVE_GPIO_LEDS
+
+#include <string.h>
+#include <metal/gpio.h>
+#include <metal/drivers/sifive_gpio-leds.h>
+#include <metal/machine.h>
+
+int  __metal_driver_led_exist (struct metal_led *led, char *label)
+{
+    if (strcmp(__metal_driver_sifive_gpio_led_label(led), label) == 0) {
+        return 1;
+    }
+    return 0;
+}
+
+void __metal_driver_led_enable (struct metal_led *led)
+{
+    int pin;
+    struct metal_gpio *gpio;
+
+    pin = __metal_driver_sifive_gpio_led_pin(led);
+    gpio =  __metal_driver_sifive_gpio_led_gpio(led);
+
+    if (gpio != NULL) {
+        /* Configure LED as output */
+        metal_gpio_disable_input((struct metal_gpio *) gpio, pin);
+        metal_gpio_enable_output((struct metal_gpio *) gpio, pin);
+    }
+}
+
+void __metal_driver_led_on (struct metal_led *led)
+{
+    int pin;
+    struct metal_gpio *gpio;
+
+    pin = __metal_driver_sifive_gpio_led_pin(led);
+    gpio =  __metal_driver_sifive_gpio_led_gpio(led);
+
+    if (gpio != NULL) {
+        metal_gpio_set_pin((struct metal_gpio *) gpio, pin, 1);
+    }
+}
+
+void __metal_driver_led_off (struct metal_led *led)
+{
+    int pin;
+    struct metal_gpio *gpio;
+
+    pin = __metal_driver_sifive_gpio_led_pin(led);
+    gpio =  __metal_driver_sifive_gpio_led_gpio(led);
+
+    if (gpio != NULL) {
+        metal_gpio_set_pin((struct metal_gpio *) gpio, pin, 0);
+    }
+}
+
+void __metal_driver_led_toggle (struct metal_led *led)
+{
+    int pin;
+    struct metal_gpio *gpio;
+
+    pin = __metal_driver_sifive_gpio_led_pin(led);
+    gpio =  __metal_driver_sifive_gpio_led_gpio(led);
+
+    if (gpio != NULL) {
+        metal_gpio_toggle_pin((struct metal_gpio *) gpio, pin);
+    }
+}
+
+__METAL_DEFINE_VTABLE(__metal_driver_vtable_sifive_led) = {
+    .led_vtable.led_exist   = __metal_driver_led_exist,
+    .led_vtable.led_enable  = __metal_driver_led_enable,
+    .led_vtable.led_on      = __metal_driver_led_on,
+    .led_vtable.led_off     = __metal_driver_led_off,
+    .led_vtable.led_toggle  = __metal_driver_led_toggle,
+};
+
+#endif