Changeset 9b7a1da in rtems

Timestamp:

05/18/23 18:47:30 (7 months ago)

Author:

Alex White <alex.white@…>

Branches:

master

Children:

bcef89f2

Parents:

59f9ed2

git-author:

Alex White <alex.white@…> (05/18/23 18:47:30)

git-committer:

Joel Sherrill <joel@…> (05/19/23 17:32:18)

Message:

bsps/microblaze: Add device tree support to GPIO

Location:

bsps/microblaze/microblaze_fpga

Files:

• gpio/microblaze-gpio.c (modified) (1 diff)
• include/bsp/microblaze-gpio.h (modified) (1 diff)

bsps/microblaze/microblaze_fpga/gpio/microblaze-gpio.c

@@ -37 +37 @@
 
 #include <bsp/fatal.h>
+#include <bsp/fdt.h>
 #include <bsp/microblaze-gpio.h>
+
+#include <libfdt.h>
 
 #ifdef __cplusplus
 extern "C" {
 #endif /* __cplusplus */
+
+#ifdef BSP_MICROBLAZE_FPGA_USE_FDT
+rtems_status_code microblaze_gpio_init_context_from_fdt(
+  Microblaze_GPIO_context *context,
+  int index
+)
+{
+  if ( context == NULL ) {
+    return RTEMS_INVALID_ADDRESS;
+  }
+
+  const char* compatible = "xlnx,xps-gpio-1.00.a";
+  const void *fdt = bsp_fdt_get();
+  int node = fdt_node_offset_by_compatible( fdt, -1, compatible );
+  if ( node < 0 ) {
+    return RTEMS_INVALID_NUMBER;
+  }
+
+  /* Get the desired GPIO node if index is greater than zero. */
+  for(int i = 0; i < index; i++) {
+    node = fdt_node_offset_by_compatible( fdt, node, compatible );
+    if ( node < 0 ) {
+      return RTEMS_INVALID_NUMBER;
+    }
+  }
+
+  const uint32_t *prop;
+  prop = fdt_getprop( fdt, node, "reg", NULL );
+  if ( prop != NULL ) {
+    context->regs = (Microblaze_GPIO_registers *) fdt32_to_cpu( prop[0] );
+  } else {
+    return RTEMS_INVALID_NUMBER;
+  }
+
+  prop = fdt_getprop( fdt, node, "xlnx,is-dual", NULL );
+  if ( prop != NULL ) {
+    context->is_dual = fdt32_to_cpu( prop[0] ) != 0 ? true : false;
+  } else {
+    return RTEMS_INVALID_NUMBER;
+  }
+
+  prop = fdt_getprop( fdt, node, "xlnx,interrupt-present", NULL );
+  if ( prop != NULL ) {
+    context->has_interrupts = fdt32_to_cpu( prop[0] ) != 0 ? true : false;
+  } else {
+    return RTEMS_INVALID_NUMBER;
+  }
+
+  if ( context->has_interrupts ) {
+    prop = fdt_getprop( fdt, node, "interrupts", NULL );
+    if ( prop != NULL ) {
+      context->irq = fdt32_to_cpu( prop[0] );
+    } else {
+      return RTEMS_INVALID_NUMBER;
+    }
+  }
+
+  return RTEMS_SUCCESSFUL;
+}
+#endif /* BSP_MICROBLAZE_FPGA_USE_FDT */
 
 void microblaze_gpio_set_data_direction(

bsps/microblaze/microblaze_fpga/include/bsp/microblaze-gpio.h

@@ -130 +130 @@
 } Microblaze_GPIO_context;
 
+#ifdef BSP_MICROBLAZE_FPGA_USE_FDT
+/**
+ * @brief Initialize GPIO context from FDT.
+ *
+ * @param[in] context the GPIO context to initialize
+ * @param[in] index the zero-based GPIO index in the FDT
+ *
+ * @retval RTEMS_SUCCESSFUL on success
+ * @retval RTEMS_INVALID_NUMBER if the index is invalid or the node is missing a
+ *         required property
+ * @retval RTEMS_INVALID_ADDRESS if the context is NULL
+ */
+rtems_status_code microblaze_gpio_init_context_from_fdt(
+  Microblaze_GPIO_context *context,
+  int index
+);
+#endif /* BSP_MICROBLAZE_FPGA_USE_FDT */
+
 /**
  * @brief Set pin configuration for the specified GPIO channel.