From 1942414f983911658117658ac0f0cc171b4f56e6 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?=C3=96mer=20G=C3=BCven?=
 <97512+DragonWork@users.noreply.github.com>
Date: Sat, 7 May 2022 20:07:08 +0200
Subject: [PATCH] Auto-detect and adjust memory pointers when BCM2711 runs on
 high peripheral mode (35-bit full address mapping), i. e. using
 arm_peri_high=1 in config.txt on Raspberry Pi 4 et al.

---
 wiringPi/wiringPi.c | 47 +++++++++++++++++++++++++++++++----------------
 1 file changed, 31 insertions(+), 16 deletions(-)

diff --git a/wiringPi/wiringPi.c b/wiringPi/wiringPi.c
index d4b1e24..783fdd3 100644
--- a/wiringPi/wiringPi.c
+++ b/wiringPi/wiringPi.c
@@ -130,11 +130,11 @@ struct wiringPiNodeStruct *wiringPiNodes = NULL ;
 // Updates in September 2015 - all now static variables (and apologies for the caps)
 //	due to the Pi v2, v3, etc. and the new /dev/gpiomem interface
 
-static volatile unsigned int GPIO_PADS ;
-static volatile unsigned int GPIO_CLOCK_BASE ;
-static volatile unsigned int GPIO_BASE ;
-static volatile unsigned int GPIO_TIMER ;
-static volatile unsigned int GPIO_PWM ;
+static volatile unsigned long GPIO_PADS ;
+static volatile unsigned long GPIO_CLOCK_BASE ;
+static volatile unsigned long GPIO_BASE ;
+static volatile unsigned long GPIO_TIMER ;
+static volatile unsigned long GPIO_PWM ;
 
 #define	PAGE_SIZE		(4*1024)
 #define	BLOCK_SIZE		(4*1024)
@@ -213,11 +213,12 @@ volatile unsigned int *_wiringPiTimerIrqRaw ;
 // piGpioBase:
 //	The base address of the GPIO memory mapped hardware IO
 
-#define	GPIO_PERI_BASE_OLD  0x20000000
-#define	GPIO_PERI_BASE_2835 0x3F000000
-#define	GPIO_PERI_BASE_2711 0xFE000000
+#define	GPIO_PERI_BASE_OLD       0x0020000000
+#define	GPIO_PERI_BASE_2835      0x003F000000
+#define	GPIO_LOW_PERI_BASE_2711  0x00FE000000
+#define	GPIO_HIGH_PERI_BASE_2711 0x047E000000
 
-static volatile unsigned int piGpioBase = 0 ;
+static volatile unsigned long piGpioBase = 0 ;
 
 const char *piModelNames [21] =
 {
@@ -1220,7 +1221,7 @@ void pwmSetClock (int divisor)
 {
   uint32_t pwm_control ;
 
-  if (piGpioBase == GPIO_PERI_BASE_2711)
+  if ((piGpioBase == GPIO_LOW_PERI_BASE_2711) || (piGpioBase == GPIO_HIGH_PERI_BASE_2711))
   {
     divisor = 540*divisor/192;
   }
@@ -2311,8 +2312,22 @@ int wiringPiSetup (void)
     case PI_MODEL_4B:
     case PI_MODEL_400:
     case PI_MODEL_CM4:
-      piGpioBase = GPIO_PERI_BASE_2711 ;
+      piGpioBase = GPIO_LOW_PERI_BASE_2711 ;
       piGpioPupOffset = GPPUPPDN0 ;
+      FILE *iomemFd ;
+	  char line [120] ;
+      if ((iomemFd = fopen ("/proc/iomem", "r")) != NULL)
+      {
+	    while (fgets (line, 120, iomemFd) != NULL)
+	      if (strncmp (line, "47e200000", 9) == 0)
+	      {
+	        piGpioBase = GPIO_HIGH_PERI_BASE_2711 ;
+		    if (wiringPiDebug)
+	  	      printf ("wiringPi: BCM2711 high peripheral mode detected\n") ;
+	        break ;
+	      }
+	    fclose (iomemFd) ;
+      }
       break ;
 
     default:
@@ -2342,11 +2357,11 @@ int wiringPiSetup (void)
 
 // Set the offsets into the memory interface.
 
-  GPIO_PADS 	  = piGpioBase + 0x00100000 ;
-  GPIO_CLOCK_BASE = piGpioBase + 0x00101000 ;
-  GPIO_BASE	  = piGpioBase + 0x00200000 ;
-  GPIO_TIMER	  = piGpioBase + 0x0000B000 ;
-  GPIO_PWM	  = piGpioBase + 0x0020C000 ;
+  GPIO_PADS 	  = piGpioBase + 0x100000 ;
+  GPIO_CLOCK_BASE = piGpioBase + 0x101000 ;
+  GPIO_BASE	  	  = piGpioBase + 0x200000 ;
+  GPIO_TIMER	  = piGpioBase + 0x00B000 ;
+  GPIO_PWM	  	  = piGpioBase + 0x20C000 ;
 
 // Map the individual hardware components