From 19f915b77992d4b3201fd2127bfe2ac1bfb7bd9c Mon Sep 17 00:00:00 2001
From: Hector Martin <marcan@marcan.st>
Date: Fri, 5 Feb 2021 01:09:47 +0900
Subject: [PATCH] aic_test.py: more experiments

Signed-off-by: Hector Martin <marcan@marcan.st>
---
 proxyclient/aic_test.py | 120 +++++++++++++++++++++++++++++++++++++---
 1 file changed, 111 insertions(+), 9 deletions(-)

diff --git a/proxyclient/aic_test.py b/proxyclient/aic_test.py
index 3ee15571..294f5ccd 100644
--- a/proxyclient/aic_test.py
+++ b/proxyclient/aic_test.py
@@ -8,6 +8,10 @@ UFCON = 0x235200008
 UTRSTAT = 0x235200010
 
 AIC = 0x23b100000
+
+AIC_RST = AIC + 0xc
+AIC_CFG = AIC + 0x10
+
 AIC_TB = 0x23b108000
 AIC_TGT_DST = AIC + 0x3000
 AIC_SW_GEN_SET = AIC + 0x4000
@@ -36,18 +40,44 @@ def cpoll():
     mon.poll()
     print(">")
 
+p.write32(AIC + 0xc, 1)
+p.write32(AIC + 0x10, 0xe0777971)
+p.write32(AIC + 0x18, 0)
+p.write32(AIC + 0x20, 0xffffffff)
+p.write32(AIC + 0x24, 0xffffffff)
+p.write32(AIC + 0x28, 0xffffffff)
+p.write32(AIC + 0x2c, 0xffffffff)
+p.write32(AIC + 0x30, 0xffffffff)
+p.write32(AIC + 0x34, 0xffffffff)
+p.write32(AIC + 0x38, 0xffffffff)
+p.write32(AIC + 0x3c, 0xffffffff)
+p.write32(AIC + 0x40, 0xffffffff)
+p.write32(AIC + 0x38, 0xffffffff)
+#p.write32(AIC + 0xc, 0)
+
 p.memset32(AIC_MASK_SET, 0xffffffff, 0x80)
 p.memset32(AIC_SW_GEN_CLR, 0xffffffff, 0x80)
-p.memset32(AIC_TGT_DST, 1, 0x1000)
+p.memset32(AIC_TGT_DST, 0x1, 0x1000)
+#p.memset32(AIC_MASK_CLR, 0xffffffff, 0x80)
 
-#mon.add(AIC + 0x0000, 0x100)
-#mon.add(AIC + 0x1000, 0x100)
-#mon.add(AIC + 0x2008, 0x0f8)
+#p.write32(AIC + 0x10, 0xe0777971)
+
+mon.add(AIC + 0x0000, 0x1000)
+mon.add(AIC + 0x2080, 0x040)
+mon.add(AIC + 0x4000, 0x200)
+mon.add(AIC + 0x5000, 0x080)
+mon.add(AIC + 0x5080, 0x080)
+mon.add(AIC + 0x5100, 0x080)
+mon.add(AIC + 0x5180, 0x080)
+mon.add(AIC + 0x5200, 0x080)
+mon.add(AIC + 0x5280, 0x080)
+mon.add(AIC + 0x5300, 0x080)
+mon.add(AIC + 0x5380, 0x080)
 #mon.add(AIC + 0x3000, 0x400)
 #mon.add(AIC + 0x4000, 0x400)
 #mon.add(AIC + 0x8000, 0x20)
 #mon.add(AIC + 0x8030, 0xd0)
-mon.add(0x235200000, 0x20)
+#mon.add(0x235200000, 0x20)
 
 def test_ipi():
     cpoll()
@@ -105,9 +135,18 @@ def test_timer():
     freq = u.mrs(CNTFRQ_EL0)
     print("Timer freq: %d" % freq)
 
