Cactus test for exercising SMMUv3 driver to perform stage2 translation

Signed-off-by: Madhukar Pappireddy <madhukar.pappireddy@arm.com>
Change-Id: I498cb63aed497ab469a38e486a7943dd634e5b36
diff --git a/include/lib/mmio.h b/include/lib/mmio.h
index e8a7df0..c788af3 100644
--- a/include/lib/mmio.h
+++ b/include/lib/mmio.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2018, Arm Limited. All rights reserved.
+ * Copyright (c) 2018-2021, Arm Limited. All rights reserved.
  *
  * SPDX-License-Identifier: BSD-3-Clause
  */
@@ -24,16 +24,33 @@
 	*(volatile uint32_t*)addr = value;
 }
 
+static inline void mmio_write32_offset(uintptr_t addr, uint32_t byte_off,
+					uint32_t data)
+{
+	mmio_write_32((uintptr_t)((uint8_t *)addr + byte_off), data);
+}
+
 static inline uint32_t mmio_read_32(uintptr_t addr)
 {
 	return *(volatile uint32_t*)addr;
 }
 
+static inline uint32_t mmio_read32_offset(uintptr_t addr, uint32_t byte_off)
+{
+	return mmio_read_32((uintptr_t)((uint8_t *)addr + byte_off));
+}
+
 static inline void mmio_write_64(uintptr_t addr, uint64_t value)
 {
 	*(volatile uint64_t*)addr = value;
 }
 
+static inline void mmio_write64_offset(uintptr_t addr, uint32_t byte_off,
+					uint64_t data)
+{
+	mmio_write_64((uintptr_t)((uint8_t *)addr + byte_off), data);
+}
+
 static inline uint64_t mmio_read_64(uintptr_t addr)
 {
 	return *(volatile uint64_t*)addr;
diff --git a/include/runtime_services/cactus_test_cmds.h b/include/runtime_services/cactus_test_cmds.h
index d03a97f..483a7f4 100644
--- a/include/runtime_services/cactus_test_cmds.h
+++ b/include/runtime_services/cactus_test_cmds.h
@@ -299,4 +299,17 @@
 	return (enum interrupt_pin)ret.ret6;
 }
 
+/**
+ * Request to initiate DMA transaction by upstream peripheral.
+ *
+ * The command id is the hex representation of the string "SMMU"
+ */
+#define CACTUS_DMA_SMMUv3_CMD           (0x534d4d55)
+
+static inline smc_ret_values cactus_send_dma_cmd(
+	ffa_vm_id_t source, ffa_vm_id_t dest)
+{
+	return cactus_send_cmd(source, dest, CACTUS_DMA_SMMUv3_CMD, 0, 0, 0,
+			       0);
+}
 #endif