localglobal

Author: soburi

cores/arduino/zephyrCommon.cpp

@@ -12,6 +12,70 @@ static const struct gpio_dt_spec arduino_pins[] = {DT_FOREACH_PROP_ELEM_SEP(
 
 namespace {
 
+#define DEVICE_GPIO(n, p, i) DEVICE_DT_GET(DT_PROP_BY_IDX(n, p, i))
+constexpr const struct device *gpios[] = {
+  DT_FOREACH_PROP_ELEM_SEP(DT_PATH(zephyr_user), gpios, DEVICE_GPIO, (,))
+};
+
+#define PROP_NGPIOS(n, p, i) DT_PROP(DT_PROP_BY_IDX(n, p, i), ngpios)
+constexpr uint32_t pins[] = {
+  DT_FOREACH_PROP_ELEM_SEP(DT_PATH(zephyr_user), gpios, PROP_NGPIOS, (,))
+};
+
+constexpr inline const struct device *local_gpio_port_recursive(pin_size_t pin,
+								const struct device *const *ctrl,
+								const uint32_t *end, size_t n)
+{
+  return (n == 0)         ? nullptr
+	 : (pin < end[0]) ? ctrl[0]
+			  : local_gpio_port_recursive(pin, ctrl + 1, end + 1, n - 1);
+}
+
+constexpr inline size_t port_index_recursive(const struct device *target,
+					     const struct device *const *table, pin_size_t idx,
+					     size_t n)
+{
+  return (n == 0)               ? size_t(-1)
+	 : (target == table[0]) ? idx
+				: port_index_recursive(target, table + 1, idx + 1, n - 1);
+}
+
+constexpr inline const struct device *local_gpio_port(pin_size_t gpin)
+{
+  return local_gpio_port_recursive(gpin, gpios, pins, ARRAY_SIZE(gpios));
+}
+
+constexpr inline pin_size_t local_gpio_pin(pin_size_t gpin)
+{
+  return gpin - pins[port_index_recursive(local_gpio_port(gpin), gpios, 0, ARRAY_SIZE(gpios))];
+}
+
+constexpr inline pin_size_t global_gpio_pin_(size_t port_idx, pin_size_t lpin)
+{
+  return port_idx == size_t(-1) ? size_t(-1) : pins[port_idx] + lpin;
+}
+
+constexpr inline pin_size_t global_gpio_pin(const struct device *lport, pin_size_t lpin)
+{
+  return global_gpio_pin_(port_index_recursive(lport, gpios, 0, ARRAY_SIZE(gpios)), lpin);
+}
+
+constexpr inline uint32_t local_gpio_dt_flags(int)
+{
+  return 0;
+}
+
+inline int global_gpio_pin_get(pin_size_t pinNumber)
+{
+  return gpio_pin_get(local_gpio_port(pinNumber), local_gpio_pin(pinNumber));
+}
+
+inline int global_gpio_pin_configure(pin_size_t pinNumber, int flags)
+{
+  return gpio_pin_configure(local_gpio_port(pinNumber), local_gpio_pin(pinNumber), flags);
+}
+
+
 /*
  * Calculate GPIO ports/pins number statically from devicetree configuration
  */