From 109eff0191fef3b4e939b3d506d6c31fcbd6ab0c Mon Sep 17 00:00:00 2001
From: Kevin O'Connor <kevin@koconnor.net>
Date: Mon, 20 Aug 2018 16:27:46 -0400
Subject: [PATCH] sam3x8e: Add support for gpio_x_reset()

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
---
 src/sam3x8e/gpio.c | 58 ++++++++++++++++++++++++++++------------------
 src/sam3x8e/gpio.h |  2 ++
 2 files changed, 38 insertions(+), 22 deletions(-)

diff --git a/src/sam3x8e/gpio.c b/src/sam3x8e/gpio.c
index acfe0d90..9b7cca65 100644
--- a/src/sam3x8e/gpio.c
+++ b/src/sam3x8e/gpio.c
@@ -53,21 +53,29 @@ gpio_out_setup(uint8_t pin, uint8_t val)
     if (GPIO2PORT(pin) >= ARRAY_SIZE(digital_regs))
         goto fail;
     Pio *regs = digital_regs[GPIO2PORT(pin)];
-    uint32_t bit = GPIO2BIT(pin);
-    irqstatus_t flag = irq_save();
-    if (val)
-        regs->PIO_SODR = bit;
-    else
-        regs->PIO_CODR = bit;
-    regs->PIO_OER = bit;
-    regs->PIO_OWER = bit;
-    regs->PIO_PER = bit;
-    irq_restore(flag);
-    return (struct gpio_out){ .regs=regs, .bit=bit };
+    struct gpio_out g = { .regs=regs, .bit=GPIO2BIT(pin) };
+    gpio_out_reset(g, val);
+    return g;
 fail:
     shutdown("Not an output pin");
 }
 
+void
+gpio_out_reset(struct gpio_out g, uint8_t val)
+{
+    Pio *regs = g.regs;
+    irqstatus_t flag = irq_save();
+    if (val)
+        regs->PIO_SODR = g.bit;
+    else
+        regs->PIO_CODR = g.bit;
+    regs->PIO_OER = g.bit;
+    regs->PIO_OWER = g.bit;
+    regs->PIO_PER = g.bit;
+    regs->PIO_PUDR = g.bit;
+    irq_restore(flag);
+}
+
 void
 gpio_out_toggle_noirq(struct gpio_out g)
 {
@@ -100,22 +108,28 @@ gpio_in_setup(uint8_t pin, int8_t pull_up)
     if (GPIO2PORT(pin) >= ARRAY_SIZE(digital_regs))
         goto fail;
     uint32_t port = GPIO2PORT(pin);
-    Pio *regs = digital_regs[port];
-    uint32_t bit = GPIO2BIT(pin);
-    irqstatus_t flag = irq_save();
     PMC->PMC_PCER0 = 1 << (ID_PIOA + port);
-    if (pull_up)
-        regs->PIO_PUER = bit;
-    else
-        regs->PIO_PUDR = bit;
-    regs->PIO_ODR = bit;
-    regs->PIO_PER = bit;
-    irq_restore(flag);
-    return (struct gpio_in){ .regs=regs, .bit=bit };
+    struct gpio_in g = { .regs=digital_regs[port], .bit=GPIO2BIT(pin) };
+    gpio_in_reset(g, pull_up);
+    return g;
 fail:
     shutdown("Not an input pin");
 }
 
+void
+gpio_in_reset(struct gpio_in g, int8_t pull_up)
+{
+    Pio *regs = g.regs;
+    irqstatus_t flag = irq_save();
+    if (pull_up)
+        regs->PIO_PUER = g.bit;
+    else
+        regs->PIO_PUDR = g.bit;
+    regs->PIO_ODR = g.bit;
+    regs->PIO_PER = g.bit;
+    irq_restore(flag);
+}
+
 uint8_t
 gpio_in_read(struct gpio_in g)
 {
diff --git a/src/sam3x8e/gpio.h b/src/sam3x8e/gpio.h
index d40eec21..ec3ea821 100644
--- a/src/sam3x8e/gpio.h
+++ b/src/sam3x8e/gpio.h
@@ -10,6 +10,7 @@ struct gpio_out {
     uint32_t bit;
 };
 struct gpio_out gpio_out_setup(uint8_t pin, uint8_t val);
+void gpio_out_reset(struct gpio_out g, uint8_t val);
 void gpio_out_toggle_noirq(struct gpio_out g);
 void gpio_out_toggle(struct gpio_out g);
 void gpio_out_write(struct gpio_out g, uint8_t val);
@@ -19,6 +20,7 @@ struct gpio_in {
     uint32_t bit;
 };
 struct gpio_in gpio_in_setup(uint8_t pin, int8_t pull_up);
+void gpio_in_reset(struct gpio_in g, int8_t pull_up);
 uint8_t gpio_in_read(struct gpio_in g);
 
 struct gpio_adc {