From a9ce9a8365eb66507b9bcacb4236af77bd33c620 Mon Sep 17 00:00:00 2001
From: Martin Fink <martin@finkmartin.com>
Date: Tue, 25 Jun 2024 14:45:12 +0200
Subject: Add support for `udf`

---
 src/armv8/a64.rs | 26 ++++++++++++++++++++++----
 1 file changed, 22 insertions(+), 4 deletions(-)

(limited to 'src/armv8')

diff --git a/src/armv8/a64.rs b/src/armv8/a64.rs
index 20098b9..87ded05 100644
--- a/src/armv8/a64.rs
+++ b/src/armv8/a64.rs
@@ -1145,6 +1145,7 @@ impl SysOps {
 #[allow(missing_docs)]
 pub enum Opcode {
     Invalid,
+    UDF,
     MOVN,
     MOVK,
     MOVZ,
@@ -1737,6 +1738,7 @@ impl Display for Opcode {
     fn fmt(&self, fmt: &mut fmt::Formatter) -> fmt::Result {
         let text = match *self {
             Opcode::Invalid => "invalid",
+            Opcode::UDF => "udf",
             Opcode::MOVK => "movk",
             Opcode::ADC => "adc",
             Opcode::ADCS => "adcs",
@@ -3178,8 +3180,8 @@ impl Decoder<ARMv8> for InstDecoder {
             DataProcessingSimd2,
             DataProcessingImmediate,
             BranchExceptionSystem,
-            SME,
             SVE,
+            ReservedSME,
         }
 
         // from ARM architecture refrence manual for ARMv8, C3.1
@@ -3196,7 +3198,7 @@ impl Decoder<ARMv8> for InstDecoder {
 
         let section_bits = word >> 25;
         static SECTIONS: [Section; 16] = [
-            Section::SME,                            // 0000 // SME encodings
+            Section::ReservedSME,                    // 0000 // reserved or SME encodings
             Section::Unallocated,                    // 0001
             Section::SVE,                            // 0010 // SVE encodings
             Section::Unallocated,                    // 0011
@@ -3213,12 +3215,28 @@ impl Decoder<ARMv8> for InstDecoder {
             Section::LoadStore,                      // 1110
             Section::DataProcessingSimd2,            // 1111
         ];
-        let section = SECTIONS[(section_bits & 0x0f) as usize];
+        let section = SECTIONS[(section_bits & 0b1111) as usize];
 
 //        crate::armv8::a64::std::eprintln!("word: {:#x}, bits: {:#b}", word, section_bits & 0xf);
 
+        let op0 = (word >> 31) & 1;
         match section {
-            Section::SME => {
+            // Reserved encodings
+            Section::ReservedSME if op0 == 0 => {
+                let op1 = (word >> 16) & 0b1111_1111;
+                if op1 != 0 {
+                    return Err(DecodeError::IncompleteDecoder);
+                }
+                inst.opcode = Opcode::UDF;
+                inst.operands = [
+                    Operand::Imm16((word & 0xffff) as u16),
+                    Operand::Nothing,
+                    Operand::Nothing,
+                    Operand::Nothing,
+                ];
+            },
+            // SME encodings
+            Section::ReservedSME => {
                 return Err(DecodeError::IncompleteDecoder);
             },
             Section::SVE => {
-- 
cgit v1.1