-    u.msr(CNTP_CTL_EL0, 0)
-    u.msr(CNTP_TVAL_EL0, freq * 2)
-    u.msr(CNTP_CTL_EL0, 1)
+    #u.msr(CNTP_CTL_EL0, 0)
+    #u.msr(CNTP_TVAL_EL0, freq * 2)
+    #u.msr(CNTP_CTL_EL0, 1)
+    #u.msr(CNTV_CTL_EL0, 0)
+    #u.msr(CNTV_TVAL_EL0, freq * 2)
+    #u.msr(CNTV_CTL_EL0, 1)
+    #u.msr(CNTHV_CTL_EL2, 0)
+    #u.msr(CNTHV_TVAL_EL2, freq * 2)
+    #u.msr(CNTHV_CTL_EL2, 1)
+    u.msr(CNTHP_CTL_EL2, 0)
+    u.msr(CNTHP_TVAL_EL2, freq * 2)
+    u.msr(CNTHP_CTL_EL2, 1)
 
     iface.ttymode()
 
@@ -296,8 +335,71 @@ UCON    UTRSTAT
 
 
 
+def test_smp_ipi():
+    code = u.malloc(0x1000)
 
+    c = asm.ARMAsm("""
+#define sys_reg(op0, op1, CRn, CRm, op2) s##op0##_##op1##_c##CRn##_c##CRm##_##op2
+#define SYS_CYC_OVRD           sys_reg(3, 5, 15, 5, 0)
+
+        msr DAIFClr, 7
+        ldr x1, =0x000000
+        msr SYS_CYC_OVRD, x1
+        mrs x0, SYS_CYC_OVRD
+        mov x1, #0x1000000
+1:
+        subs x1, x1, #1
+        mrs x0, HCR_EL2
+        bne 1b
+        ret
+""", code)
+
+    iface.writemem(code, c.data)
+    p.dc_cvau(code, len(c.data))
+    p.ic_ivau(code, len(c.data))
+
+    print("Enable IRQs on secondaries")
+    for i in range(1, 8):
+        ret = p.smp_call_sync(i, code)
+        print("0x%x"%ret)
+
+    #e0477971
+    #p.write32(AIC + 0x10, 0xe0777971)
+    #p.write32(AIC + 0x28, 0xffffffff)
+
+    cpoll()
+
+    print("Clear IPI")
+    p.write32(AIC_IPI_CLR, 0xffffffff)
+    p.write32(AIC_IPI_MASK_CLR, 0xffffffff)
+    for i in range(8):
+        p.write32(AIC_IPI_CLR+0x3000+i*0x80, 0xffffffff)
+        p.write32(AIC_IPI_MASK_CLR+0x3000+i*0x80, 0xffffffff)
+
+    cpoll()
+
+    print("Set IPI")
+    #p.write32(AIC_IPI_SET, 0x00000004)
+    #p.write32(AIC_IPI_SET, 0x00000000)
+
+    cpoll()
+    print("Clear IPI")
+    p.write32(AIC_IPI_CLR, 0xffffffff)
+    p.write32(AIC_IPI_MASK_CLR, 0xffffffff)
+    for i in range(8):
+        p.write32(AIC_IPI_CLR+0x3000+i*0x80, 1)
+        p.write32(AIC_IPI_MASK_CLR+0x3000+i*0x80, 1)
+
+def test_smp_affinity():
+    p.write32(AIC_TGT_DST, 0x6)
+    p.write32(AIC_TGT_DST+4, 0xfe)
+    p.write32(AIC_TGT_DST+8, 0xfe)
+    p.write32(AIC_TGT_DST+12, 0x6)
+    p.write32(AIC_SW_GEN_SET,0x8);
+    p.write32(AIC_MASK_CLR,0x8);
 
 #test_ipi()
 #test_timer()
-test_uart_irq()
+#test_uart_irq()
+test_smp_ipi()
+test_smp_affinity()