From c40b5490f41c11c95ba0607487a46beb36c01452 Mon Sep 17 00:00:00 2001
From: Peter Barker <pbarker@barker.dropbear.id.au>
Date: Thu, 1 Oct 2020 15:43:50 +1000
Subject: [PATCH] AP_HAL_SITL: stop setting of pull-up resistors affecting
 SIM_PIN_MASK

---
 libraries/AP_HAL_SITL/GPIO.cpp | 18 +++++++++++++++++-
 libraries/AP_HAL_SITL/GPIO.h   |  2 ++
 2 files changed, 19 insertions(+), 1 deletion(-)

diff --git a/libraries/AP_HAL_SITL/GPIO.cpp b/libraries/AP_HAL_SITL/GPIO.cpp
index 5654148adb..ec195e7c08 100644
--- a/libraries/AP_HAL_SITL/GPIO.cpp
+++ b/libraries/AP_HAL_SITL/GPIO.cpp
@@ -11,7 +11,16 @@ void GPIO::init()
 {}
 
 void GPIO::pinMode(uint8_t pin, uint8_t output)
-{}
+{
+    if (pin > 7) {
+        return;
+    }
+    if (output) {
+        pin_mode_is_write |= (1U<<pin);
+    } else {
+        pin_mode_is_write &= ~(1U<<pin);
+    }
+}
 
 uint8_t GPIO::read(uint8_t pin)
 {
@@ -33,6 +42,13 @@ void GPIO::write(uint8_t pin, uint8_t value)
     if (!_sitlState->_sitl) {
         return;
     }
+
+    if (pin < 8) {
+        if (!(pin_mode_is_write & (1U<<pin))) {
+            // ignore setting of pull-up resistors
+            return;
+        }
+    }
     uint16_t mask = static_cast<uint16_t>(_sitlState->_sitl->pin_mask.get());
     uint16_t new_mask = mask;
 
diff --git a/libraries/AP_HAL_SITL/GPIO.h b/libraries/AP_HAL_SITL/GPIO.h
index 4e94379091..38af0571e6 100644
--- a/libraries/AP_HAL_SITL/GPIO.h
+++ b/libraries/AP_HAL_SITL/GPIO.h
@@ -19,6 +19,8 @@ public:
 
 private:
     SITL_State *_sitlState;
+
+    uint8_t pin_mode_is_write;
 };
 
 class HALSITL::DigitalSource : public AP_HAL::DigitalSource {