sart: Add SARTv0 support

SARTv0 is used on Apple A11 SoC.

Signed-off-by: Nick Chan <towinchenmi@gmail.com>

Author: asdfugil

src/sart.c

@@ -18,6 +18,18 @@ struct sart_dev {
 
 #define APPLE_SART_MAX_ENTRIES 16
 
+/* SARTv0 registers */
+#define APPLE_SART0_CONFIG(idx)       (0x00 + 4 * (idx))
+#define APPLE_SART0_CONFIG_FLAGS      GENMASK(28, 24)
+#define APPLE_SART0_CONFIG_SIZE       GENMASK(18, 0)
+#define APPLE_SART0_CONFIG_SIZE_SHIFT 12
+#define APPLE_SART0_CONFIG_SIZE_MAX   GENMASK(18, 0)
+
+#define APPLE_SART0_PADDR(idx)  (0x40 + 4 * (idx))
+#define APPLE_SART0_PADDR_SHIFT 12
+
+#define APPLE_SART0_FLAGS_ALLOW 0xf
+
 /* SARTv2 registers */
 #define APPLE_SART2_CONFIG(idx)       (0x00 + 4 * (idx))
 #define APPLE_SART2_CONFIG_FLAGS      GENMASK(31, 24)
@@ -42,6 +54,40 @@ struct sart_dev {
 
 #define APPLE_SART3_FLAGS_ALLOW 0xff
 
+static void sart0_get_entry(sart_dev_t *sart, int index, u8 *flags, void **paddr, size_t *size)
+{
+    u32 cfg = read32(sart->base + APPLE_SART0_CONFIG(index));
+    *flags = FIELD_GET(APPLE_SART0_CONFIG_FLAGS, cfg);
+    *size = (size_t)FIELD_GET(APPLE_SART0_CONFIG_SIZE, cfg) << APPLE_SART0_CONFIG_SIZE_SHIFT;
+    *paddr =
+        (void *)((u64)read32(sart->base + APPLE_SART0_PADDR(index)) << APPLE_SART0_PADDR_SHIFT);
+}
+
+static bool sart0_set_entry(sart_dev_t *sart, int index, u8 flags, void *paddr_, size_t size)
+{
+    u32 cfg;
+    u64 paddr = (u64)paddr_;
+
+    if (size & ((1 << APPLE_SART0_CONFIG_SIZE_SHIFT) - 1))
+        return false;
+    if (paddr & ((1 << APPLE_SART0_PADDR_SHIFT) - 1))
+        return false;
+
+    size >>= APPLE_SART0_CONFIG_SIZE_SHIFT;
+    paddr >>= APPLE_SART0_PADDR_SHIFT;
+
+    if (size > APPLE_SART0_CONFIG_SIZE_MAX)
+        return false;
+
+    cfg = FIELD_PREP(APPLE_SART0_CONFIG_FLAGS, flags);
+    cfg |= FIELD_PREP(APPLE_SART0_CONFIG_SIZE, size);
+
+    write32(sart->base + APPLE_SART0_PADDR(index), paddr);
+    write32(sart->base + APPLE_SART0_CONFIG(index), cfg);
+
+    return true;
+}
+
 static void sart2_get_entry(sart_dev_t *sart, int index, u8 *flags, void **paddr, size_t *size)
 {
     u32 cfg = read32(sart->base + APPLE_SART2_CONFIG(index));
@@ -121,9 +167,14 @@ sart_dev_t *sart_init(const char *adt_path)
     }
 
     const u32 *sart_version = adt_getprop(adt, node, "sart-version", NULL);
+    const u32 sart_version_zero = 0;
     if (!sart_version) {
-        printf("sart: SART %s has no sart-version property\n", adt_path);
-        return NULL;
+        if (adt_is_compatible(adt, node, "sart,t8015")) {
+            sart_version = &sart_version_zero;
+        } else {
+            printf("sart: SART %s has no sart-version property\n", adt_path);
+            return NULL;
+        }
     }
 
     sart_dev_t *sart = calloc(1, sizeof(*sart));
@@ -133,6 +184,10 @@ sart_dev_t *sart_init(const char *adt_path)
     sart->base = base;
 
     switch (*sart_version) {
+        case 0:
+            sart->get_entry = sart0_get_entry;
+            sart->set_entry = sart0_set_entry;
+            sart->flags_allow = APPLE_SART0_FLAGS_ALLOW;
         case 2:
             sart->get_entry = sart2_get_entry;
             sart->set_entry = sart2_set_entry;