Skip to main content

synth_backend/
arm_encoder.rs

1//! ARM Code Encoder - Converts ARM instructions to binary machine code
2//!
3//! Generates ARM32/Thumb-2 machine code from ARM instruction structures
4
5use synth_core::Result;
6use synth_core::target::FPUPrecision;
7use synth_synthesis::contracts::encoding as encoding_contracts;
8use synth_synthesis::{ArmOp, MemAddr, MveSize, Operand2, QReg, Reg, VfpReg};
9
10/// ARM instruction encoding
11pub struct ArmEncoder {
12    /// Use Thumb mode (vs ARM mode)
13    thumb_mode: bool,
14    /// FPU capability for VFP instruction encoding
15    #[allow(dead_code)]
16    fpu: Option<FPUPrecision>,
17}
18
19impl ArmEncoder {
20    /// Create a new ARM encoder in ARM32 mode
21    pub fn new_arm32() -> Self {
22        Self {
23            thumb_mode: false,
24            fpu: None,
25        }
26    }
27
28    /// Create a new ARM encoder in Thumb-2 mode
29    pub fn new_thumb2() -> Self {
30        Self {
31            thumb_mode: true,
32            fpu: None,
33        }
34    }
35
36    /// Create a new Thumb-2 encoder with FPU capability
37    pub fn new_thumb2_with_fpu(fpu: Option<FPUPrecision>) -> Self {
38        Self {
39            thumb_mode: true,
40            fpu,
41        }
42    }
43
44    /// Encode a single ARM instruction to bytes
45    pub fn encode(&self, op: &ArmOp) -> Result<Vec<u8>> {
46        if self.thumb_mode {
47            self.encode_thumb(op)
48        } else {
49            self.encode_arm(op)
50        }
51    }
52
53    /// Encode an ARM instruction in ARM32 mode (32-bit instructions)
54    fn encode_arm(&self, op: &ArmOp) -> Result<Vec<u8>> {
55        let instr: u32 = match op {
56            // Data processing instructions
57            ArmOp::Add { rd, rn, op2 } => {
58                let rd_bits = reg_to_bits(rd);
59                let rn_bits = reg_to_bits(rn);
60                let (op2_bits, i_flag) = encode_operand2(op2);
61
62                // ADD encoding: cond(4) | 00 | I(1) | 0100 | S(1) | Rn(4) | Rd(4) | operand2(12)
63                0xE0800000 // condition=always(E), opcode=ADD(0100), S=0
64                    | (i_flag << 25)
65                    | (rn_bits << 16)
66                    | (rd_bits << 12)
67                    | op2_bits
68            }
69
70            ArmOp::Sub { rd, rn, op2 } => {
71                let rd_bits = reg_to_bits(rd);
72                let rn_bits = reg_to_bits(rn);
73                let (op2_bits, i_flag) = encode_operand2(op2);
74
75                // SUB encoding: opcode=0010
76                0xE0400000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
77            }
78
79            // i64 support: ADDS, ADC, SUBS, SBC for ARM32
80            ArmOp::Adds { rd, rn, op2 } => {
81                let rd_bits = reg_to_bits(rd);
82                let rn_bits = reg_to_bits(rn);
83                let (op2_bits, i_flag) = encode_operand2(op2);
84
85                // ADDS encoding: opcode=0100, S=1
86                0xE0900000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
87            }
88
89            ArmOp::Adc { rd, rn, op2 } => {
90                let rd_bits = reg_to_bits(rd);
91                let rn_bits = reg_to_bits(rn);
92                let (op2_bits, i_flag) = encode_operand2(op2);
93
94                // ADC encoding: opcode=0101
95                0xE0A00000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
96            }
97
98            ArmOp::Subs { rd, rn, op2 } => {
99                let rd_bits = reg_to_bits(rd);
100                let rn_bits = reg_to_bits(rn);
101                let (op2_bits, i_flag) = encode_operand2(op2);
102
103                // SUBS encoding: opcode=0010, S=1
104                0xE0500000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
105            }
106
107            ArmOp::Sbc { rd, rn, op2 } => {
108                let rd_bits = reg_to_bits(rd);
109                let rn_bits = reg_to_bits(rn);
110                let (op2_bits, i_flag) = encode_operand2(op2);
111
112                // SBC encoding: opcode=0110
113                0xE0C00000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
114            }
115
116            ArmOp::Mul { rd, rn, rm } => {
117                let rd_bits = reg_to_bits(rd);
118                let rn_bits = reg_to_bits(rn);
119                let rm_bits = reg_to_bits(rm);
120
121                // MUL encoding: cond(4) | 000000 | A(1) | S(1) | Rd(4) | Rn(4) | Rs(4) | 1001 | Rm(4)
122                0xE0000090 | (rd_bits << 16) | (rn_bits << 8) | rm_bits
123            }
124
125            ArmOp::Sdiv { rd, rn, rm } => {
126                let rd_bits = reg_to_bits(rd);
127                let rn_bits = reg_to_bits(rn);
128                let rm_bits = reg_to_bits(rm);
129
130                // SDIV encoding: cond(4) | 01110001 | Rd(4) | 1111 | Rm(4) | 0001 | Rn(4)
131                // ARMv7-M and above
132                0xE710F010 | (rd_bits << 16) | (rm_bits << 8) | rn_bits
133            }
134
135            ArmOp::Udiv { rd, rn, rm } => {
136                let rd_bits = reg_to_bits(rd);
137                let rn_bits = reg_to_bits(rn);
138                let rm_bits = reg_to_bits(rm);
139
140                // UDIV encoding: cond(4) | 01110011 | Rd(4) | 1111 | Rm(4) | 0001 | Rn(4)
141                // ARMv7-M and above
142                0xE730F010 | (rd_bits << 16) | (rm_bits << 8) | rn_bits
143            }
144
145            ArmOp::Mls { rd, rn, rm, ra } => {
146                let rd_bits = reg_to_bits(rd);
147                let rn_bits = reg_to_bits(rn);
148                let rm_bits = reg_to_bits(rm);
149                let ra_bits = reg_to_bits(ra);
150
151                // MLS encoding: cond(4) | 00000110 | Rd(4) | Ra(4) | Rm(4) | 1001 | Rn(4)
152                // Rd = Ra - (Rn * Rm)
153                0xE0600090 | (rd_bits << 16) | (ra_bits << 12) | (rm_bits << 8) | rn_bits
154            }
155
156            ArmOp::And { rd, rn, op2 } => {
157                let rd_bits = reg_to_bits(rd);
158                let rn_bits = reg_to_bits(rn);
159                let (op2_bits, i_flag) = encode_operand2(op2);
160
161                // AND encoding: opcode=0000
162                0xE0000000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
163            }
164
165            ArmOp::Orr { rd, rn, op2 } => {
166                let rd_bits = reg_to_bits(rd);
167                let rn_bits = reg_to_bits(rn);
168                let (op2_bits, i_flag) = encode_operand2(op2);
169
170                // ORR encoding: opcode=1100
171                0xE1800000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
172            }
173
174            ArmOp::Eor { rd, rn, op2 } => {
175                let rd_bits = reg_to_bits(rd);
176                let rn_bits = reg_to_bits(rn);
177                let (op2_bits, i_flag) = encode_operand2(op2);
178
179                // EOR encoding: opcode=0001
180                0xE0200000 | (i_flag << 25) | (rn_bits << 16) | (rd_bits << 12) | op2_bits
181            }
182
183            // Shift instructions
184            ArmOp::Lsl { rd, rn, shift } => {
185                let rd_bits = reg_to_bits(rd);
186                let rn_bits = reg_to_bits(rn);
187                let shift_bits = *shift & 0x1F;
188
189                // LSL encoding: MOV with shift
190                0xE1A00000 | (rd_bits << 12) | (shift_bits << 7) | rn_bits
191            }
192
193            ArmOp::Lsr { rd, rn, shift } => {
194                let rd_bits = reg_to_bits(rd);
195                let rn_bits = reg_to_bits(rn);
196                let shift_bits = *shift & 0x1F;
197
198                // LSR encoding
199                0xE1A00020 | (rd_bits << 12) | (shift_bits << 7) | rn_bits
200            }
201
202            ArmOp::Asr { rd, rn, shift } => {
203                let rd_bits = reg_to_bits(rd);
204                let rn_bits = reg_to_bits(rn);
205                let shift_bits = *shift & 0x1F;
206
207                // ASR encoding
208                0xE1A00040 | (rd_bits << 12) | (shift_bits << 7) | rn_bits
209            }
210
211            ArmOp::Ror { rd, rn, shift } => {
212                let rd_bits = reg_to_bits(rd);
213                let rn_bits = reg_to_bits(rn);
214                let shift_bits = *shift & 0x1F;
215
216                // ROR encoding: MOV with ROR shift
217                0xE1A00060 | (rd_bits << 12) | (shift_bits << 7) | rn_bits
218            }
219
220            // Register-based shifts (ARM32)
221            // LSL Rd, Rn, Rm: cond 0001101S 0000 Rd Rs 0001 Rn
222            ArmOp::LslReg { rd, rn, rm } => {
223                let rd_bits = reg_to_bits(rd);
224                let rn_bits = reg_to_bits(rn);
225                let rm_bits = reg_to_bits(rm);
226                0xE1A00010 | (rd_bits << 12) | (rm_bits << 8) | rn_bits
227            }
228            ArmOp::LsrReg { rd, rn, rm } => {
229                let rd_bits = reg_to_bits(rd);
230                let rn_bits = reg_to_bits(rn);
231                let rm_bits = reg_to_bits(rm);
232                0xE1A00030 | (rd_bits << 12) | (rm_bits << 8) | rn_bits
233            }
234            ArmOp::AsrReg { rd, rn, rm } => {
235                let rd_bits = reg_to_bits(rd);
236                let rn_bits = reg_to_bits(rn);
237                let rm_bits = reg_to_bits(rm);
238                0xE1A00050 | (rd_bits << 12) | (rm_bits << 8) | rn_bits
239            }
240            ArmOp::RorReg { rd, rn, rm } => {
241                let rd_bits = reg_to_bits(rd);
242                let rn_bits = reg_to_bits(rn);
243                let rm_bits = reg_to_bits(rm);
244                0xE1A00070 | (rd_bits << 12) | (rm_bits << 8) | rn_bits
245            }
246
247            // RSB (Reverse Subtract): Rd = imm - Rn
248            ArmOp::Rsb { rd, rn, imm } => {
249                let rd_bits = reg_to_bits(rd);
250                let rn_bits = reg_to_bits(rn);
251                // RSB encoding: cond(4) | 00 1 0011 S | Rn(4) | Rd(4) | imm12
252                // Opcode for RSB = 0011, I=1 (immediate), S=0
253                0xE2600000 | (rn_bits << 16) | (rd_bits << 12) | (*imm & 0xFF)
254            }
255
256            // Bit manipulation instructions
257            ArmOp::Clz { rd, rm } => {
258                let rd_bits = reg_to_bits(rd);
259                let rm_bits = reg_to_bits(rm);
260
261                // CLZ encoding: cond(4) | 00010110 | 1111 | Rd(4) | 1111 | 0001 | Rm(4)
262                // ARMv5T and above
263                0xE16F0F10 | (rd_bits << 12) | rm_bits
264            }
265
266            ArmOp::Rbit { rd, rm } => {
267                let rd_bits = reg_to_bits(rd);
268                let rm_bits = reg_to_bits(rm);
269
270                // RBIT encoding: cond(4) | 01101111 | 1111 | Rd(4) | 1111 | 0011 | Rm(4)
271                // ARMv6T2 and above
272                0xE6FF0F30 | (rd_bits << 12) | rm_bits
273            }
274
275            ArmOp::Sxtb { rd, rm } => {
276                let rd_bits = reg_to_bits(rd);
277                let rm_bits = reg_to_bits(rm);
278
279                // SXTB encoding: cond(4) | 01101010 | 1111 | Rd(4) | rotate(2) | 00 | 0111 | Rm(4)
280                // ARMv6 and above. rotate=00 for no rotation
281                0xE6AF0070 | (rd_bits << 12) | rm_bits
282            }
283
284            ArmOp::Sxth { rd, rm } => {
285                let rd_bits = reg_to_bits(rd);
286                let rm_bits = reg_to_bits(rm);
287
288                // SXTH encoding: cond(4) | 01101011 | 1111 | Rd(4) | rotate(2) | 00 | 0111 | Rm(4)
289                // ARMv6 and above. rotate=00 for no rotation
290                0xE6BF0070 | (rd_bits << 12) | rm_bits
291            }
292
293            // Move instructions
294            ArmOp::Mov { rd, op2 } => {
295                let rd_bits = reg_to_bits(rd);
296                let (op2_bits, i_flag) = encode_operand2(op2);
297
298                // MOV encoding: opcode=1101
299                0xE1A00000 | (i_flag << 25) | (rd_bits << 12) | op2_bits
300            }
301
302            ArmOp::Mvn { rd, op2 } => {
303                let rd_bits = reg_to_bits(rd);
304                let (op2_bits, i_flag) = encode_operand2(op2);
305
306                // MVN encoding: opcode=1111
307                0xE1E00000 | (i_flag << 25) | (rd_bits << 12) | op2_bits
308            }
309
310            // MOVW - Move Wide (ARM32)
311            // Encoding: cond(4) | 0011 0000 | imm4(4) | Rd(4) | imm12(12)
312            ArmOp::Movw { rd, imm16 } => {
313                let rd_bits = reg_to_bits(rd);
314                let imm4 = ((*imm16 as u32) >> 12) & 0xF;
315                let imm12 = (*imm16 as u32) & 0xFFF;
316                0xE3000000 | (imm4 << 16) | (rd_bits << 12) | imm12
317            }
318
319            // MOVT - Move Top (ARM32)
320            // Encoding: cond(4) | 0011 0100 | imm4(4) | Rd(4) | imm12(12)
321            ArmOp::Movt { rd, imm16 } => {
322                let rd_bits = reg_to_bits(rd);
323                let imm4 = ((*imm16 as u32) >> 12) & 0xF;
324                let imm12 = (*imm16 as u32) & 0xFFF;
325                0xE3400000 | (imm4 << 16) | (rd_bits << 12) | imm12
326            }
327
328            // Compare
329            ArmOp::Cmp { rn, op2 } => {
330                let rn_bits = reg_to_bits(rn);
331                let (op2_bits, i_flag) = encode_operand2(op2);
332
333                // CMP encoding: opcode=1010, S=1
334                0xE1500000 | (i_flag << 25) | (rn_bits << 16) | op2_bits
335            }
336
337            // Compare Negative (CMN) - computes Rn + op2 and sets flags
338            ArmOp::Cmn { rn, op2 } => {
339                let rn_bits = reg_to_bits(rn);
340                let (op2_bits, i_flag) = encode_operand2(op2);
341
342                // CMN encoding: opcode=1011, S=1
343                0xE1700000 | (i_flag << 25) | (rn_bits << 16) | op2_bits
344            }
345
346            // Load/Store
347            ArmOp::Ldr { rd, addr } => {
348                let rd_bits = reg_to_bits(rd);
349                let (base_bits, offset_bits) = encode_mem_addr(addr);
350
351                // LDR encoding: cond(4) | 01 | I(1) | P(1) | U(1) | B(1) | W(1) | L(1) | Rn(4) | Rd(4) | offset(12)
352                // P=1 (pre-indexed), U=1 (add offset), L=1 (load)
353                0xE5900000 | (base_bits << 16) | (rd_bits << 12) | offset_bits
354            }
355
356            ArmOp::Str { rd, addr } => {
357                let rd_bits = reg_to_bits(rd);
358                let (base_bits, offset_bits) = encode_mem_addr(addr);
359
360                // STR encoding: L=0 (store)
361                0xE5800000 | (base_bits << 16) | (rd_bits << 12) | offset_bits
362            }
363
364            // Sub-word loads (ARM32 encoding)
365            ArmOp::Ldrb { rd, addr } => {
366                let rd_bits = reg_to_bits(rd);
367                let (base_bits, offset_bits) = encode_mem_addr(addr);
368                // LDRB: LDR with B=1 (byte): cond|01|I|P|U|1|W|L|Rn|Rd|offset
369                0xE5D00000 | (base_bits << 16) | (rd_bits << 12) | offset_bits
370            }
371
372            ArmOp::Ldrsb { rd, addr } => {
373                let rd_bits = reg_to_bits(rd);
374                let (base_bits, offset_bits) = encode_mem_addr(addr);
375                // LDRSB (misc load): cond|000|P|U|1|W|1|Rn|Rd|imm4H|1101|imm4L
376                // Simplified with immediate offset
377                let offset_val = offset_bits & 0xFF;
378                let imm4h = (offset_val >> 4) & 0xF;
379                let imm4l = offset_val & 0xF;
380                0xE1D000D0 | (base_bits << 16) | (rd_bits << 12) | (imm4h << 8) | imm4l
381            }
382
383            ArmOp::Ldrh { rd, addr } => {
384                let rd_bits = reg_to_bits(rd);
385                let (base_bits, offset_bits) = encode_mem_addr(addr);
386                // LDRH (misc load): cond|000|P|U|1|W|1|Rn|Rd|imm4H|1011|imm4L
387                let offset_val = offset_bits & 0xFF;
388                let imm4h = (offset_val >> 4) & 0xF;
389                let imm4l = offset_val & 0xF;
390                0xE1D000B0 | (base_bits << 16) | (rd_bits << 12) | (imm4h << 8) | imm4l
391            }
392
393            ArmOp::Ldrsh { rd, addr } => {
394                let rd_bits = reg_to_bits(rd);
395                let (base_bits, offset_bits) = encode_mem_addr(addr);
396                // LDRSH (misc load): cond|000|P|U|1|W|1|Rn|Rd|imm4H|1111|imm4L
397                let offset_val = offset_bits & 0xFF;
398                let imm4h = (offset_val >> 4) & 0xF;
399                let imm4l = offset_val & 0xF;
400                0xE1D000F0 | (base_bits << 16) | (rd_bits << 12) | (imm4h << 8) | imm4l
401            }
402
403            // Sub-word stores (ARM32 encoding)
404            ArmOp::Strb { rd, addr } => {
405                let rd_bits = reg_to_bits(rd);
406                let (base_bits, offset_bits) = encode_mem_addr(addr);
407                // STRB: STR with B=1 (byte): cond|01|I|P|U|1|W|0|Rn|Rd|offset
408                0xE5C00000 | (base_bits << 16) | (rd_bits << 12) | offset_bits
409            }
410
411            ArmOp::Strh { rd, addr } => {
412                let rd_bits = reg_to_bits(rd);
413                let (base_bits, offset_bits) = encode_mem_addr(addr);
414                // STRH (misc store): cond|000|P|U|1|W|0|Rn|Rd|imm4H|1011|imm4L
415                let offset_val = offset_bits & 0xFF;
416                let imm4h = (offset_val >> 4) & 0xF;
417                let imm4l = offset_val & 0xF;
418                0xE1C000B0 | (base_bits << 16) | (rd_bits << 12) | (imm4h << 8) | imm4l
419            }
420
421            // Memory management (ARM32 encoding)
422            ArmOp::MemorySize { rd } => {
423                let rd_bits = reg_to_bits(rd);
424                // MOV rd, R10, LSR #16  (memory size in bytes / 65536 = pages)
425                // cond|000|1101|S|0000|Rd|shift5|type|0|Rm
426                // LSR #16: shift5=10000, type=01
427                0xE1A00820 | (rd_bits << 12) | 0x0A // Rm=R10, shift=16, LSR
428            }
429
430            ArmOp::MemoryGrow { rd, .. } => {
431                let rd_bits = reg_to_bits(rd);
432                // On embedded, always fail: MOV rd, #-1
433                0xE3E00000 | (rd_bits << 12) // MVN rd, #0 = MOV rd, #-1
434            }
435
436            // Label pseudo-instruction: emits no machine code
437            ArmOp::Label { .. } => {
438                return Ok(Vec::new());
439            }
440
441            // Branch instructions
442            ArmOp::B { label: _ } => {
443                // B encoding: cond(4) | 1010 | offset(24)
444                // Simplified: branch to offset 0 (will be patched by linker/resolver)
445                0xEA000000
446            }
447
448            // Conditional branch to label (generic)
449            ArmOp::Bcc { cond, label: _ } => {
450                use synth_synthesis::Condition;
451                let cond_bits: u32 = match cond {
452                    Condition::EQ => 0x0,
453                    Condition::NE => 0x1,
454                    Condition::HS => 0x2,
455                    Condition::LO => 0x3,
456                    Condition::HI => 0x8,
457                    Condition::LS => 0x9,
458                    Condition::GE => 0xA,
459                    Condition::LT => 0xB,
460                    Condition::GT => 0xC,
461                    Condition::LE => 0xD,
462                };
463                // B<cond> with offset 0 (will be patched)
464                (cond_bits << 28) | 0x0A000000
465            }
466
467            // BHS (Branch if Higher or Same) - used for bounds checking
468            ArmOp::Bhs { label: _ } => {
469                // BHS encoding: cond(2=HS) | 1010 | offset(24)
470                0x2A000000 // BHS with offset 0
471            }
472
473            // BLO (Branch if Lower) - complementary to BHS
474            ArmOp::Blo { label: _ } => {
475                // BLO encoding: cond(3=LO) | 1010 | offset(24)
476                0x3A000000 // BLO with offset 0
477            }
478
479            // Branch with numeric offset (in instructions)
480            // ARM32 B instruction: offset is in instructions, stored as words
481            // The offset is relative to PC+8 (due to ARM pipeline)
482            ArmOp::BOffset { offset } => {
483                // B encoding: cond(4) | 1010 | offset(24)
484                // Offset is signed, in words (4-byte units)
485                // ARM adds PC+8 to the offset, so we need to adjust:
486                // target = PC + 8 + (offset * 4)
487                // For backward branch of N instructions: offset = -(N + 2)
488                let adjusted_offset = *offset - 2; // Account for PC+8
489                let offset_bits = (adjusted_offset as u32) & 0x00FFFFFF;
490                0xEA000000 | offset_bits
491            }
492
493            // Conditional branch with numeric offset
494            ArmOp::BCondOffset { cond, offset } => {
495                use synth_synthesis::Condition;
496                let cond_bits: u32 = match cond {
497                    Condition::EQ => 0x0,
498                    Condition::NE => 0x1,
499                    Condition::HS => 0x2,
500                    Condition::LO => 0x3,
501                    Condition::HI => 0x8,
502                    Condition::LS => 0x9,
503                    Condition::GE => 0xA,
504                    Condition::LT => 0xB,
505                    Condition::GT => 0xC,
506                    Condition::LE => 0xD,
507                };
508                // B<cond> encoding: cond(4) | 1010 | offset(24)
509                let adjusted_offset = *offset - 2; // Account for PC+8
510                let offset_bits = (adjusted_offset as u32) & 0x00FFFFFF;
511                (cond_bits << 28) | 0x0A000000 | offset_bits
512            }
513
514            ArmOp::Bl { label: _ } => {
515                // BL encoding: cond(4) | 1011 | offset(24)
516                0xEB000000
517            }
518
519            ArmOp::Bx { rm } => {
520                let rm_bits = reg_to_bits(rm);
521
522                // BX encoding: cond(4) | 000100101111111111110001 | Rm(4)
523                0xE12FFF10 | rm_bits
524            }
525
526            ArmOp::Blx { rm } => {
527                let rm_bits = reg_to_bits(rm);
528
529                // BLX (register) encoding: cond(4) | 000100101111111111110011 | Rm(4)
530                0xE12FFF30 | rm_bits
531            }
532
533            ArmOp::Push { regs } => {
534                // STMDB SP!, {regs} encoding: cond(4) | 100100 | 10 | 1101 | register_list(16)
535                let mut reg_list: u32 = 0;
536                for r in regs {
537                    reg_list |= 1 << reg_to_bits(r);
538                }
539                0xE92D0000 | reg_list
540            }
541
542            ArmOp::Pop { regs } => {
543                // LDMIA SP!, {regs} encoding: cond(4) | 100010 | 11 | 1101 | register_list(16)
544                let mut reg_list: u32 = 0;
545                for r in regs {
546                    reg_list |= 1 << reg_to_bits(r);
547                }
548                0xE8BD0000 | reg_list
549            }
550
551            ArmOp::Nop => {
552                // NOP encoding: MOV R0, R0
553                0xE1A00000
554            }
555
556            ArmOp::Udf { imm } => {
557                // UDF (Undefined) encoding in ARM: 0xE7F000F0 | (imm12_hi << 8) | imm4_lo
558                // We only use imm8, so split into imm4_hi and imm4_lo
559                let imm8 = *imm as u32;
560                0xE7F000F0 | ((imm8 & 0xF0) << 4) | (imm8 & 0x0F)
561            }
562
563            // Pseudo-instructions for verification - encode as NOP
564            // These are used in formal verification but not actual code generation
565            ArmOp::Popcnt { .. } => {
566                // Population count pseudo-instruction
567                // Not a real ARM instruction, would be expanded to actual code
568                0xE1A00000 // NOP for now
569            }
570
571            ArmOp::SetCond { .. } => {
572                // Condition evaluation pseudo-instruction
573                // Not a real ARM instruction, would be expanded to actual code
574                0xE1A00000 // NOP for now
575            }
576
577            ArmOp::SelectMove { .. } => {
578                // Conditional move pseudo-instruction for ARM32
579                // Would use MOV{cond} instruction
580                0xE1A00000 // NOP for now
581            }
582
583            ArmOp::Select { .. } => {
584                // Select pseudo-instruction
585                // Not a real ARM instruction, would be expanded to conditional moves
586                0xE1A00000 // NOP for now
587            }
588
589            ArmOp::LocalGet { .. } => {
590                // Local variable get pseudo-instruction
591                // Not a real ARM instruction, would be expanded to memory access
592                0xE1A00000 // NOP for now
593            }
594
595            ArmOp::LocalSet { .. } => {
596                // Local variable set pseudo-instruction
597                // Not a real ARM instruction, would be expanded to memory access
598                0xE1A00000 // NOP for now
599            }
600
601            ArmOp::LocalTee { .. } => {
602                // Local variable tee pseudo-instruction
603                // Not a real ARM instruction, would be expanded to memory access
604                0xE1A00000 // NOP for now
605            }
606
607            ArmOp::GlobalGet { .. } => {
608                // Global variable get pseudo-instruction
609                // Not a real ARM instruction, would be expanded to memory access
610                0xE1A00000 // NOP for now
611            }
612
613            ArmOp::GlobalSet { .. } => {
614                // Global variable set pseudo-instruction
615                // Not a real ARM instruction, would be expanded to memory access
616                0xE1A00000 // NOP for now
617            }
618
619            ArmOp::BrTable { .. } => {
620                // Branch table pseudo-instruction
621                // Not a real ARM instruction, would be expanded to jump table
622                0xE1A00000 // NOP for now
623            }
624
625            ArmOp::Call { .. } => {
626                // Function call pseudo-instruction
627                // Not a real ARM instruction, would be expanded to BL
628                0xE1A00000 // NOP for now
629            }
630
631            ArmOp::CallIndirect { .. } => {
632                // Indirect function call pseudo-instruction
633                // Not a real ARM instruction, would be expanded to indirect branch
634                0xE1A00000 // NOP for now
635            }
636
637            // i64 pseudo-instructions (Phase 2) - encode as NOP for now
638            // Real compiler would expand these to multi-instruction sequences
639            ArmOp::I64Add { .. } => 0xE1A00000,        // NOP
640            ArmOp::I64Sub { .. } => 0xE1A00000,        // NOP
641            ArmOp::I64DivS { .. } => 0xE1A00000,       // NOP
642            ArmOp::I64DivU { .. } => 0xE1A00000,       // NOP
643            ArmOp::I64RemS { .. } => 0xE1A00000,       // NOP
644            ArmOp::I64RemU { .. } => 0xE1A00000,       // NOP
645            ArmOp::I64Clz { .. } => 0xE1A00000,        // NOP
646            ArmOp::I64Ctz { .. } => 0xE1A00000,        // NOP
647            ArmOp::I64Popcnt { .. } => 0xE1A00000,     // NOP
648            ArmOp::I64And { .. } => 0xE1A00000,        // NOP
649            ArmOp::I64Or { .. } => 0xE1A00000,         // NOP
650            ArmOp::I64Xor { .. } => 0xE1A00000,        // NOP
651            ArmOp::I64Eqz { .. } => 0xE1A00000,        // NOP
652            ArmOp::I64Eq { .. } => 0xE1A00000,         // NOP
653            ArmOp::I64Ne { .. } => 0xE1A00000,         // NOP
654            ArmOp::I64LtS { .. } => 0xE1A00000,        // NOP
655            ArmOp::I64LtU { .. } => 0xE1A00000,        // NOP
656            ArmOp::I64LeS { .. } => 0xE1A00000,        // NOP
657            ArmOp::I64LeU { .. } => 0xE1A00000,        // NOP
658            ArmOp::I64GtS { .. } => 0xE1A00000,        // NOP
659            ArmOp::I64GtU { .. } => 0xE1A00000,        // NOP
660            ArmOp::I64GeS { .. } => 0xE1A00000,        // NOP
661            ArmOp::I64GeU { .. } => 0xE1A00000,        // NOP
662            ArmOp::I64Const { .. } => 0xE1A00000,      // NOP
663            ArmOp::I64Ldr { .. } => 0xE1A00000,        // NOP
664            ArmOp::I64Str { .. } => 0xE1A00000,        // NOP
665            ArmOp::I64ExtendI32S { .. } => 0xE1A00000, // NOP
666            ArmOp::I64ExtendI32U { .. } => 0xE1A00000, // NOP
667            ArmOp::I64Extend8S { .. } => 0xE1A00000,   // NOP (Thumb-2 only)
668            ArmOp::I64Extend16S { .. } => 0xE1A00000,  // NOP (Thumb-2 only)
669            ArmOp::I64Extend32S { .. } => 0xE1A00000,  // NOP (Thumb-2 only)
670            ArmOp::I32WrapI64 { .. } => 0xE1A00000,    // NOP
671
672            // f32 VFP single-precision instructions
673            ArmOp::F32Add { sd, sn, sm } => encode_vfp_3reg(0xEE300A00, sd, sn, sm)?,
674            ArmOp::F32Sub { sd, sn, sm } => encode_vfp_3reg(0xEE300A40, sd, sn, sm)?,
675            ArmOp::F32Mul { sd, sn, sm } => encode_vfp_3reg(0xEE200A00, sd, sn, sm)?,
676            ArmOp::F32Div { sd, sn, sm } => encode_vfp_3reg(0xEE800A00, sd, sn, sm)?,
677            ArmOp::F32Abs { sd, sm } => encode_vfp_2reg(0xEEB00AC0, sd, sm)?,
678            ArmOp::F32Neg { sd, sm } => encode_vfp_2reg(0xEEB10A40, sd, sm)?,
679            ArmOp::F32Sqrt { sd, sm } => encode_vfp_2reg(0xEEB10AC0, sd, sm)?,
680
681            // f32 pseudo-ops — multi-instruction sequences
682            // FPSCR RMode: 00=nearest, 01=+inf(ceil), 10=-inf(floor), 11=zero(trunc)
683            ArmOp::F32Ceil { sd, sm } => {
684                return self.encode_arm_f32_rounding(sd, sm, 0b01); // Round toward +Inf
685            }
686            ArmOp::F32Floor { sd, sm } => {
687                return self.encode_arm_f32_rounding(sd, sm, 0b10); // Round toward -Inf
688            }
689            ArmOp::F32Trunc { sd, sm } => {
690                return self.encode_arm_f32_rounding(sd, sm, 0b11); // VCVT toward zero
691            }
692            ArmOp::F32Nearest { sd, sm } => {
693                return self.encode_arm_f32_rounding(sd, sm, 0b00); // VCVT to nearest
694            }
695            ArmOp::F32Min { sd, sn, sm } => {
696                return self.encode_arm_f32_minmax(sd, sn, sm, true);
697            }
698            ArmOp::F32Max { sd, sn, sm } => {
699                return self.encode_arm_f32_minmax(sd, sn, sm, false);
700            }
701            ArmOp::F32Copysign { sd, sn, sm } => {
702                return self.encode_arm_f32_copysign(sd, sn, sm);
703            }
704
705            // f32 comparisons — multi-instruction: VCMP + VMRS + conditional MOV
706            ArmOp::F32Eq { rd, sn, sm } => {
707                return self.encode_arm_f32_compare(rd, sn, sm, 0x0); // EQ
708            }
709            ArmOp::F32Ne { rd, sn, sm } => {
710                return self.encode_arm_f32_compare(rd, sn, sm, 0x1); // NE
711            }
712            ArmOp::F32Lt { rd, sn, sm } => {
713                return self.encode_arm_f32_compare(rd, sn, sm, 0x4); // MI (less than)
714            }
715            ArmOp::F32Le { rd, sn, sm } => {
716                return self.encode_arm_f32_compare(rd, sn, sm, 0x9); // LS (less or same)
717            }
718            ArmOp::F32Gt { rd, sn, sm } => {
719                return self.encode_arm_f32_compare(rd, sn, sm, 0xC); // GT
720            }
721            ArmOp::F32Ge { rd, sn, sm } => {
722                return self.encode_arm_f32_compare(rd, sn, sm, 0xA); // GE
723            }
724
725            // f32 const — multi-instruction: MOVW + MOVT + VMOV
726            ArmOp::F32Const { sd, value } => {
727                return self.encode_arm_f32_const(sd, *value);
728            }
729
730            ArmOp::F32Load { sd, addr } => encode_vfp_ldst(0xED900A00, sd, addr)?,
731            ArmOp::F32Store { sd, addr } => encode_vfp_ldst(0xED800A00, sd, addr)?,
732
733            // f32 conversions — multi-instruction sequences
734            ArmOp::F32ConvertI32S { sd, rm } => {
735                return self.encode_arm_f32_convert_i32(sd, rm, true);
736            }
737            ArmOp::F32ConvertI32U { sd, rm } => {
738                return self.encode_arm_f32_convert_i32(sd, rm, false);
739            }
740            ArmOp::F32ConvertI64S { .. } | ArmOp::F32ConvertI64U { .. } => {
741                return Err(synth_core::Error::synthesis(
742                    "F32 i64 conversion not supported (requires register pairs on 32-bit ARM)",
743                ));
744            }
745            ArmOp::F32ReinterpretI32 { sd, rm } => encode_vmov_core_sreg(true, sd, rm)?,
746            ArmOp::I32ReinterpretF32 { rd, sm } => encode_vmov_core_sreg(false, sm, rd)?,
747            ArmOp::I32TruncF32S { rd, sm } => {
748                return self.encode_arm_i32_trunc_f32(rd, sm, true);
749            }
750            ArmOp::I32TruncF32U { rd, sm } => {
751                return self.encode_arm_i32_trunc_f32(rd, sm, false);
752            }
753
754            // f64 VFP double-precision instructions (ARM32)
755            // F64 arithmetic: same as F32 but with sz=1 (bit 8 = 1, cp11 = 0xB)
756            ArmOp::F64Add { dd, dn, dm } => encode_vfp_3reg_f64(0xEE300B00, dd, dn, dm)?,
757            ArmOp::F64Sub { dd, dn, dm } => encode_vfp_3reg_f64(0xEE300B40, dd, dn, dm)?,
758            ArmOp::F64Mul { dd, dn, dm } => encode_vfp_3reg_f64(0xEE200B00, dd, dn, dm)?,
759            ArmOp::F64Div { dd, dn, dm } => encode_vfp_3reg_f64(0xEE800B00, dd, dn, dm)?,
760            ArmOp::F64Abs { dd, dm } => encode_vfp_2reg_f64(0xEEB00BC0, dd, dm)?,
761            ArmOp::F64Neg { dd, dm } => encode_vfp_2reg_f64(0xEEB10B40, dd, dm)?,
762            ArmOp::F64Sqrt { dd, dm } => encode_vfp_2reg_f64(0xEEB10BC0, dd, dm)?,
763
764            // f64 pseudo-ops
765            // FPSCR RMode: 00=nearest, 01=+inf(ceil), 10=-inf(floor), 11=zero(trunc)
766            ArmOp::F64Ceil { dd, dm } => {
767                return self.encode_arm_f64_rounding(dd, dm, 0b01);
768            }
769            ArmOp::F64Floor { dd, dm } => {
770                return self.encode_arm_f64_rounding(dd, dm, 0b10);
771            }
772            ArmOp::F64Trunc { dd, dm } => {
773                return self.encode_arm_f64_rounding(dd, dm, 0b11);
774            }
775            ArmOp::F64Nearest { dd, dm } => {
776                return self.encode_arm_f64_rounding(dd, dm, 0b00);
777            }
778            ArmOp::F64Min { dd, dn, dm } => {
779                return self.encode_arm_f64_minmax(dd, dn, dm, true);
780            }
781            ArmOp::F64Max { dd, dn, dm } => {
782                return self.encode_arm_f64_minmax(dd, dn, dm, false);
783            }
784            ArmOp::F64Copysign { dd, dn, dm } => {
785                return self.encode_arm_f64_copysign(dd, dn, dm);
786            }
787
788            // f64 comparisons
789            ArmOp::F64Eq { rd, dn, dm } => {
790                return self.encode_arm_f64_compare(rd, dn, dm, 0x0);
791            }
792            ArmOp::F64Ne { rd, dn, dm } => {
793                return self.encode_arm_f64_compare(rd, dn, dm, 0x1);
794            }
795            ArmOp::F64Lt { rd, dn, dm } => {
796                return self.encode_arm_f64_compare(rd, dn, dm, 0x4);
797            }
798            ArmOp::F64Le { rd, dn, dm } => {
799                return self.encode_arm_f64_compare(rd, dn, dm, 0x9);
800            }
801            ArmOp::F64Gt { rd, dn, dm } => {
802                return self.encode_arm_f64_compare(rd, dn, dm, 0xC);
803            }
804            ArmOp::F64Ge { rd, dn, dm } => {
805                return self.encode_arm_f64_compare(rd, dn, dm, 0xA);
806            }
807
808            ArmOp::F64Const { dd, value } => {
809                return self.encode_arm_f64_const(dd, *value);
810            }
811
812            ArmOp::F64Load { dd, addr } => encode_vfp_ldst_f64(0xED900B00, dd, addr)?,
813            ArmOp::F64Store { dd, addr } => encode_vfp_ldst_f64(0xED800B00, dd, addr)?,
814
815            ArmOp::F64ConvertI32S { dd, rm } => {
816                return self.encode_arm_f64_convert_i32(dd, rm, true);
817            }
818            ArmOp::F64ConvertI32U { dd, rm } => {
819                return self.encode_arm_f64_convert_i32(dd, rm, false);
820            }
821            ArmOp::F64ConvertI64S { .. } | ArmOp::F64ConvertI64U { .. } => {
822                return Err(synth_core::Error::synthesis(
823                    "F64 i64 conversion not supported (requires register pairs on 32-bit ARM)",
824                ));
825            }
826            ArmOp::F64PromoteF32 { dd, sm } => {
827                return self.encode_arm_f64_promote_f32(dd, sm);
828            }
829            ArmOp::F64ReinterpretI64 { dd, rmlo, rmhi } => {
830                encode_vmov_core_dreg(true, dd, rmlo, rmhi)?
831            }
832            ArmOp::I64ReinterpretF64 { rdlo, rdhi, dm } => {
833                encode_vmov_core_dreg(false, dm, rdlo, rdhi)?
834            }
835            ArmOp::I64TruncF64S { .. } | ArmOp::I64TruncF64U { .. } => {
836                return Err(synth_core::Error::synthesis(
837                    "i64 truncation from F64 not supported (requires i64 register pairs on 32-bit ARM)",
838                ));
839            }
840            ArmOp::I32TruncF64S { rd, dm } => {
841                return self.encode_arm_i32_trunc_f64(rd, dm, true);
842            }
843            ArmOp::I32TruncF64U { rd, dm } => {
844                return self.encode_arm_i32_trunc_f64(rd, dm, false);
845            }
846            // Multi-instruction sequences - only meaningful in Thumb-2 mode
847            ArmOp::I64SetCond { .. }
848            | ArmOp::I64SetCondZ { .. }
849            | ArmOp::I64Mul { .. }
850            | ArmOp::I64Shl { .. }
851            | ArmOp::I64ShrS { .. }
852            | ArmOp::I64ShrU { .. }
853            | ArmOp::I64Rotl { .. }
854            | ArmOp::I64Rotr { .. } => 0xE1A00000, // NOP (Thumb-2 only)
855
856            // MVE instructions — Thumb-2 only (Cortex-M55 is always Thumb-2)
857            ArmOp::MveLoad { .. }
858            | ArmOp::MveStore { .. }
859            | ArmOp::MveConst { .. }
860            | ArmOp::MveAnd { .. }
861            | ArmOp::MveOrr { .. }
862            | ArmOp::MveEor { .. }
863            | ArmOp::MveMvn { .. }
864            | ArmOp::MveBic { .. }
865            | ArmOp::MveAddI { .. }
866            | ArmOp::MveSubI { .. }
867            | ArmOp::MveMulI { .. }
868            | ArmOp::MveNegI { .. }
869            | ArmOp::MveCmpEqI { .. }
870            | ArmOp::MveCmpNeI { .. }
871            | ArmOp::MveCmpLtS { .. }
872            | ArmOp::MveCmpLtU { .. }
873            | ArmOp::MveCmpGtS { .. }
874            | ArmOp::MveCmpGtU { .. }
875            | ArmOp::MveCmpLeS { .. }
876            | ArmOp::MveCmpLeU { .. }
877            | ArmOp::MveCmpGeS { .. }
878            | ArmOp::MveCmpGeU { .. }
879            | ArmOp::MveDup { .. }
880            | ArmOp::MveExtractLane { .. }
881            | ArmOp::MveInsertLane { .. }
882            | ArmOp::MveAddF32 { .. }
883            | ArmOp::MveSubF32 { .. }
884            | ArmOp::MveMulF32 { .. }
885            | ArmOp::MveNegF32 { .. }
886            | ArmOp::MveAbsF32 { .. }
887            | ArmOp::MveCmpEqF32 { .. }
888            | ArmOp::MveCmpNeF32 { .. }
889            | ArmOp::MveCmpLtF32 { .. }
890            | ArmOp::MveCmpLeF32 { .. }
891            | ArmOp::MveCmpGtF32 { .. }
892            | ArmOp::MveCmpGeF32 { .. }
893            | ArmOp::MveDupF32 { .. }
894            | ArmOp::MveExtractLaneF32 { .. }
895            | ArmOp::MveReplaceLaneF32 { .. }
896            | ArmOp::MveDivF32 { .. }
897            | ArmOp::MveSqrtF32 { .. } => 0xE1A00000, // NOP (MVE = Thumb-2 only)
898        };
899
900        // ARM32 instructions are little-endian
901        Ok(instr.to_le_bytes().to_vec())
902    }
903
904    // === ARM32 VFP multi-instruction helpers ===
905
906    /// Encode F32 comparison as ARM32: VCMP.F32 + VMRS + MOV rd,#0 + MOVcond rd,#1
907    fn encode_arm_f32_compare(
908        &self,
909        rd: &Reg,
910        sn: &VfpReg,
911        sm: &VfpReg,
912        cond_code: u32,
913    ) -> Result<Vec<u8>> {
914        let mut bytes = Vec::new();
915
916        // VCMP.F32 Sn, Sm: 0xEEB40A40 with Sn in Vd position, Sm in Vm position
917        let sn_num = vfp_sreg_to_num(sn)?;
918        let sm_num = vfp_sreg_to_num(sm)?;
919        let (vd, d) = encode_sreg(sn_num);
920        let (vm, m) = encode_sreg(sm_num);
921        let vcmp = 0xEEB40A40 | (d << 22) | (vd << 12) | (m << 5) | vm;
922        bytes.extend_from_slice(&vcmp.to_le_bytes());
923
924        // VMRS APSR_nzcv, FPSCR: 0xEEF1FA10
925        bytes.extend_from_slice(&0xEEF1FA10u32.to_le_bytes());
926
927        // MOV rd, #0: 0xE3A0_0000 | (rd << 12)
928        let rd_bits = reg_to_bits(rd);
929        let mov_zero = 0xE3A00000 | (rd_bits << 12);
930        bytes.extend_from_slice(&mov_zero.to_le_bytes());
931
932        // MOVcond rd, #1: cond(4) | 0011 1010 0000 rd(4) 0000 0000 0001
933        let mov_one = (cond_code << 28) | 0x03A00001 | (rd_bits << 12);
934        bytes.extend_from_slice(&mov_one.to_le_bytes());
935
936        Ok(bytes)
937    }
938
939    /// Encode F32 constant load as ARM32: MOVW Rt,#lo16 + MOVT Rt,#hi16 + VMOV Sd,Rt
940    fn encode_arm_f32_const(&self, sd: &VfpReg, value: f32) -> Result<Vec<u8>> {
941        let mut bytes = Vec::new();
942        let bits = value.to_bits();
943
944        // Use R12 as temp register for constant loading
945        let rt: u32 = 12; // R12/IP
946
947        // MOVW R12, #lo16: 0xE300_C000 | (imm4 << 16) | imm12
948        let lo16 = bits & 0xFFFF;
949        let movw = 0xE3000000 | (rt << 12) | ((lo16 >> 12) << 16) | (lo16 & 0xFFF);
950        bytes.extend_from_slice(&movw.to_le_bytes());
951
952        // MOVT R12, #hi16: 0xE340_C000 | (imm4 << 16) | imm12
953        let hi16 = (bits >> 16) & 0xFFFF;
954        let movt = 0xE3400000 | (rt << 12) | ((hi16 >> 12) << 16) | (hi16 & 0xFFF);
955        bytes.extend_from_slice(&movt.to_le_bytes());
956
957        // VMOV Sd, R12
958        let vmov = encode_vmov_core_sreg(true, sd, &Reg::R12)?;
959        bytes.extend_from_slice(&vmov.to_le_bytes());
960
961        Ok(bytes)
962    }
963
964    /// Encode VMOV + VCVT.F32.S32/U32 as ARM32
965    fn encode_arm_f32_convert_i32(&self, sd: &VfpReg, rm: &Reg, signed: bool) -> Result<Vec<u8>> {
966        let mut bytes = Vec::new();
967
968        // VMOV Sd, Rm — move integer to VFP register
969        let vmov = encode_vmov_core_sreg(true, sd, rm)?;
970        bytes.extend_from_slice(&vmov.to_le_bytes());
971
972        // VCVT.F32.S32 Sd, Sd (signed) or VCVT.F32.U32 Sd, Sd (unsigned)
973        // Base: 0xEEB80A40 (signed) or 0xEEB80AC0 (unsigned)
974        let sd_num = vfp_sreg_to_num(sd)?;
975        let (vd, d) = encode_sreg(sd_num);
976        let (vm, m) = encode_sreg(sd_num); // same register as source
977        let base = if signed { 0xEEB80A40 } else { 0xEEB80AC0 };
978        let vcvt = base | (d << 22) | (vd << 12) | (m << 5) | vm;
979        bytes.extend_from_slice(&vcvt.to_le_bytes());
980
981        Ok(bytes)
982    }
983
984    /// Encode F32 rounding pseudo-op as ARM32 via VCVT to integer and back.
985    /// mode: 0b00=nearest, 0b01=floor(-Inf), 0b10=ceil(+Inf), 0b11=trunc(zero)
986    /// Strategy: VCVT.S32.F32 Sd, Sm (toward zero), then VCVT.F32.S32 Sd, Sd
987    /// For ceil/floor/nearest, we use VCVTR (round toward mode) + convert back.
988    /// Simplified: convert to int (toward zero for trunc) then back to float.
989    /// Encode F32 rounding as ARM32.
990    /// `mode`: FPSCR RMode — 0b00=nearest, 0b01=+inf(ceil), 0b10=-inf(floor), 0b11=zero(trunc)
991    ///
992    /// For trunc (mode=0b11): uses VCVTR.S32.F32 (always rounds toward zero).
993    /// For ceil/floor/nearest: sets FPSCR rounding mode, uses VCVT.S32.F32 (non-R variant
994    /// which honours FPSCR rmode), then restores FPSCR.
995    fn encode_arm_f32_rounding(&self, sd: &VfpReg, sm: &VfpReg, mode: u8) -> Result<Vec<u8>> {
996        let mut bytes = Vec::new();
997        let sm_num = vfp_sreg_to_num(sm)?;
998        let sd_num = vfp_sreg_to_num(sd)?;
999        let (vd_s, d_s) = encode_sreg(sd_num);
1000        let (vm_s, m_s) = encode_sreg(sm_num);
1001
1002        if mode == 0b11 {
1003            // Trunc (toward zero): VCVTR.S32.F32 — the "R" variant always truncates.
1004            // 0xEEBD0AC0: bit[7]=1 => round toward zero regardless of FPSCR
1005            let vcvt_to_int = 0xEEBD0AC0 | (d_s << 22) | (vd_s << 12) | (m_s << 5) | vm_s;
1006            bytes.extend_from_slice(&vcvt_to_int.to_le_bytes());
1007        } else {
1008            // ceil/floor/nearest: manipulate FPSCR rounding mode
1009            let rt: u32 = 12; // R12/IP as temp
1010
1011            // VMRS R12, FPSCR
1012            let vmrs = 0xEEF10A10 | (rt << 12);
1013            bytes.extend_from_slice(&vmrs.to_le_bytes());
1014
1015            // BIC R12, R12, #(3 << 22) — clear RMode bits [23:22]
1016            // 3<<22 = 0x00C00000. ARM rotated imm: 0x03 ror 10 (rotation=5, imm8=0x03)
1017            let bic = 0xE3CC0000 | (rt << 12) | (0x05 << 8) | 0x03;
1018            bytes.extend_from_slice(&bic.to_le_bytes());
1019
1020            // ORR R12, R12, #(mode << 22) — set desired rounding mode
1021            if mode != 0 {
1022                // mode<<22: rotation=5, imm8=mode
1023                let orr = 0xE38C0000 | (rt << 12) | (0x05 << 8) | (mode as u32);
1024                bytes.extend_from_slice(&orr.to_le_bytes());
1025            }
1026
1027            // VMSR FPSCR, R12
1028            let vmsr = 0xEEE10A10 | (rt << 12);
1029            bytes.extend_from_slice(&vmsr.to_le_bytes());
1030
1031            // VCVT.S32.F32 Sd, Sm — non-R variant (bit[7]=0), uses FPSCR rounding mode
1032            let vcvt_to_int = 0xEEBD0A40 | (d_s << 22) | (vd_s << 12) | (m_s << 5) | vm_s;
1033            bytes.extend_from_slice(&vcvt_to_int.to_le_bytes());
1034
1035            // Restore FPSCR: clear rmode bits back to nearest (default)
1036            bytes.extend_from_slice(&vmrs.to_le_bytes());
1037            bytes.extend_from_slice(&bic.to_le_bytes());
1038            bytes.extend_from_slice(&vmsr.to_le_bytes());
1039        }
1040
1041        // VCVT.F32.S32 Sd, Sd (convert integer result back to float)
1042        let (vd2, d2) = encode_sreg(sd_num);
1043        let vcvt_to_float = 0xEEB80A40 | (d2 << 22) | (vd2 << 12) | (d_s << 5) | vd_s;
1044        bytes.extend_from_slice(&vcvt_to_float.to_le_bytes());
1045
1046        Ok(bytes)
1047    }
1048
1049    /// Encode F32 min/max as ARM32: VCMP + VMRS + conditional VMOV
1050    fn encode_arm_f32_minmax(
1051        &self,
1052        sd: &VfpReg,
1053        sn: &VfpReg,
1054        sm: &VfpReg,
1055        is_min: bool,
1056    ) -> Result<Vec<u8>> {
1057        let mut bytes = Vec::new();
1058        let sn_num = vfp_sreg_to_num(sn)?;
1059        let sm_num = vfp_sreg_to_num(sm)?;
1060        let sd_num = vfp_sreg_to_num(sd)?;
1061
1062        // VMOV Sd, Sn (start with first operand)
1063        let (vd, d) = encode_sreg(sd_num);
1064        let (vn, n) = encode_sreg(sn_num);
1065        let vmov_sn = 0xEEB00A40 | (d << 22) | (vd << 12) | (n << 5) | vn;
1066        bytes.extend_from_slice(&vmov_sn.to_le_bytes());
1067
1068        // VCMP.F32 Sn, Sm
1069        let (vm, m) = encode_sreg(sm_num);
1070        let vcmp = 0xEEB40A40 | (n << 22) | (vn << 12) | (m << 5) | vm;
1071        bytes.extend_from_slice(&vcmp.to_le_bytes());
1072
1073        // VMRS APSR_nzcv, FPSCR
1074        bytes.extend_from_slice(&0xEEF1FA10u32.to_le_bytes());
1075
1076        // For min: if Sn > Sm (GT), use Sm. Condition = GT (0xC)
1077        // For max: if Sn < Sm (MI/LT), use Sm. Condition = MI (0x4)
1078        let cond = if is_min { 0xCu32 } else { 0x4u32 };
1079
1080        // VMOV{cond} Sd, Sm — conditional VMOV
1081        let vmov_cond = (cond << 28) | 0x0EB00A40 | (d << 22) | (vd << 12) | (m << 5) | vm;
1082        bytes.extend_from_slice(&vmov_cond.to_le_bytes());
1083
1084        Ok(bytes)
1085    }
1086
1087    /// Encode F32 copysign as ARM32: extract sign from Sm, magnitude from Sn
1088    fn encode_arm_f32_copysign(&self, sd: &VfpReg, sn: &VfpReg, sm: &VfpReg) -> Result<Vec<u8>> {
1089        let mut bytes = Vec::new();
1090
1091        // VMOV R12, Sm (get sign source bits)
1092        let vmov_sm = encode_vmov_core_sreg(false, sm, &Reg::R12)?;
1093        bytes.extend_from_slice(&vmov_sm.to_le_bytes());
1094
1095        // VMOV R0, Sn (get magnitude source bits) — use R0 as temp
1096        let vmov_sn = encode_vmov_core_sreg(false, sn, &Reg::R0)?;
1097        bytes.extend_from_slice(&vmov_sn.to_le_bytes());
1098
1099        // AND R12, R12, #0x80000000 (keep only sign bit)
1100        // Thumb-2 constant 0x80000000 needs special encoding; in ARM32 use rotated imm
1101        // 0x80000000 = 0x02 rotated right by 2 (rotation=1, imm8=0x02)
1102        let and_sign = 0xE2000000u32 | (12 << 16) | (12 << 12) | (1 << 8) | 0x02;
1103        bytes.extend_from_slice(&and_sign.to_le_bytes());
1104
1105        // BIC R0, R0, #0x80000000 (clear sign bit from magnitude)
1106        // R0 = register 0, so Rn and Rd fields are 0
1107        let bic_sign = 0xE3C00000u32 | (1 << 8) | 0x02;
1108        bytes.extend_from_slice(&bic_sign.to_le_bytes());
1109
1110        // ORR R0, R0, R12 (combine sign + magnitude)
1111        // R0 = register 0, so Rn and Rd fields are 0
1112        let orr = 0xE1800000u32 | 12;
1113        bytes.extend_from_slice(&orr.to_le_bytes());
1114
1115        // VMOV Sd, R0
1116        let vmov_result = encode_vmov_core_sreg(true, sd, &Reg::R0)?;
1117        bytes.extend_from_slice(&vmov_result.to_le_bytes());
1118
1119        Ok(bytes)
1120    }
1121
1122    /// Encode F64 comparison as ARM32: VCMP.F64 + VMRS + MOV rd,#0 + MOVcond rd,#1
1123    fn encode_arm_f64_compare(
1124        &self,
1125        rd: &Reg,
1126        dn: &VfpReg,
1127        dm: &VfpReg,
1128        cond_code: u32,
1129    ) -> Result<Vec<u8>> {
1130        let mut bytes = Vec::new();
1131
1132        // VCMP.F64 Dn, Dm: 0xEEB40B40 with Dn in Vd position, Dm in Vm position
1133        let dn_num = vfp_dreg_to_num(dn)?;
1134        let dm_num = vfp_dreg_to_num(dm)?;
1135        let (vd, d) = encode_dreg(dn_num);
1136        let (vm, m) = encode_dreg(dm_num);
1137        let vcmp = 0xEEB40B40 | (d << 22) | (vd << 12) | (m << 5) | vm;
1138        bytes.extend_from_slice(&vcmp.to_le_bytes());
1139
1140        // VMRS APSR_nzcv, FPSCR
1141        bytes.extend_from_slice(&0xEEF1FA10u32.to_le_bytes());
1142
1143        // MOV rd, #0
1144        let rd_bits = reg_to_bits(rd);
1145        let mov_zero = 0xE3A00000 | (rd_bits << 12);
1146        bytes.extend_from_slice(&mov_zero.to_le_bytes());
1147
1148        // MOVcond rd, #1
1149        let mov_one = (cond_code << 28) | 0x03A00001 | (rd_bits << 12);
1150        bytes.extend_from_slice(&mov_one.to_le_bytes());
1151
1152        Ok(bytes)
1153    }
1154
1155    /// Encode F64 constant load as ARM32: MOVW + MOVT + MOVW + MOVT + VMOV
1156    fn encode_arm_f64_const(&self, dd: &VfpReg, value: f64) -> Result<Vec<u8>> {
1157        let mut bytes = Vec::new();
1158        let bits = value.to_bits();
1159        let lo32 = bits as u32;
1160        let hi32 = (bits >> 32) as u32;
1161
1162        // Load low 32 bits into R0 (Rd field = 0 for R0)
1163        let lo16 = lo32 & 0xFFFF;
1164        let movw_r0 = 0xE3000000 | ((lo16 >> 12) << 16) | (lo16 & 0xFFF);
1165        bytes.extend_from_slice(&movw_r0.to_le_bytes());
1166        let hi16 = (lo32 >> 16) & 0xFFFF;
1167        let movt_r0 = 0xE3400000 | ((hi16 >> 12) << 16) | (hi16 & 0xFFF);
1168        bytes.extend_from_slice(&movt_r0.to_le_bytes());
1169
1170        // Load high 32 bits into R12
1171        let lo16 = hi32 & 0xFFFF;
1172        let movw_r12 = 0xE3000000 | ((lo16 >> 12) << 16) | (12 << 12) | (lo16 & 0xFFF);
1173        bytes.extend_from_slice(&movw_r12.to_le_bytes());
1174        let hi16 = (hi32 >> 16) & 0xFFFF;
1175        let movt_r12 = 0xE3400000 | ((hi16 >> 12) << 16) | (12 << 12) | (hi16 & 0xFFF);
1176        bytes.extend_from_slice(&movt_r12.to_le_bytes());
1177
1178        // VMOV Dd, R0, R12
1179        let vmov = encode_vmov_core_dreg(true, dd, &Reg::R0, &Reg::R12)?;
1180        bytes.extend_from_slice(&vmov.to_le_bytes());
1181
1182        Ok(bytes)
1183    }
1184
1185    /// Encode VMOV Sd, Rm + VCVT.F64.S32/U32 Dd, Sd as ARM32
1186    fn encode_arm_f64_convert_i32(&self, dd: &VfpReg, rm: &Reg, signed: bool) -> Result<Vec<u8>> {
1187        let mut bytes = Vec::new();
1188
1189        // Use S0 as intermediate: VMOV S0, Rm
1190        let vmov = encode_vmov_core_sreg(true, &VfpReg::S0, rm)?;
1191        bytes.extend_from_slice(&vmov.to_le_bytes());
1192
1193        // VCVT.F64.S32 Dd, S0 (signed) or VCVT.F64.U32 Dd, S0 (unsigned)
1194        // Base: 0xEEB80B40 (signed) or 0xEEB80BC0 (unsigned)
1195        let dd_num = vfp_dreg_to_num(dd)?;
1196        let (vd, d) = encode_dreg(dd_num);
1197        let base = if signed { 0xEEB80B40 } else { 0xEEB80BC0 };
1198        // S0 is register 0: Vm=0, M=0
1199        let vcvt = base | (d << 22) | (vd << 12);
1200        bytes.extend_from_slice(&vcvt.to_le_bytes());
1201
1202        Ok(bytes)
1203    }
1204
1205    /// Encode VCVT.F64.F32 Dd, Sm as ARM32 (f32 to f64 promotion)
1206    fn encode_arm_f64_promote_f32(&self, dd: &VfpReg, sm: &VfpReg) -> Result<Vec<u8>> {
1207        let dd_num = vfp_dreg_to_num(dd)?;
1208        let sm_num = vfp_sreg_to_num(sm)?;
1209        let (vd, d) = encode_dreg(dd_num);
1210        let (vm, m) = encode_sreg(sm_num);
1211
1212        // VCVT.F64.F32 Dd, Sm: 0xEEB70AC0
1213        let vcvt = 0xEEB70AC0 | (d << 22) | (vd << 12) | (m << 5) | vm;
1214        Ok(vcvt.to_le_bytes().to_vec())
1215    }
1216
1217    /// Encode VCVT.S32/U32.F64 Sd, Dm + VMOV Rd, Sd as ARM32
1218    fn encode_arm_i32_trunc_f64(&self, rd: &Reg, dm: &VfpReg, signed: bool) -> Result<Vec<u8>> {
1219        let mut bytes = Vec::new();
1220        let dm_num = vfp_dreg_to_num(dm)?;
1221        let (vm, m) = encode_dreg(dm_num);
1222
1223        // VCVT.S32.F64 S0, Dm (toward zero) or VCVT.U32.F64 S0, Dm
1224        // S0: Vd=0, D=0
1225        let base = if signed { 0xEEBD0BC0 } else { 0xEEBC0BC0 };
1226        let vcvt = base | (m << 5) | vm;
1227        bytes.extend_from_slice(&vcvt.to_le_bytes());
1228
1229        // VMOV Rd, S0
1230        let vmov = encode_vmov_core_sreg(false, &VfpReg::S0, rd)?;
1231        bytes.extend_from_slice(&vmov.to_le_bytes());
1232
1233        Ok(bytes)
1234    }
1235
1236    /// Encode F64 rounding pseudo-op as ARM32 via VCVT to integer and back.
1237    /// Encode F64 rounding as ARM32.
1238    /// `mode`: FPSCR RMode — 0b00=nearest, 0b01=+inf(ceil), 0b10=-inf(floor), 0b11=zero(trunc)
1239    ///
1240    /// For trunc: uses VCVTR.S32.F64 (always truncates).
1241    /// For ceil/floor/nearest: sets FPSCR rounding mode, uses VCVT.S32.F64 (non-R variant),
1242    /// then restores FPSCR.
1243    fn encode_arm_f64_rounding(&self, dd: &VfpReg, dm: &VfpReg, mode: u8) -> Result<Vec<u8>> {
1244        let mut bytes = Vec::new();
1245        let dm_num = vfp_dreg_to_num(dm)?;
1246        let dd_num = vfp_dreg_to_num(dd)?;
1247        let (vm, m) = encode_dreg(dm_num);
1248        let (vd, d) = encode_dreg(dd_num);
1249
1250        if mode == 0b11 {
1251            // Trunc (toward zero): VCVTR.S32.F64 — bit[7]=1, always truncates
1252            let vcvt_to_int = 0xEEBD0BC0 | (m << 5) | vm;
1253            bytes.extend_from_slice(&vcvt_to_int.to_le_bytes());
1254        } else {
1255            // ceil/floor/nearest: manipulate FPSCR rounding mode
1256            let rt: u32 = 12;
1257
1258            // VMRS R12, FPSCR
1259            let vmrs = 0xEEF10A10 | (rt << 12);
1260            bytes.extend_from_slice(&vmrs.to_le_bytes());
1261
1262            // BIC R12, R12, #(3 << 22)
1263            let bic = 0xE3CC0000 | (rt << 12) | (0x05 << 8) | 0x03;
1264            bytes.extend_from_slice(&bic.to_le_bytes());
1265
1266            // ORR R12, R12, #(mode << 22)
1267            if mode != 0 {
1268                let orr = 0xE38C0000 | (rt << 12) | (0x05 << 8) | (mode as u32);
1269                bytes.extend_from_slice(&orr.to_le_bytes());
1270            }
1271
1272            // VMSR FPSCR, R12
1273            let vmsr = 0xEEE10A10 | (rt << 12);
1274            bytes.extend_from_slice(&vmsr.to_le_bytes());
1275
1276            // VCVT.S32.F64 S0, Dm — non-R variant (bit[7]=0), uses FPSCR rmode
1277            let vcvt_to_int = 0xEEBD0B40 | (m << 5) | vm;
1278            bytes.extend_from_slice(&vcvt_to_int.to_le_bytes());
1279
1280            // Restore FPSCR
1281            bytes.extend_from_slice(&vmrs.to_le_bytes());
1282            bytes.extend_from_slice(&bic.to_le_bytes());
1283            bytes.extend_from_slice(&vmsr.to_le_bytes());
1284        }
1285
1286        // VCVT.F64.S32 Dd, S0 (convert back to double)
1287        let vcvt_to_float = 0xEEB80B40 | (d << 22) | (vd << 12);
1288        bytes.extend_from_slice(&vcvt_to_float.to_le_bytes());
1289
1290        Ok(bytes)
1291    }
1292
1293    /// Encode F64 min/max as ARM32: VMOV + VCMP + VMRS + conditional VMOV
1294    fn encode_arm_f64_minmax(
1295        &self,
1296        dd: &VfpReg,
1297        dn: &VfpReg,
1298        dm: &VfpReg,
1299        is_min: bool,
1300    ) -> Result<Vec<u8>> {
1301        let mut bytes = Vec::new();
1302        let dn_num = vfp_dreg_to_num(dn)?;
1303        let dm_num = vfp_dreg_to_num(dm)?;
1304        let dd_num = vfp_dreg_to_num(dd)?;
1305
1306        // VMOV.F64 Dd, Dn (start with first operand)
1307        let (vd, d) = encode_dreg(dd_num);
1308        let (vn, n) = encode_dreg(dn_num);
1309        let vmov_dn = 0xEEB00B40 | (d << 22) | (vd << 12) | (n << 5) | vn;
1310        bytes.extend_from_slice(&vmov_dn.to_le_bytes());
1311
1312        // VCMP.F64 Dn, Dm
1313        let (vm, m) = encode_dreg(dm_num);
1314        let vcmp = 0xEEB40B40 | (n << 22) | (vn << 12) | (m << 5) | vm;
1315        bytes.extend_from_slice(&vcmp.to_le_bytes());
1316
1317        // VMRS APSR_nzcv, FPSCR
1318        bytes.extend_from_slice(&0xEEF1FA10u32.to_le_bytes());
1319
1320        let cond = if is_min { 0xCu32 } else { 0x4u32 };
1321        let vmov_cond = (cond << 28) | 0x0EB00B40 | (d << 22) | (vd << 12) | (m << 5) | vm;
1322        bytes.extend_from_slice(&vmov_cond.to_le_bytes());
1323
1324        Ok(bytes)
1325    }
1326
1327    /// Encode F64 copysign as ARM32
1328    fn encode_arm_f64_copysign(&self, dd: &VfpReg, dn: &VfpReg, dm: &VfpReg) -> Result<Vec<u8>> {
1329        let mut bytes = Vec::new();
1330
1331        // VMOV R0, R12, Dm (get sign source bits)
1332        let vmov_dm = encode_vmov_core_dreg(false, dm, &Reg::R0, &Reg::R12)?;
1333        bytes.extend_from_slice(&vmov_dm.to_le_bytes());
1334
1335        // VMOV R1, R2, Dn (get magnitude source bits)
1336        // We use R1 (lo) and R2 (hi) for the magnitude
1337        let vmov_dn = encode_vmov_core_dreg(false, dn, &Reg::R1, &Reg::R2)?;
1338        bytes.extend_from_slice(&vmov_dn.to_le_bytes());
1339
1340        // AND R12, R12, #0x80000000 (keep only sign bit from hi word)
1341        let and_sign = 0xE2000000u32 | (12 << 16) | (12 << 12) | (1 << 8) | 0x02;
1342        bytes.extend_from_slice(&and_sign.to_le_bytes());
1343
1344        // BIC R2, R2, #0x80000000 (clear sign bit from magnitude hi word)
1345        let bic_sign = 0xE3C00000u32 | (2 << 16) | (2 << 12) | (1 << 8) | 0x02;
1346        bytes.extend_from_slice(&bic_sign.to_le_bytes());
1347
1348        // ORR R2, R2, R12 (combine sign + magnitude)
1349        let orr = 0xE1800000u32 | (2 << 16) | (2 << 12) | 12;
1350        bytes.extend_from_slice(&orr.to_le_bytes());
1351
1352        // VMOV Dd, R1, R2
1353        let vmov_result = encode_vmov_core_dreg(true, dd, &Reg::R1, &Reg::R2)?;
1354        bytes.extend_from_slice(&vmov_result.to_le_bytes());
1355
1356        Ok(bytes)
1357    }
1358
1359    /// Encode VCVT.S32/U32.F32 + VMOV as ARM32
1360    fn encode_arm_i32_trunc_f32(&self, rd: &Reg, sm: &VfpReg, signed: bool) -> Result<Vec<u8>> {
1361        let mut bytes = Vec::new();
1362
1363        // VCVT.S32.F32 Sd, Sm (toward zero) or VCVT.U32.F32 Sd, Sm
1364        // We use Sm as both source and destination for the intermediate result
1365        let sm_num = vfp_sreg_to_num(sm)?;
1366        let (vd, d) = encode_sreg(sm_num);
1367        let (vm, m) = encode_sreg(sm_num);
1368        let base = if signed { 0xEEBD0AC0 } else { 0xEEBC0AC0 };
1369        let vcvt = base | (d << 22) | (vd << 12) | (m << 5) | vm;
1370        bytes.extend_from_slice(&vcvt.to_le_bytes());
1371
1372        // VMOV Rd, Sm — move result back to core register
1373        let vmov = encode_vmov_core_sreg(false, sm, rd)?;
1374        bytes.extend_from_slice(&vmov.to_le_bytes());
1375
1376        Ok(bytes)
1377    }
1378
1379    /// Encode an ARM instruction in Thumb-2 mode (16-bit or 32-bit instructions)
1380    fn encode_thumb(&self, op: &ArmOp) -> Result<Vec<u8>> {
1381        // Thumb-2 supports both 16-bit and 32-bit instructions
1382        // 32-bit instructions are encoded as two 16-bit halfwords (big-endian order)
1383        match op {
1384            // === 16-bit Thumb encodings ===
1385            ArmOp::Add { rd, rn, op2 } => {
1386                let rd_bits = reg_to_bits(rd) as u16;
1387                let rn_bits = reg_to_bits(rn) as u16;
1388
1389                if let Operand2::Reg(rm) = op2 {
1390                    let rm_bits = reg_to_bits(rm) as u16;
1391                    // ADDS Rd, Rn, Rm (16-bit): 0001 100 Rm Rn Rd
1392                    let instr: u16 = 0x1800 | (rm_bits << 6) | (rn_bits << 3) | rd_bits;
1393                    Ok(instr.to_le_bytes().to_vec())
1394                } else if let Operand2::Imm(imm) = op2 {
1395                    if *imm <= 7 && rd_bits < 8 && rn_bits < 8 {
1396                        // ADDS Rd, Rn, #imm3 (16-bit): 0001 110 imm3 Rn Rd
1397                        let instr: u16 = 0x1C00 | ((*imm as u16) << 6) | (rn_bits << 3) | rd_bits;
1398                        Ok(instr.to_le_bytes().to_vec())
1399                    } else {
1400                        // Use 32-bit ADD for larger immediates
1401                        self.encode_thumb32_add(rd, rn, *imm as u32)
1402                    }
1403                } else {
1404                    // Fallback to 32-bit encoding
1405                    self.encode_thumb32_add(rd, rn, 0)
1406                }
1407            }
1408
1409            ArmOp::Sub { rd, rn, op2 } => {
1410                let rd_bits = reg_to_bits(rd) as u16;
1411                let rn_bits = reg_to_bits(rn) as u16;
1412
1413                if let Operand2::Reg(rm) = op2 {
1414                    let rm_bits = reg_to_bits(rm) as u16;
1415                    // 16-bit SUBS can only use low registers (R0-R7)
1416                    if rd_bits < 8 && rn_bits < 8 && rm_bits < 8 {
1417                        // SUBS Rd, Rn, Rm (16-bit): 0001 101 Rm Rn Rd
1418                        let instr: u16 = 0x1A00 | (rm_bits << 6) | (rn_bits << 3) | rd_bits;
1419                        Ok(instr.to_le_bytes().to_vec())
1420                    } else {
1421                        // Use 32-bit SUB.W for high registers
1422                        self.encode_thumb32_sub_reg_raw(
1423                            rd_bits as u32,
1424                            rn_bits as u32,
1425                            rm_bits as u32,
1426                        )
1427                    }
1428                } else if let Operand2::Imm(imm) = op2 {
1429                    if *imm <= 7 && rd_bits < 8 && rn_bits < 8 {
1430                        // SUBS Rd, Rn, #imm3 (16-bit): 0001 111 imm3 Rn Rd
1431                        let instr: u16 = 0x1E00 | ((*imm as u16) << 6) | (rn_bits << 3) | rd_bits;
1432                        Ok(instr.to_le_bytes().to_vec())
1433                    } else {
1434                        self.encode_thumb32_sub(rd, rn, *imm as u32)
1435                    }
1436                } else {
1437                    self.encode_thumb32_sub(rd, rn, 0)
1438                }
1439            }
1440
1441            ArmOp::Mov { rd, op2 } => {
1442                let rd_bits = reg_to_bits(rd) as u16;
1443
1444                if let Operand2::Imm(imm) = op2 {
1445                    if *imm <= 255 && rd_bits < 8 {
1446                        // MOVS Rd, #imm8 (16-bit): 0010 0 Rd imm8
1447                        let imm_bits = (*imm as u16) & 0xFF;
1448                        let instr: u16 = 0x2000 | (rd_bits << 8) | imm_bits;
1449                        Ok(instr.to_le_bytes().to_vec())
1450                    } else {
1451                        // Use 32-bit MOVW for larger immediates
1452                        self.encode_thumb32_movw(rd, *imm as u32)
1453                    }
1454                } else if let Operand2::Reg(rm) = op2 {
1455                    let rm_bits = reg_to_bits(rm) as u16;
1456                    // MOV Rd, Rm (16-bit): 0100 0110 D Rm Rd[2:0]
1457                    // D = Rd[3], Rd[2:0] in lower bits
1458                    let d_bit = (rd_bits >> 3) & 1;
1459                    let instr: u16 = 0x4600 | (d_bit << 7) | (rm_bits << 3) | (rd_bits & 0x7);
1460                    Ok(instr.to_le_bytes().to_vec())
1461                } else {
1462                    let instr: u16 = 0xBF00; // NOP fallback
1463                    Ok(instr.to_le_bytes().to_vec())
1464                }
1465            }
1466
1467            ArmOp::Push { regs } => {
1468                // Thumb-2 PUSH encoding:
1469                // If all regs in R0-R7 + LR, use 16-bit: 1011 010 M rrrrrrrr
1470                // Otherwise use 32-bit: STMDB SP!, {regs} = 1110 1001 0010 1101 | 0M0 reglist(13)
1471                let mut reg_list: u16 = 0;
1472                let mut need_32bit = false;
1473                for r in regs {
1474                    let bit = reg_to_bits(r);
1475                    if bit >= 8 && *r != Reg::LR {
1476                        need_32bit = true;
1477                    }
1478                    reg_list |= 1 << bit;
1479                }
1480                if !need_32bit {
1481                    // 16-bit PUSH: 1011 010 M rrrrrrrr
1482                    let m_bit = if reg_list & (1 << 14) != 0 {
1483                        1u16
1484                    } else {
1485                        0u16
1486                    };
1487                    let low_regs = reg_list & 0xFF;
1488                    let instr: u16 = 0xB400 | (m_bit << 8) | low_regs;
1489                    Ok(instr.to_le_bytes().to_vec())
1490                } else {
1491                    // 32-bit STMDB SP!, {regs}: E92D | reglist(16)
1492                    let hw1: u16 = 0xE92D;
1493                    let hw2: u16 = reg_list;
1494                    let mut bytes = hw1.to_le_bytes().to_vec();
1495                    bytes.extend_from_slice(&hw2.to_le_bytes());
1496                    Ok(bytes)
1497                }
1498            }
1499
1500            ArmOp::Pop { regs } => {
1501                // Thumb-2 POP encoding:
1502                // If all regs in R0-R7 + PC, use 16-bit: 1011 110 P rrrrrrrr
1503                // Otherwise use 32-bit: LDMIA SP!, {regs} = 1110 1000 1011 1101 | PM0 reglist(13)
1504                let mut reg_list: u16 = 0;
1505                let mut need_32bit = false;
1506                for r in regs {
1507                    let bit = reg_to_bits(r);
1508                    if bit >= 8 && *r != Reg::PC {
1509                        need_32bit = true;
1510                    }
1511                    reg_list |= 1 << bit;
1512                }
1513                if !need_32bit {
1514                    // 16-bit POP: 1011 110 P rrrrrrrr
1515                    let p_bit = if reg_list & (1 << 15) != 0 {
1516                        1u16
1517                    } else {
1518                        0u16
1519                    };
1520                    let low_regs = reg_list & 0xFF;
1521                    let instr: u16 = 0xBC00 | (p_bit << 8) | low_regs;
1522                    Ok(instr.to_le_bytes().to_vec())
1523                } else {
1524                    // 32-bit LDMIA SP!, {regs}: E8BD | reglist(16)
1525                    let hw1: u16 = 0xE8BD;
1526                    let hw2: u16 = reg_list;
1527                    let mut bytes = hw1.to_le_bytes().to_vec();
1528                    bytes.extend_from_slice(&hw2.to_le_bytes());
1529                    Ok(bytes)
1530                }
1531            }
1532
1533            ArmOp::Nop => {
1534                let instr: u16 = 0xBF00; // NOP in Thumb-2
1535                Ok(instr.to_le_bytes().to_vec())
1536            }
1537
1538            ArmOp::Udf { imm } => {
1539                // UDF (Undefined) in Thumb-2: 16-bit encoding is 0xDE00 | imm8
1540                // This triggers UsageFault/HardFault, used for WASM traps
1541                let instr: u16 = 0xDE00 | (*imm as u16);
1542                let bytes = instr.to_le_bytes().to_vec();
1543                encoding_contracts::verify_thumb16(&bytes);
1544                Ok(bytes)
1545            }
1546
1547            // i64 support: ADDS, ADC, SUBS, SBC for register pair arithmetic
1548            // ADDS sets flags (carry), ADC uses carry from previous ADDS
1549            ArmOp::Adds { rd, rn, op2 } => {
1550                let rd_bits = reg_to_bits(rd) as u16;
1551                let rn_bits = reg_to_bits(rn) as u16;
1552
1553                if let Operand2::Reg(rm) = op2 {
1554                    let rm_bits = reg_to_bits(rm) as u16;
1555                    // ADDS Rd, Rn, Rm (16-bit): 0001 100 Rm Rn Rd
1556                    let instr: u16 = 0x1800 | (rm_bits << 6) | (rn_bits << 3) | rd_bits;
1557                    Ok(instr.to_le_bytes().to_vec())
1558                } else {
1559                    // 32-bit Thumb-2 ADDS with immediate
1560                    self.encode_thumb32_adds(rd, rn, 0)
1561                }
1562            }
1563
1564            // ADC: Add with Carry (Thumb-2 32-bit)
1565            // ADC.W Rd, Rn, Rm: EB40 Rn | 00 Rd 00 Rm
1566            ArmOp::Adc { rd, rn, op2 } => {
1567                let rd_bits = reg_to_bits(rd);
1568                let rn_bits = reg_to_bits(rn);
1569
1570                if let Operand2::Reg(rm) = op2 {
1571                    let rm_bits = reg_to_bits(rm);
1572                    // ADC.W Rd, Rn, Rm (T2): 1110 1011 0100 Rn | 0 000 Rd 00 00 Rm
1573                    let hw1: u16 = (0xEB40 | rn_bits) as u16;
1574                    let hw2: u16 = ((rd_bits << 8) | rm_bits) as u16;
1575
1576                    let mut bytes = hw1.to_le_bytes().to_vec();
1577                    bytes.extend_from_slice(&hw2.to_le_bytes());
1578                    Ok(bytes)
1579                } else {
1580                    // ADC with immediate - use 32-bit encoding
1581                    let hw1: u16 = (0xF140 | rn_bits) as u16;
1582                    let hw2: u16 = (rd_bits << 8) as u16;
1583                    let mut bytes = hw1.to_le_bytes().to_vec();
1584                    bytes.extend_from_slice(&hw2.to_le_bytes());
1585                    Ok(bytes)
1586                }
1587            }
1588
1589            // SUBS sets flags (borrow), SBC uses borrow from previous SUBS
1590            ArmOp::Subs { rd, rn, op2 } => {
1591                let rd_bits = reg_to_bits(rd) as u16;
1592                let rn_bits = reg_to_bits(rn) as u16;
1593
1594                if let Operand2::Reg(rm) = op2 {
1595                    let rm_bits = reg_to_bits(rm) as u16;
1596                    // SUBS Rd, Rn, Rm (16-bit): 0001 101 Rm Rn Rd
1597                    let instr: u16 = 0x1A00 | (rm_bits << 6) | (rn_bits << 3) | rd_bits;
1598                    Ok(instr.to_le_bytes().to_vec())
1599                } else {
1600                    // 32-bit Thumb-2 SUBS with immediate
1601                    self.encode_thumb32_subs(rd, rn, 0)
1602                }
1603            }
1604
1605            // SBC: Subtract with Carry (Thumb-2 32-bit)
1606            // SBC.W Rd, Rn, Rm: EB60 Rn | 00 Rd 00 Rm
1607            ArmOp::Sbc { rd, rn, op2 } => {
1608                let rd_bits = reg_to_bits(rd);
1609                let rn_bits = reg_to_bits(rn);
1610
1611                if let Operand2::Reg(rm) = op2 {
1612                    let rm_bits = reg_to_bits(rm);
1613                    // SBC.W Rd, Rn, Rm (T2): 1110 1011 0110 Rn | 0 000 Rd 00 00 Rm
1614                    let hw1: u16 = (0xEB60 | rn_bits) as u16;
1615                    let hw2: u16 = ((rd_bits << 8) | rm_bits) as u16;
1616
1617                    let mut bytes = hw1.to_le_bytes().to_vec();
1618                    bytes.extend_from_slice(&hw2.to_le_bytes());
1619                    Ok(bytes)
1620                } else {
1621                    // SBC with immediate - use 32-bit encoding
1622                    let hw1: u16 = (0xF160 | rn_bits) as u16;
1623                    let hw2: u16 = (rd_bits << 8) as u16;
1624                    let mut bytes = hw1.to_le_bytes().to_vec();
1625                    bytes.extend_from_slice(&hw2.to_le_bytes());
1626                    Ok(bytes)
1627                }
1628            }
1629
1630            // === 32-bit Thumb-2 encodings ===
1631
1632            // SDIV: 11111011 1001 Rn 1111 Rd 1111 Rm
1633            ArmOp::Sdiv { rd, rn, rm } => {
1634                let rd_bits = reg_to_bits(rd);
1635                let rn_bits = reg_to_bits(rn);
1636                let rm_bits = reg_to_bits(rm);
1637                encoding_contracts::verify_reg_bits(rd_bits);
1638                encoding_contracts::verify_reg_bits(rn_bits);
1639                encoding_contracts::verify_reg_bits(rm_bits);
1640
1641                // Thumb-2 SDIV: FB90 F0F0 | Rn<<16 | Rd<<8 | Rm
1642                // First halfword: 1111 1011 1001 Rn = 0xFB90 | Rn
1643                // Second halfword: 1111 Rd 1111 Rm = 0xF0F0 | Rd<<8 | Rm
1644                let hw1: u16 = (0xFB90 | rn_bits) as u16;
1645                let hw2: u16 = (0xF0F0 | (rd_bits << 8) | rm_bits) as u16;
1646
1647                // Thumb-2 32-bit instructions: first halfword, then second halfword (little-endian each)
1648                let mut bytes = hw1.to_le_bytes().to_vec();
1649                bytes.extend_from_slice(&hw2.to_le_bytes());
1650                encoding_contracts::verify_thumb32(&bytes);
1651                Ok(bytes)
1652            }
1653
1654            // UDIV: 11111011 1011 Rn 1111 Rd 1111 Rm
1655            ArmOp::Udiv { rd, rn, rm } => {
1656                let rd_bits = reg_to_bits(rd);
1657                let rn_bits = reg_to_bits(rn);
1658                let rm_bits = reg_to_bits(rm);
1659                encoding_contracts::verify_reg_bits(rd_bits);
1660                encoding_contracts::verify_reg_bits(rn_bits);
1661                encoding_contracts::verify_reg_bits(rm_bits);
1662
1663                // Thumb-2 UDIV: FBB0 F0F0 | Rn<<16 | Rd<<8 | Rm
1664                let hw1: u16 = (0xFBB0 | rn_bits) as u16;
1665                let hw2: u16 = (0xF0F0 | (rd_bits << 8) | rm_bits) as u16;
1666
1667                let mut bytes = hw1.to_le_bytes().to_vec();
1668                bytes.extend_from_slice(&hw2.to_le_bytes());
1669                encoding_contracts::verify_thumb32(&bytes);
1670                Ok(bytes)
1671            }
1672
1673            // MUL (Thumb-2 32-bit): MUL Rd, Rn, Rm
1674            ArmOp::Mul { rd, rn, rm } => {
1675                let rd_bits = reg_to_bits(rd);
1676                let rn_bits = reg_to_bits(rn);
1677                let rm_bits = reg_to_bits(rm);
1678
1679                // Thumb-2 MUL: FB00 F000 | Rn | Rd<<8 | Rm
1680                // 11111011 0000 Rn | 1111 Rd 0000 Rm
1681                let hw1: u16 = (0xFB00 | rn_bits) as u16;
1682                let hw2: u16 = (0xF000 | (rd_bits << 8) | rm_bits) as u16;
1683
1684                let mut bytes = hw1.to_le_bytes().to_vec();
1685                bytes.extend_from_slice(&hw2.to_le_bytes());
1686                Ok(bytes)
1687            }
1688
1689            // MLS: Rd = Ra - Rn * Rm
1690            ArmOp::Mls { rd, rn, rm, ra } => {
1691                let rd_bits = reg_to_bits(rd);
1692                let rn_bits = reg_to_bits(rn);
1693                let rm_bits = reg_to_bits(rm);
1694                let ra_bits = reg_to_bits(ra);
1695
1696                // Thumb-2 MLS: FB00 Rn | Ra Rd 0001 Rm
1697                // 11111011 0000 Rn | Ra Rd 0001 Rm
1698                let hw1: u16 = (0xFB00 | rn_bits) as u16;
1699                let hw2: u16 = ((ra_bits << 12) | (rd_bits << 8) | 0x10 | rm_bits) as u16;
1700
1701                let mut bytes = hw1.to_le_bytes().to_vec();
1702                bytes.extend_from_slice(&hw2.to_le_bytes());
1703                Ok(bytes)
1704            }
1705
1706            // AND (Thumb-2 32-bit)
1707            ArmOp::And { rd, rn, op2 } => {
1708                if let Operand2::Reg(rm) = op2 {
1709                    let rd_bits = reg_to_bits(rd);
1710                    let rn_bits = reg_to_bits(rn);
1711                    let rm_bits = reg_to_bits(rm);
1712
1713                    // Thumb-2 AND register: EA00 Rn | 0 Rd 00 00 Rm
1714                    let hw1: u16 = (0xEA00 | rn_bits) as u16;
1715                    let hw2: u16 = ((rd_bits << 8) | rm_bits) as u16;
1716
1717                    let mut bytes = hw1.to_le_bytes().to_vec();
1718                    bytes.extend_from_slice(&hw2.to_le_bytes());
1719                    Ok(bytes)
1720                } else if let Operand2::Imm(imm) = op2 {
1721                    let rd_bits = reg_to_bits(rd);
1722                    let rn_bits = reg_to_bits(rn);
1723                    let imm_val = *imm as u32;
1724
1725                    // Thumb-2 AND.W immediate T1: 11110 i 0 0000 S Rn | 0 imm3 Rd imm8
1726                    let i_bit = (imm_val >> 11) & 1;
1727                    let imm3 = (imm_val >> 8) & 0x7;
1728                    let imm8 = imm_val & 0xFF;
1729
1730                    let hw1: u16 = (0xF000 | (i_bit << 10) | rn_bits) as u16;
1731                    let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
1732
1733                    let mut bytes = hw1.to_le_bytes().to_vec();
1734                    bytes.extend_from_slice(&hw2.to_le_bytes());
1735                    Ok(bytes)
1736                } else {
1737                    // RegShift variant - fallback to NOP
1738                    let instr: u16 = 0xBF00;
1739                    Ok(instr.to_le_bytes().to_vec())
1740                }
1741            }
1742
1743            // ORR (Thumb-2 32-bit)
1744            ArmOp::Orr { rd, rn, op2 } => {
1745                if let Operand2::Reg(rm) = op2 {
1746                    let rd_bits = reg_to_bits(rd);
1747                    let rn_bits = reg_to_bits(rn);
1748                    let rm_bits = reg_to_bits(rm);
1749
1750                    // Thumb-2 ORR: EA40 Rn | 0 Rd 00 00 Rm
1751                    let hw1: u16 = (0xEA40 | rn_bits) as u16;
1752                    let hw2: u16 = ((rd_bits << 8) | rm_bits) as u16;
1753
1754                    let mut bytes = hw1.to_le_bytes().to_vec();
1755                    bytes.extend_from_slice(&hw2.to_le_bytes());
1756                    Ok(bytes)
1757                } else {
1758                    let instr: u16 = 0xBF00;
1759                    Ok(instr.to_le_bytes().to_vec())
1760                }
1761            }
1762
1763            // EOR (Thumb-2 32-bit)
1764            ArmOp::Eor { rd, rn, op2 } => {
1765                if let Operand2::Reg(rm) = op2 {
1766                    let rd_bits = reg_to_bits(rd);
1767                    let rn_bits = reg_to_bits(rn);
1768                    let rm_bits = reg_to_bits(rm);
1769
1770                    // Thumb-2 EOR: EA80 Rn | 0 Rd 00 00 Rm
1771                    let hw1: u16 = (0xEA80 | rn_bits) as u16;
1772                    let hw2: u16 = ((rd_bits << 8) | rm_bits) as u16;
1773
1774                    let mut bytes = hw1.to_le_bytes().to_vec();
1775                    bytes.extend_from_slice(&hw2.to_le_bytes());
1776                    Ok(bytes)
1777                } else {
1778                    let instr: u16 = 0xBF00;
1779                    Ok(instr.to_le_bytes().to_vec())
1780                }
1781            }
1782
1783            // Shift operations (16-bit for low registers)
1784            ArmOp::Lsl { rd, rn, shift } => {
1785                let rd_bits = reg_to_bits(rd) as u16;
1786                let rn_bits = reg_to_bits(rn) as u16;
1787                let shift_bits = (*shift as u16) & 0x1F;
1788
1789                if rd_bits < 8 && rn_bits < 8 {
1790                    // LSLS Rd, Rm, #imm5 (16-bit): 0000 0 imm5 Rm Rd
1791                    let instr: u16 = (shift_bits << 6) | (rn_bits << 3) | rd_bits;
1792                    Ok(instr.to_le_bytes().to_vec())
1793                } else {
1794                    // Use 32-bit encoding for high registers
1795                    self.encode_thumb32_shift(rd, rn, *shift, 0b00) // LSL type
1796                }
1797            }
1798
1799            ArmOp::Lsr { rd, rn, shift } => {
1800                let rd_bits = reg_to_bits(rd) as u16;
1801                let rn_bits = reg_to_bits(rn) as u16;
1802                let shift_bits = (*shift as u16) & 0x1F;
1803
1804                if rd_bits < 8 && rn_bits < 8 && shift_bits > 0 {
1805                    // LSRS Rd, Rm, #imm5 (16-bit): 0000 1 imm5 Rm Rd
1806                    let instr: u16 = 0x0800 | (shift_bits << 6) | (rn_bits << 3) | rd_bits;
1807                    Ok(instr.to_le_bytes().to_vec())
1808                } else {
1809                    self.encode_thumb32_shift(rd, rn, *shift, 0b01) // LSR type
1810                }
1811            }
1812
1813            ArmOp::Asr { rd, rn, shift } => {
1814                let rd_bits = reg_to_bits(rd) as u16;
1815                let rn_bits = reg_to_bits(rn) as u16;
1816                let shift_bits = (*shift as u16) & 0x1F;
1817
1818                if rd_bits < 8 && rn_bits < 8 && shift_bits > 0 {
1819                    // ASRS Rd, Rm, #imm5 (16-bit): 0001 0 imm5 Rm Rd
1820                    let instr: u16 = 0x1000 | (shift_bits << 6) | (rn_bits << 3) | rd_bits;
1821                    Ok(instr.to_le_bytes().to_vec())
1822                } else {
1823                    self.encode_thumb32_shift(rd, rn, *shift, 0b10) // ASR type
1824                }
1825            }
1826
1827            ArmOp::Ror { rd, rn, shift } => {
1828                // ROR doesn't have a 16-bit immediate form, use 32-bit
1829                self.encode_thumb32_shift(rd, rn, *shift, 0b11) // ROR type
1830            }
1831
1832            // Register-based shifts (Thumb-2 32-bit)
1833            // Encoding: 11111010 0xxS Rn 1111 Rd 0000 Rm
1834            // xx = shift type: 00=LSL, 01=LSR, 10=ASR, 11=ROR
1835            ArmOp::LslReg { rd, rn, rm } => self.encode_thumb32_shift_reg(rd, rn, rm, 0b00),
1836            ArmOp::LsrReg { rd, rn, rm } => self.encode_thumb32_shift_reg(rd, rn, rm, 0b01),
1837            ArmOp::AsrReg { rd, rn, rm } => self.encode_thumb32_shift_reg(rd, rn, rm, 0b10),
1838            ArmOp::RorReg { rd, rn, rm } => self.encode_thumb32_shift_reg(rd, rn, rm, 0b11),
1839
1840            // RSB (Reverse Subtract): Rd = imm - Rn
1841            // Thumb-2 T2 encoding: 11110 i 0 1110 S Rn | 0 imm3 Rd imm8
1842            ArmOp::Rsb { rd, rn, imm } => {
1843                let rd_bits = reg_to_bits(rd);
1844                let rn_bits = reg_to_bits(rn);
1845                let imm_val = *imm;
1846
1847                let i_bit = (imm_val >> 11) & 1;
1848                let imm3 = (imm_val >> 8) & 0x7;
1849                let imm8 = imm_val & 0xFF;
1850
1851                // hw1: 11110 i 01110 0 Rn  (S=0)
1852                let hw1: u16 = (0xF1C0 | (i_bit << 10) | rn_bits) as u16;
1853                // hw2: 0 imm3 Rd imm8
1854                let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
1855
1856                let mut bytes = hw1.to_le_bytes().to_vec();
1857                bytes.extend_from_slice(&hw2.to_le_bytes());
1858                Ok(bytes)
1859            }
1860
1861            // CLZ (Thumb-2 32-bit)
1862            ArmOp::Clz { rd, rm } => {
1863                let rd_bits = reg_to_bits(rd);
1864                let rm_bits = reg_to_bits(rm);
1865
1866                // Thumb-2 CLZ: FAB0 Rm | F8 Rd Rm
1867                // 11111010 1011 Rm | 1111 1000 Rd Rm
1868                let hw1: u16 = (0xFAB0 | rm_bits) as u16;
1869                let hw2: u16 = (0xF080 | (rd_bits << 8) | rm_bits) as u16;
1870
1871                let mut bytes = hw1.to_le_bytes().to_vec();
1872                bytes.extend_from_slice(&hw2.to_le_bytes());
1873                Ok(bytes)
1874            }
1875
1876            // RBIT (Thumb-2 32-bit)
1877            ArmOp::Rbit { rd, rm } => {
1878                let rd_bits = reg_to_bits(rd);
1879                let rm_bits = reg_to_bits(rm);
1880
1881                // Thumb-2 RBIT: FA90 Rm | F0 Rd A0 Rm
1882                // 11111010 1001 Rm | 1111 Rd 1010 Rm
1883                let hw1: u16 = (0xFA90 | rm_bits) as u16;
1884                let hw2: u16 = (0xF0A0 | (rd_bits << 8) | rm_bits) as u16;
1885
1886                let mut bytes = hw1.to_le_bytes().to_vec();
1887                bytes.extend_from_slice(&hw2.to_le_bytes());
1888                Ok(bytes)
1889            }
1890
1891            // SXTB (16-bit for low registers)
1892            ArmOp::Sxtb { rd, rm } => {
1893                let rd_bits = reg_to_bits(rd) as u16;
1894                let rm_bits = reg_to_bits(rm) as u16;
1895
1896                if rd_bits < 8 && rm_bits < 8 {
1897                    // SXTB Rd, Rm (16-bit): 1011 0010 01 Rm Rd
1898                    let instr: u16 = 0xB240 | (rm_bits << 3) | rd_bits;
1899                    Ok(instr.to_le_bytes().to_vec())
1900                } else {
1901                    // Thumb-2 SXTB.W: FA4F F(rd)80 (rm)
1902                    // 11111010 0100 1111 | 1111 Rd 10 rotate Rm
1903                    let rd_bits32 = rd_bits as u32;
1904                    let rm_bits32 = rm_bits as u32;
1905                    let hw1: u16 = 0xFA4F;
1906                    let hw2: u16 = (0xF080 | (rd_bits32 << 8) | rm_bits32) as u16;
1907                    let mut bytes = hw1.to_le_bytes().to_vec();
1908                    bytes.extend_from_slice(&hw2.to_le_bytes());
1909                    Ok(bytes)
1910                }
1911            }
1912
1913            // SXTH (16-bit for low registers)
1914            ArmOp::Sxth { rd, rm } => {
1915                let rd_bits = reg_to_bits(rd) as u16;
1916                let rm_bits = reg_to_bits(rm) as u16;
1917
1918                if rd_bits < 8 && rm_bits < 8 {
1919                    // SXTH Rd, Rm (16-bit): 1011 0010 00 Rm Rd
1920                    let instr: u16 = 0xB200 | (rm_bits << 3) | rd_bits;
1921                    Ok(instr.to_le_bytes().to_vec())
1922                } else {
1923                    // Thumb-2 SXTH.W: FA0F F(rd)80 (rm)
1924                    // 11111010 0000 1111 | 1111 Rd 10 rotate Rm
1925                    let rd_bits32 = rd_bits as u32;
1926                    let rm_bits32 = rm_bits as u32;
1927                    let hw1: u16 = 0xFA0F;
1928                    let hw2: u16 = (0xF080 | (rd_bits32 << 8) | rm_bits32) as u16;
1929                    let mut bytes = hw1.to_le_bytes().to_vec();
1930                    bytes.extend_from_slice(&hw2.to_le_bytes());
1931                    Ok(bytes)
1932                }
1933            }
1934
1935            // CMP (can be 16-bit for low registers)
1936            ArmOp::Cmp { rn, op2 } => {
1937                let rn_bits = reg_to_bits(rn) as u16;
1938
1939                if let Operand2::Imm(imm) = op2 {
1940                    // Only use 16-bit encoding for non-negative immediates 0-255
1941                    // Negative immediates must use 32-bit encoding
1942                    if *imm >= 0 && *imm <= 255 && rn_bits < 8 {
1943                        // CMP Rn, #imm8 (16-bit): 0010 1 Rn imm8
1944                        let instr: u16 = 0x2800 | (rn_bits << 8) | (*imm as u16 & 0xFF);
1945                        Ok(instr.to_le_bytes().to_vec())
1946                    } else {
1947                        self.encode_thumb32_cmp_imm(rn, *imm as u32)
1948                    }
1949                } else if let Operand2::Reg(rm) = op2 {
1950                    let rm_bits = reg_to_bits(rm) as u16;
1951                    if rn_bits < 8 && rm_bits < 8 {
1952                        // CMP Rn, Rm (16-bit low): 0100 0010 10 Rm Rn
1953                        let instr: u16 = 0x4280 | (rm_bits << 3) | rn_bits;
1954                        Ok(instr.to_le_bytes().to_vec())
1955                    } else {
1956                        // CMP Rn, Rm (16-bit high): 0100 0101 N Rm Rn[2:0]
1957                        let n_bit = (rn_bits >> 3) & 1;
1958                        let instr: u16 = 0x4500 | (n_bit << 7) | (rm_bits << 3) | (rn_bits & 0x7);
1959                        Ok(instr.to_le_bytes().to_vec())
1960                    }
1961                } else {
1962                    let instr: u16 = 0xBF00;
1963                    Ok(instr.to_le_bytes().to_vec())
1964                }
1965            }
1966
1967            // CMN (Compare Negative) - computes Rn + op2 and sets flags
1968            // CMN Rn, #1 sets Z flag if Rn == -1 (since -1 + 1 = 0)
1969            ArmOp::Cmn { rn, op2 } => {
1970                let rn_bits = reg_to_bits(rn) as u16;
1971
1972                if let Operand2::Imm(imm) = op2 {
1973                    // CMN.W Rn, #imm (32-bit encoding)
1974                    // Encoding: F110 Rn | 0F00 imm8 (for small immediates 0-255)
1975                    if *imm >= 0 && *imm <= 255 {
1976                        let imm8 = *imm as u16 & 0xFF;
1977                        let hw1: u16 = 0xF110 | rn_bits;
1978                        let hw2: u16 = 0x0F00 | imm8;
1979                        let mut bytes = hw1.to_le_bytes().to_vec();
1980                        bytes.extend_from_slice(&hw2.to_le_bytes());
1981                        Ok(bytes)
1982                    } else {
1983                        // For other immediates, fallback to NOP (should not happen in our use case)
1984                        Ok(vec![0xBF, 0x00])
1985                    }
1986                } else if let Operand2::Reg(rm) = op2 {
1987                    let rm_bits = reg_to_bits(rm) as u16;
1988                    // CMN Rn, Rm (16-bit): 0100 0010 11 Rm Rn
1989                    let instr: u16 = 0x42C0 | (rm_bits << 3) | rn_bits;
1990                    Ok(instr.to_le_bytes().to_vec())
1991                } else {
1992                    Ok(vec![0xBF, 0x00])
1993                }
1994            }
1995
1996            // LDR (can be 16-bit for simple cases)
1997            ArmOp::Ldr { rd, addr } => {
1998                let rd_bits = reg_to_bits(rd);
1999                let base_bits = reg_to_bits(&addr.base);
2000
2001                // Handle register offset mode [base, Roff] or [base, Roff, #imm]
2002                if let Some(offset_reg) = &addr.offset_reg {
2003                    let rm_bits = reg_to_bits(offset_reg);
2004
2005                    // If there's also an immediate offset, we need to ADD it first
2006                    if addr.offset != 0 {
2007                        // Use R12 (IP) as scratch to avoid clobbering the address register
2008                        // ADD R12, Rm, #offset; LDR Rd, [base, R12]
2009                        let scratch = Reg::R12;
2010                        let mut bytes =
2011                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2012                        bytes.extend(self.encode_thumb32_ldr_reg(rd, &addr.base, &scratch)?);
2013                        return Ok(bytes);
2014                    }
2015
2016                    // Simple register offset: LDR Rd, [Rn, Rm]
2017                    // 16-bit: only if Rd, Rn, Rm < R8
2018                    if rd_bits < 8 && base_bits < 8 && rm_bits < 8 {
2019                        // LDR Rd, [Rn, Rm] (16-bit): 0101 100 Rm Rn Rd
2020                        let instr: u16 = 0x5800
2021                            | ((rm_bits as u16) << 6)
2022                            | ((base_bits as u16) << 3)
2023                            | (rd_bits as u16);
2024                        return Ok(instr.to_le_bytes().to_vec());
2025                    }
2026
2027                    // 32-bit register offset
2028                    return self.encode_thumb32_ldr_reg(rd, &addr.base, offset_reg);
2029                }
2030
2031                // Immediate offset mode [base, #imm]
2032                let offset = addr.offset as u32;
2033
2034                if rd_bits < 8 && base_bits < 8 && (offset & 0x3) == 0 && offset <= 124 {
2035                    // LDR Rd, [Rn, #imm5*4] (16-bit): 0110 1 imm5 Rn Rd
2036                    let imm5 = (offset >> 2) as u16;
2037                    let instr: u16 =
2038                        0x6800 | (imm5 << 6) | ((base_bits as u16) << 3) | (rd_bits as u16);
2039                    Ok(instr.to_le_bytes().to_vec())
2040                } else {
2041                    self.encode_thumb32_ldr(rd, &addr.base, offset)
2042                }
2043            }
2044
2045            // STR (can be 16-bit for simple cases)
2046            ArmOp::Str { rd, addr } => {
2047                let rd_bits = reg_to_bits(rd);
2048                let base_bits = reg_to_bits(&addr.base);
2049
2050                // Handle register offset mode [base, Roff] or [base, Roff, #imm]
2051                if let Some(offset_reg) = &addr.offset_reg {
2052                    let rm_bits = reg_to_bits(offset_reg);
2053
2054                    // If there's also an immediate offset, we need to ADD it first
2055                    if addr.offset != 0 {
2056                        // Use R12 (IP) as scratch to avoid clobbering the address register
2057                        // ADD R12, Rm, #offset; STR Rd, [base, R12]
2058                        let scratch = Reg::R12;
2059                        let mut bytes =
2060                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2061                        bytes.extend(self.encode_thumb32_str_reg(rd, &addr.base, &scratch)?);
2062                        return Ok(bytes);
2063                    }
2064
2065                    // Simple register offset: STR Rd, [Rn, Rm]
2066                    // 16-bit: only if Rd, Rn, Rm < R8
2067                    if rd_bits < 8 && base_bits < 8 && rm_bits < 8 {
2068                        // STR Rd, [Rn, Rm] (16-bit): 0101 000 Rm Rn Rd
2069                        let instr: u16 = 0x5000
2070                            | ((rm_bits as u16) << 6)
2071                            | ((base_bits as u16) << 3)
2072                            | (rd_bits as u16);
2073                        return Ok(instr.to_le_bytes().to_vec());
2074                    }
2075
2076                    // 32-bit register offset
2077                    return self.encode_thumb32_str_reg(rd, &addr.base, offset_reg);
2078                }
2079
2080                // Immediate offset mode [base, #imm]
2081                let offset = addr.offset as u32;
2082
2083                if rd_bits < 8 && base_bits < 8 && (offset & 0x3) == 0 && offset <= 124 {
2084                    // STR Rd, [Rn, #imm5*4] (16-bit): 0110 0 imm5 Rn Rd
2085                    let imm5 = (offset >> 2) as u16;
2086                    let instr: u16 =
2087                        0x6000 | (imm5 << 6) | ((base_bits as u16) << 3) | (rd_bits as u16);
2088                    Ok(instr.to_le_bytes().to_vec())
2089                } else {
2090                    self.encode_thumb32_str(rd, &addr.base, offset)
2091                }
2092            }
2093
2094            // LDRB (Thumb-2)
2095            ArmOp::Ldrb { rd, addr } => {
2096                let rd_bits = reg_to_bits(rd);
2097                let base_bits = reg_to_bits(&addr.base);
2098
2099                if let Some(offset_reg) = &addr.offset_reg {
2100                    if addr.offset != 0 {
2101                        let scratch = Reg::R12;
2102                        let mut bytes =
2103                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2104                        bytes.extend(self.encode_thumb32_ldrb_reg(rd, &addr.base, &scratch)?);
2105                        return Ok(bytes);
2106                    }
2107                    return self.encode_thumb32_ldrb_reg(rd, &addr.base, offset_reg);
2108                }
2109
2110                let offset = addr.offset as u32;
2111                if rd_bits < 8 && base_bits < 8 && offset <= 31 {
2112                    // LDRB Rd, [Rn, #imm5] (16-bit): 0111 1 imm5 Rn Rd
2113                    let instr: u16 = 0x7800
2114                        | ((offset as u16) << 6)
2115                        | ((base_bits as u16) << 3)
2116                        | (rd_bits as u16);
2117                    Ok(instr.to_le_bytes().to_vec())
2118                } else {
2119                    self.encode_thumb32_ldrb_imm(rd, &addr.base, offset)
2120                }
2121            }
2122
2123            // LDRSB (Thumb-2)
2124            ArmOp::Ldrsb { rd, addr } => {
2125                let rd_bits = reg_to_bits(rd);
2126                let base_bits = reg_to_bits(&addr.base);
2127
2128                if let Some(offset_reg) = &addr.offset_reg {
2129                    if addr.offset != 0 {
2130                        let scratch = Reg::R12;
2131                        let mut bytes =
2132                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2133                        bytes.extend(self.encode_thumb32_ldrsb_reg(rd, &addr.base, &scratch)?);
2134                        return Ok(bytes);
2135                    }
2136                    return self.encode_thumb32_ldrsb_reg(rd, &addr.base, offset_reg);
2137                }
2138
2139                let offset = addr.offset as u32;
2140                // LDRSB has no 16-bit immediate form (only register)
2141                // For 16-bit reg form: only if Rd, Rn, Rm < R8
2142                if rd_bits < 8 && base_bits < 8 && offset == 0 {
2143                    // No immediate 16-bit encoding for LDRSB; use 32-bit
2144                    self.encode_thumb32_ldrsb_imm(rd, &addr.base, offset)
2145                } else {
2146                    self.encode_thumb32_ldrsb_imm(rd, &addr.base, offset)
2147                }
2148            }
2149
2150            // LDRH (Thumb-2)
2151            ArmOp::Ldrh { rd, addr } => {
2152                let rd_bits = reg_to_bits(rd);
2153                let base_bits = reg_to_bits(&addr.base);
2154
2155                if let Some(offset_reg) = &addr.offset_reg {
2156                    if addr.offset != 0 {
2157                        let scratch = Reg::R12;
2158                        let mut bytes =
2159                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2160                        bytes.extend(self.encode_thumb32_ldrh_reg(rd, &addr.base, &scratch)?);
2161                        return Ok(bytes);
2162                    }
2163                    return self.encode_thumb32_ldrh_reg(rd, &addr.base, offset_reg);
2164                }
2165
2166                let offset = addr.offset as u32;
2167                if rd_bits < 8 && base_bits < 8 && (offset & 0x1) == 0 && offset <= 62 {
2168                    // LDRH Rd, [Rn, #imm5*2] (16-bit): 1000 1 imm5 Rn Rd
2169                    let imm5 = (offset >> 1) as u16;
2170                    let instr: u16 =
2171                        0x8800 | (imm5 << 6) | ((base_bits as u16) << 3) | (rd_bits as u16);
2172                    Ok(instr.to_le_bytes().to_vec())
2173                } else {
2174                    self.encode_thumb32_ldrh_imm(rd, &addr.base, offset)
2175                }
2176            }
2177
2178            // LDRSH (Thumb-2)
2179            ArmOp::Ldrsh { rd, addr } => {
2180                if let Some(offset_reg) = &addr.offset_reg {
2181                    if addr.offset != 0 {
2182                        let scratch = Reg::R12;
2183                        let mut bytes =
2184                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2185                        bytes.extend(self.encode_thumb32_ldrsh_reg(rd, &addr.base, &scratch)?);
2186                        return Ok(bytes);
2187                    }
2188                    return self.encode_thumb32_ldrsh_reg(rd, &addr.base, offset_reg);
2189                }
2190
2191                let offset = addr.offset as u32;
2192                self.encode_thumb32_ldrsh_imm(rd, &addr.base, offset)
2193            }
2194
2195            // STRB (Thumb-2)
2196            ArmOp::Strb { rd, addr } => {
2197                let rd_bits = reg_to_bits(rd);
2198                let base_bits = reg_to_bits(&addr.base);
2199
2200                if let Some(offset_reg) = &addr.offset_reg {
2201                    if addr.offset != 0 {
2202                        let scratch = Reg::R12;
2203                        let mut bytes =
2204                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2205                        bytes.extend(self.encode_thumb32_strb_reg(rd, &addr.base, &scratch)?);
2206                        return Ok(bytes);
2207                    }
2208                    return self.encode_thumb32_strb_reg(rd, &addr.base, offset_reg);
2209                }
2210
2211                let offset = addr.offset as u32;
2212                if rd_bits < 8 && base_bits < 8 && offset <= 31 {
2213                    // STRB Rd, [Rn, #imm5] (16-bit): 0111 0 imm5 Rn Rd
2214                    let instr: u16 = 0x7000
2215                        | ((offset as u16) << 6)
2216                        | ((base_bits as u16) << 3)
2217                        | (rd_bits as u16);
2218                    Ok(instr.to_le_bytes().to_vec())
2219                } else {
2220                    self.encode_thumb32_strb_imm(rd, &addr.base, offset)
2221                }
2222            }
2223
2224            // STRH (Thumb-2)
2225            ArmOp::Strh { rd, addr } => {
2226                let rd_bits = reg_to_bits(rd);
2227                let base_bits = reg_to_bits(&addr.base);
2228
2229                if let Some(offset_reg) = &addr.offset_reg {
2230                    if addr.offset != 0 {
2231                        let scratch = Reg::R12;
2232                        let mut bytes =
2233                            self.encode_thumb32_add_imm(&scratch, offset_reg, addr.offset as u32)?;
2234                        bytes.extend(self.encode_thumb32_strh_reg(rd, &addr.base, &scratch)?);
2235                        return Ok(bytes);
2236                    }
2237                    return self.encode_thumb32_strh_reg(rd, &addr.base, offset_reg);
2238                }
2239
2240                let offset = addr.offset as u32;
2241                if rd_bits < 8 && base_bits < 8 && (offset & 0x1) == 0 && offset <= 62 {
2242                    // STRH Rd, [Rn, #imm5*2] (16-bit): 1000 0 imm5 Rn Rd
2243                    let imm5 = (offset >> 1) as u16;
2244                    let instr: u16 =
2245                        0x8000 | (imm5 << 6) | ((base_bits as u16) << 3) | (rd_bits as u16);
2246                    Ok(instr.to_le_bytes().to_vec())
2247                } else {
2248                    self.encode_thumb32_strh_imm(rd, &addr.base, offset)
2249                }
2250            }
2251
2252            // MemorySize (Thumb-2)
2253            ArmOp::MemorySize { rd } => {
2254                // LSR rd, R10, #16 — memory size in bytes / 65536 = pages
2255                // Thumb-2 16-bit: LSRS Rd, Rm, #imm5 — 0000 1 imm5 Rm Rd
2256                let rd_bits = reg_to_bits(rd);
2257                let r10_bits = reg_to_bits(&Reg::R10);
2258                if rd_bits < 8 && r10_bits < 8 {
2259                    let instr: u16 =
2260                        0x0800 | (16u16 << 6) | ((r10_bits as u16) << 3) | (rd_bits as u16);
2261                    Ok(instr.to_le_bytes().to_vec())
2262                } else {
2263                    // Thumb-2 32-bit LSR: 1110 1010 010 0 1111 | 0 imm3 Rd imm2 01 Rm
2264                    let imm5: u32 = 16;
2265                    let imm3 = (imm5 >> 2) & 0x7;
2266                    let imm2 = imm5 & 0x3;
2267                    let hw1: u16 = 0xEA4F;
2268                    let hw2: u16 =
2269                        ((imm3 << 12) | (rd_bits << 8) | (imm2 << 6) | 0x10 | r10_bits) as u16;
2270                    let mut bytes = hw1.to_le_bytes().to_vec();
2271                    bytes.extend_from_slice(&hw2.to_le_bytes());
2272                    Ok(bytes)
2273                }
2274            }
2275
2276            // MemoryGrow (Thumb-2)
2277            ArmOp::MemoryGrow { rd, .. } => {
2278                // On embedded with fixed memory, always return -1 (failure)
2279                // MVN rd, #0 → MOV rd, #-1
2280                // Thumb-2 32-bit: MVN: 1111 0 i 0 0 0 1 1 0 1111 | 0 imm3 Rd imm8
2281                let rd_bits = reg_to_bits(rd);
2282                let hw1: u16 = 0xF06F; // MVN with i=0
2283                let hw2: u16 = (rd_bits << 8) as u16; // imm8=0 → ~0 = 0xFFFFFFFF = -1
2284                let mut bytes = hw1.to_le_bytes().to_vec();
2285                bytes.extend_from_slice(&hw2.to_le_bytes());
2286                Ok(bytes)
2287            }
2288
2289            // BX (16-bit)
2290            ArmOp::Bx { rm } => {
2291                let rm_bits = reg_to_bits(rm) as u16;
2292                // BX Rm (16-bit): 0100 0111 0 Rm 000
2293                let instr: u16 = 0x4700 | (rm_bits << 3);
2294                Ok(instr.to_le_bytes().to_vec())
2295            }
2296
2297            // BLX (16-bit) - Branch with Link and Exchange
2298            // BLX Rm: 0100 0111 1 Rm 000
2299            ArmOp::Blx { rm } => {
2300                let rm_bits = reg_to_bits(rm) as u16;
2301                let instr: u16 = 0x4780 | (rm_bits << 3);
2302                Ok(instr.to_le_bytes().to_vec())
2303            }
2304
2305            // CallIndirect - indirect function call via table lookup
2306            // table_index_reg contains the table index
2307            // Generates: LSL R12, idx, #2; LDR R12, [R12, table_base]; BLX R12
2308            ArmOp::CallIndirect {
2309                rd: _,
2310                type_idx: _,
2311                table_index_reg,
2312            } => {
2313                let idx_reg = reg_to_bits(table_index_reg);
2314                let mut bytes = Vec::new();
2315
2316                // For now, we generate code that:
2317                // 1. Multiplies index by 4 (function pointer size)
2318                // 2. Loads function pointer from table (assumes table base in R11)
2319                // 3. Calls the function via BLX
2320                //
2321                // Table base setup must be done by caller/runtime.
2322                // This is a simplified implementation - full support needs:
2323                // - Table base address resolution
2324                // - Type signature checking
2325                // - Bounds checking
2326
2327                // LSL R12, idx_reg, #2 (multiply index by 4)
2328                // Thumb-2 MOV with shift: 11101010 010 S 1111 | 0 imm3 Rd imm2 type Rm
2329                // LSL: type=00, imm5=2 -> imm3=0, imm2=10
2330                let hw1: u16 = 0xEA4F_u16; // MOV.W R12, Rm, LSL #2
2331                let hw2: u16 = ((0x0C00 | (0b10 << 4)) | idx_reg) as u16;
2332                bytes.extend_from_slice(&hw1.to_le_bytes());
2333                bytes.extend_from_slice(&hw2.to_le_bytes());
2334
2335                // LDR R12, [R11, R12] - load function pointer
2336                // Thumb-2 LDR (register): 1111 1000 0101 Rn | Rt 0000 00 imm2 Rm
2337                // Rn=R11, Rt=R12, Rm=R12, imm2=00 (no shift)
2338                let ldr_hw1: u16 = 0xF85B; // LDR.W Rt, [R11, Rm]
2339                let ldr_hw2: u16 = 0xC00C; // Rt=R12, imm2=00, Rm=R12
2340                bytes.extend_from_slice(&ldr_hw1.to_le_bytes());
2341                bytes.extend_from_slice(&ldr_hw2.to_le_bytes());
2342
2343                // BLX R12 (call function indirectly)
2344                // BLX Rm (16-bit): 0100 0111 1 Rm 000
2345                let blx: u16 = 0x47E0; // BLX R12
2346                bytes.extend_from_slice(&blx.to_le_bytes());
2347
2348                Ok(bytes)
2349            }
2350
2351            // Label pseudo-instruction: emits no machine code
2352            ArmOp::Label { .. } => Ok(Vec::new()),
2353
2354            // Conditional branch to label (generic) - offset 0, will be patched
2355            ArmOp::Bcc { cond, label: _ } => {
2356                use synth_synthesis::Condition;
2357                let cond_bits: u16 = match cond {
2358                    Condition::EQ => 0x0,
2359                    Condition::NE => 0x1,
2360                    Condition::HS => 0x2,
2361                    Condition::LO => 0x3,
2362                    Condition::HI => 0x8,
2363                    Condition::LS => 0x9,
2364                    Condition::GE => 0xA,
2365                    Condition::LT => 0xB,
2366                    Condition::GT => 0xC,
2367                    Condition::LE => 0xD,
2368                };
2369                // 16-bit B<cond> with offset 0: 1101 cond imm8
2370                let instr: u16 = 0xD000 | (cond_bits << 8);
2371                Ok(instr.to_le_bytes().to_vec())
2372            }
2373
2374            // Branch instructions
2375            ArmOp::B { label: _ } => {
2376                // Simplified: B.N with offset 0
2377                // For real usage, would need label resolution
2378                let instr: u16 = 0xE000; // B.N #0
2379                Ok(instr.to_le_bytes().to_vec())
2380            }
2381
2382            // BHS (Branch if Higher or Same) - used for bounds checking
2383            // Condition code: 0x2 (C set)
2384            ArmOp::Bhs { label: _ } => {
2385                // 16-bit B<cond> with offset 0: 1101 cond imm8
2386                // cond = 0x2 (HS)
2387                let instr: u16 = 0xD200; // BHS.N #0
2388                Ok(instr.to_le_bytes().to_vec())
2389            }
2390
2391            // BLO (Branch if Lower) - complementary to BHS
2392            // Condition code: 0x3 (C clear)
2393            ArmOp::Blo { label: _ } => {
2394                // 16-bit B<cond> with offset 0: 1101 cond imm8
2395                // cond = 0x3 (LO)
2396                let instr: u16 = 0xD300; // BLO.N #0
2397                Ok(instr.to_le_bytes().to_vec())
2398            }
2399
2400            // Branch with numeric offset (Thumb-2)
2401            // Thumb-2 B.W instruction: 32-bit with +-16MB range
2402            ArmOp::BOffset { offset } => {
2403                // offset is already the halfword displacement: (target - branch - 4) / 2
2404                // This is the raw encoded value, accounting for variable-length instructions
2405                let halfword_offset = *offset;
2406
2407                // 16-bit B.N encoding: 1110 0 imm11 (11-bit signed halfword offset)
2408                // Range: -1024 to +1022 halfwords
2409                if (-1024..=1022).contains(&halfword_offset) {
2410                    // 16-bit B.N encoding: 1110 0 imm11
2411                    let imm11 = (halfword_offset as u16) & 0x7FF;
2412                    let instr: u16 = 0xE000 | imm11;
2413                    Ok(instr.to_le_bytes().to_vec())
2414                } else {
2415                    // 32-bit B.W encoding for larger offsets
2416                    // First halfword: 1111 0 S imm10
2417                    // Second halfword: 10 J1 0 J2 imm11
2418                    // Total offset = SignExtend(S:I1:I2:imm10:imm11:0)
2419                    // where I1 = NOT(J1 XOR S), I2 = NOT(J2 XOR S)
2420
2421                    // The B.W (T4) encoding packs the signed offset as:
2422                    //   S:I1:I2:imm10:imm11:0  (25-bit signed, halfword-aligned)
2423                    // where J1 = NOT(I1 XOR S), J2 = NOT(I2 XOR S)
2424                    // Input halfword_offset already equals (target - PC - 4) / 2,
2425                    // so the full byte offset = halfword_offset << 1.
2426                    // The encoding fields split that 25-bit signed value (including the
2427                    // implicit trailing zero) as: S | imm10 | imm11
2428                    // with I1 = bit 23 and I2 = bit 22 of the signed offset.
2429                    let signed_offset = halfword_offset << 1; // byte offset
2430                    let s = if signed_offset < 0 { 1u32 } else { 0u32 };
2431                    let uoffset = signed_offset as u32;
2432                    let imm10 = (uoffset >> 12) & 0x3FF; // bits [21:12]
2433                    let imm11 = (uoffset >> 1) & 0x7FF; // bits [11:1]
2434                    let i1 = (uoffset >> 23) & 1; // bit 23
2435                    let i2 = (uoffset >> 22) & 1; // bit 22
2436                    let j1 = (!(i1 ^ s)) & 1; // J1 = NOT(I1 XOR S)
2437                    let j2 = (!(i2 ^ s)) & 1; // J2 = NOT(I2 XOR S)
2438
2439                    let hw1: u16 = (0xF000 | (s << 10) | imm10) as u16;
2440                    let hw2: u16 = (0x9000 | (j1 << 13) | (j2 << 11) | imm11) as u16;
2441
2442                    let mut bytes = hw1.to_le_bytes().to_vec();
2443                    bytes.extend_from_slice(&hw2.to_le_bytes());
2444                    Ok(bytes)
2445                }
2446            }
2447
2448            // Conditional branch with numeric offset (Thumb-2)
2449            ArmOp::BCondOffset { cond, offset } => {
2450                use synth_synthesis::Condition;
2451                let cond_bits: u16 = match cond {
2452                    Condition::EQ => 0x0,
2453                    Condition::NE => 0x1,
2454                    Condition::HS => 0x2,
2455                    Condition::LO => 0x3,
2456                    Condition::HI => 0x8,
2457                    Condition::LS => 0x9,
2458                    Condition::GE => 0xA,
2459                    Condition::LT => 0xB,
2460                    Condition::GT => 0xC,
2461                    Condition::LE => 0xD,
2462                };
2463
2464                // offset is already the halfword displacement: (target - branch - 4) / 2
2465                // This is the raw imm8 value for 16-bit B<cond> encoding
2466                let halfword_offset = *offset;
2467
2468                // 16-bit B<cond> encoding: 1101 cond imm8
2469                // Range: -256 to +254 halfwords (imm8 is sign-extended and shifted left 1)
2470                if (-128..=127).contains(&halfword_offset) {
2471                    let imm8 = (halfword_offset as u16) & 0xFF;
2472                    let instr: u16 = 0xD000 | (cond_bits << 8) | imm8;
2473                    Ok(instr.to_le_bytes().to_vec())
2474                } else {
2475                    // 32-bit B<cond>.W for larger offsets
2476                    // First halfword: 1111 0 S cond imm6
2477                    // Second halfword: 10 J1 0 J2 imm11
2478                    let offset = halfword_offset >> 1;
2479                    let s = if offset < 0 { 1u32 } else { 0u32 };
2480                    let imm6 = ((offset >> 11) as u32) & 0x3F;
2481                    let imm11 = (offset as u32) & 0x7FF;
2482                    let j1 = if s == 1 { 1 } else { 0 };
2483                    let j2 = if s == 1 { 1 } else { 0 };
2484
2485                    let hw1: u16 = (0xF000 | (s << 10) | ((cond_bits as u32) << 6) | imm6) as u16;
2486                    let hw2: u16 = (0x8000 | (j1 << 13) | (j2 << 11) | imm11) as u16;
2487
2488                    let mut bytes = hw1.to_le_bytes().to_vec();
2489                    bytes.extend_from_slice(&hw2.to_le_bytes());
2490                    Ok(bytes)
2491                }
2492            }
2493
2494            ArmOp::Bl { label: _ } => {
2495                // BL is always 32-bit in Thumb-2, encoded here with offset 0
2496                // (a relocation patches the target — see arm_backend.rs).
2497                // Second halfword must be 0xF800, NOT 0xD000: the Thumb-2 BL
2498                // offset uses I1 = NOT(J1 XOR S), I2 = NOT(J2 XOR S). For a true
2499                // zero offset (S=0, imm=0) we need I1=I2=0, i.e. J1=J2=1, giving
2500                //   hw2 = 11 J1(=1) 1 J2(=1) imm11(=0) = 0b1111_1000_0000_0000 = 0xF800.
2501                // The old 0xD000 (J1=J2=0) decodes to I1=I2=1 → a bogus built-in
2502                // addend of ~+0x600000, which produced the garbage `bl c0000c`
2503                // target and "relocation truncated to fit" at link time (#167).
2504                let hw1: u16 = 0xF000;
2505                let hw2: u16 = 0xF800;
2506                let mut bytes = hw1.to_le_bytes().to_vec();
2507                bytes.extend_from_slice(&hw2.to_le_bytes());
2508                Ok(bytes)
2509            }
2510
2511            // MVN
2512            ArmOp::Mvn { rd, op2 } => {
2513                if let Operand2::Reg(rm) = op2 {
2514                    let rd_bits = reg_to_bits(rd) as u16;
2515                    let rm_bits = reg_to_bits(rm) as u16;
2516
2517                    if rd_bits < 8 && rm_bits < 8 {
2518                        // MVNS Rd, Rm (16-bit): 0100 0011 11 Rm Rd
2519                        let instr: u16 = 0x43C0 | (rm_bits << 3) | rd_bits;
2520                        Ok(instr.to_le_bytes().to_vec())
2521                    } else {
2522                        // 32-bit MVN
2523                        let hw1: u16 = 0xEA6F_u16;
2524                        let hw2: u16 = ((reg_to_bits(rd) << 8) | reg_to_bits(rm)) as u16;
2525                        let mut bytes = hw1.to_le_bytes().to_vec();
2526                        bytes.extend_from_slice(&hw2.to_le_bytes());
2527                        Ok(bytes)
2528                    }
2529                } else {
2530                    let instr: u16 = 0xBF00;
2531                    Ok(instr.to_le_bytes().to_vec())
2532                }
2533            }
2534
2535            // MOVW - Move Wide (Thumb-2 32-bit)
2536            ArmOp::Movw { rd, imm16 } => {
2537                self.encode_thumb32_movw_raw(reg_to_bits(rd), *imm16 as u32)
2538            }
2539
2540            // MOVT - Move Top (Thumb-2 32-bit)
2541            ArmOp::Movt { rd, imm16 } => {
2542                self.encode_thumb32_movt_raw(reg_to_bits(rd), *imm16 as u32)
2543            }
2544
2545            // SetCond: Materialize condition flag into register (0 or 1)
2546            // Strategy: ITE <cond>; MOV Rd, #1; MOV Rd, #0
2547            // IMPORTANT: Must use ITE (If-Then-Else) because 16-bit Thumb MOV
2548            // always sets flags (MOVS). We need to evaluate the condition BEFORE
2549            // any MOV instruction clobbers the flags from CMP.
2550            ArmOp::SetCond { rd, cond } => {
2551                let rd_bits = reg_to_bits(rd) as u16;
2552
2553                // Condition code encoding for IT block
2554                use synth_synthesis::Condition;
2555                let cond_bits: u16 = match cond {
2556                    Condition::EQ => 0x0,
2557                    Condition::NE => 0x1,
2558                    Condition::LT => 0xB,
2559                    Condition::LE => 0xD,
2560                    Condition::GT => 0xC,
2561                    Condition::GE => 0xA,
2562                    Condition::LO => 0x3, // CC/LO (unsigned <)
2563                    Condition::LS => 0x9, // LS (unsigned <=)
2564                    Condition::HI => 0x8, // HI (unsigned >)
2565                    Condition::HS => 0x2, // CS/HS (unsigned >=)
2566                };
2567
2568                // ITE <cond>: encodes If-Then-Else block
2569                // The mask field depends on firstcond[0]:
2570                // - If firstcond[0] = 0: mask = 0xC for TE pattern (ITE EQ = BF0C)
2571                // - If firstcond[0] = 1: mask = 0x4 for TE pattern (ITE NE = BF14)
2572                let mask = if (cond_bits & 1) == 0 { 0xC } else { 0x4 };
2573                let ite_instr: u16 = 0xBF00 | (cond_bits << 4) | mask;
2574
2575                // MOV Rd, #1 (Then branch - condition true)
2576                let mov_one: u16 = 0x2001 | (rd_bits << 8);
2577
2578                // MOV Rd, #0 (Else branch - condition false)
2579                let mov_zero: u16 = 0x2000 | (rd_bits << 8);
2580
2581                // Emit: ITE, MOV #1 (Then), MOV #0 (Else)
2582                let mut bytes = ite_instr.to_le_bytes().to_vec();
2583                bytes.extend_from_slice(&mov_one.to_le_bytes());
2584                bytes.extend_from_slice(&mov_zero.to_le_bytes());
2585                Ok(bytes)
2586            }
2587
2588            // I64SetCond: Compare two i64 register pairs, result 0/1 in rd
2589            // EQ/NE: CMP lo,lo; IT EQ; CMPEQ hi,hi; ITE <cond>; MOV 1; MOV 0
2590            // LT: CMP lo,lo; SBCS rd,hi,hi; ITE LT; MOV 1; MOV 0
2591            // GT: CMP lo,lo (swapped); SBCS rd,hi,hi (swapped); ITE LT; MOV 1; MOV 0
2592            ArmOp::I64SetCond {
2593                rd,
2594                rn_lo,
2595                rn_hi,
2596                rm_lo,
2597                rm_hi,
2598                cond,
2599            } => {
2600                use synth_synthesis::Condition;
2601                let rd_bits = reg_to_bits(rd) as u16;
2602                let mut bytes = Vec::new();
2603
2604                // Helper: encode CMP Rn, Rm (16-bit)
2605                let encode_cmp_reg = |rn: &synth_synthesis::Reg,
2606                                      rm: &synth_synthesis::Reg|
2607                 -> Vec<u8> {
2608                    let rn_bits = reg_to_bits(rn) as u16;
2609                    let rm_bits = reg_to_bits(rm) as u16;
2610                    if rn_bits < 8 && rm_bits < 8 {
2611                        let instr: u16 = 0x4280 | (rm_bits << 3) | rn_bits;
2612                        instr.to_le_bytes().to_vec()
2613                    } else {
2614                        let n_bit = (rn_bits >> 3) & 1;
2615                        let instr: u16 = 0x4500 | (n_bit << 7) | (rm_bits << 3) | (rn_bits & 0x7);
2616                        instr.to_le_bytes().to_vec()
2617                    }
2618                };
2619
2620                // Helper: encode ITE <cond> (2 bytes)
2621                let encode_ite = |cond_bits: u16| -> Vec<u8> {
2622                    let mask = if (cond_bits & 1) == 0 { 0xC } else { 0x4 };
2623                    let ite_instr: u16 = 0xBF00 | (cond_bits << 4) | mask;
2624                    ite_instr.to_le_bytes().to_vec()
2625                };
2626
2627                // Helper: encode SetCond (ITE + MOV #1 + MOV #0) for given condition
2628                let encode_setcond = |cond_bits: u16, rd_bits: u16| -> Vec<u8> {
2629                    let mut b = encode_ite(cond_bits);
2630                    let mov_one: u16 = 0x2001 | (rd_bits << 8);
2631                    let mov_zero: u16 = 0x2000 | (rd_bits << 8);
2632                    b.extend_from_slice(&mov_one.to_le_bytes());
2633                    b.extend_from_slice(&mov_zero.to_le_bytes());
2634                    b
2635                };
2636
2637                match cond {
2638                    Condition::EQ | Condition::NE => {
2639                        // CMP rn_lo, rm_lo (compare low words)
2640                        bytes.extend_from_slice(&encode_cmp_reg(rn_lo, rm_lo));
2641
2642                        // IT EQ (execute next instruction only if Z=1)
2643                        let it_eq: u16 = 0xBF08; // IT EQ: cond=0000, mask=1000
2644                        bytes.extend_from_slice(&it_eq.to_le_bytes());
2645
2646                        // CMPEQ rn_hi, rm_hi (compare high words, only if low equal)
2647                        bytes.extend_from_slice(&encode_cmp_reg(rn_hi, rm_hi));
2648
2649                        // ITE <cond>; MOV rd, #1; MOV rd, #0
2650                        let cond_bits: u16 = match cond {
2651                            Condition::EQ => 0x0,
2652                            Condition::NE => 0x1,
2653                            _ => unreachable!(),
2654                        };
2655                        bytes.extend_from_slice(&encode_setcond(cond_bits, rd_bits));
2656                    }
2657
2658                    Condition::LT => {
2659                        // CMP rn_lo, rm_lo (sets C flag for borrow)
2660                        bytes.extend_from_slice(&encode_cmp_reg(rn_lo, rm_lo));
2661
2662                        // SBCS rd, rn_hi, rm_hi (subtract with carry, sets N,V flags)
2663                        // SBCS.W Rd, Rn, Rm: EB70 Rn | 0000 Rd 0000 Rm
2664                        let rn_hi_bits = reg_to_bits(rn_hi);
2665                        let rm_hi_bits = reg_to_bits(rm_hi);
2666                        let hw1: u16 = (0xEB70 | rn_hi_bits) as u16;
2667                        let hw2: u16 = ((rd_bits as u32) << 8 | rm_hi_bits) as u16;
2668                        bytes.extend_from_slice(&hw1.to_le_bytes());
2669                        bytes.extend_from_slice(&hw2.to_le_bytes());
2670
2671                        // ITE LT; MOV rd, #1; MOV rd, #0
2672                        bytes.extend_from_slice(&encode_setcond(0xB, rd_bits)); // LT = 0xB
2673                    }
2674
2675                    Condition::GT => {
2676                        // GT(a,b) = LT(b,a): swap operands
2677                        // CMP rm_lo, rn_lo (swapped)
2678                        bytes.extend_from_slice(&encode_cmp_reg(rm_lo, rn_lo));
2679
2680                        // SBCS rd, rm_hi, rn_hi (swapped)
2681                        let rm_hi_bits = reg_to_bits(rm_hi);
2682                        let rn_hi_bits = reg_to_bits(rn_hi);
2683                        let hw1: u16 = (0xEB70 | rm_hi_bits) as u16;
2684                        let hw2: u16 = ((rd_bits as u32) << 8 | rn_hi_bits) as u16;
2685                        bytes.extend_from_slice(&hw1.to_le_bytes());
2686                        bytes.extend_from_slice(&hw2.to_le_bytes());
2687
2688                        // ITE LT; MOV rd, #1; MOV rd, #0
2689                        bytes.extend_from_slice(&encode_setcond(0xB, rd_bits)); // LT = 0xB
2690                    }
2691
2692                    Condition::LE => {
2693                        // LE(a,b) = !GT(a,b): use GT logic but invert result
2694                        // GT(a,b) = LT(b,a): so we do CMP(b,a) and check LT, then invert
2695                        // CMP rm_lo, rn_lo (swapped, same as GT)
2696                        bytes.extend_from_slice(&encode_cmp_reg(rm_lo, rn_lo));
2697
2698                        // SBCS rd, rm_hi, rn_hi (swapped)
2699                        let rm_hi_bits = reg_to_bits(rm_hi);
2700                        let rn_hi_bits = reg_to_bits(rn_hi);
2701                        let hw1: u16 = (0xEB70 | rm_hi_bits) as u16;
2702                        let hw2: u16 = ((rd_bits as u32) << 8 | rn_hi_bits) as u16;
2703                        bytes.extend_from_slice(&hw1.to_le_bytes());
2704                        bytes.extend_from_slice(&hw2.to_le_bytes());
2705
2706                        // ITE GE; MOV rd, #1; MOV rd, #0 (GE is !LT, so inverting GT result)
2707                        bytes.extend_from_slice(&encode_setcond(0xA, rd_bits)); // GE = 0xA
2708                    }
2709
2710                    Condition::GE => {
2711                        // GE(a,b) = !LT(a,b): use LT logic but invert result
2712                        // CMP rn_lo, rm_lo (same as LT)
2713                        bytes.extend_from_slice(&encode_cmp_reg(rn_lo, rm_lo));
2714
2715                        // SBCS rd, rn_hi, rm_hi (same as LT)
2716                        let rn_hi_bits = reg_to_bits(rn_hi);
2717                        let rm_hi_bits = reg_to_bits(rm_hi);
2718                        let hw1: u16 = (0xEB70 | rn_hi_bits) as u16;
2719                        let hw2: u16 = ((rd_bits as u32) << 8 | rm_hi_bits) as u16;
2720                        bytes.extend_from_slice(&hw1.to_le_bytes());
2721                        bytes.extend_from_slice(&hw2.to_le_bytes());
2722
2723                        // ITE GE; MOV rd, #1; MOV rd, #0 (GE is !LT)
2724                        bytes.extend_from_slice(&encode_setcond(0xA, rd_bits)); // GE = 0xA
2725                    }
2726
2727                    // Unsigned comparisons - same instruction sequence, different conditions
2728                    Condition::LO => {
2729                        // LO (unsigned LT): CMP lo, SBCS hi, check C=0
2730                        bytes.extend_from_slice(&encode_cmp_reg(rn_lo, rm_lo));
2731                        let rn_hi_bits = reg_to_bits(rn_hi);
2732                        let rm_hi_bits = reg_to_bits(rm_hi);
2733                        let hw1: u16 = (0xEB70 | rn_hi_bits) as u16;
2734                        let hw2: u16 = ((rd_bits as u32) << 8 | rm_hi_bits) as u16;
2735                        bytes.extend_from_slice(&hw1.to_le_bytes());
2736                        bytes.extend_from_slice(&hw2.to_le_bytes());
2737                        bytes.extend_from_slice(&encode_setcond(0x3, rd_bits)); // LO = 0x3 (CC)
2738                    }
2739
2740                    Condition::HI => {
2741                        // HI (unsigned GT): swap operands and check LO
2742                        bytes.extend_from_slice(&encode_cmp_reg(rm_lo, rn_lo));
2743                        let rm_hi_bits = reg_to_bits(rm_hi);
2744                        let rn_hi_bits = reg_to_bits(rn_hi);
2745                        let hw1: u16 = (0xEB70 | rm_hi_bits) as u16;
2746                        let hw2: u16 = ((rd_bits as u32) << 8 | rn_hi_bits) as u16;
2747                        bytes.extend_from_slice(&hw1.to_le_bytes());
2748                        bytes.extend_from_slice(&hw2.to_le_bytes());
2749                        bytes.extend_from_slice(&encode_setcond(0x3, rd_bits)); // LO = 0x3 (CC)
2750                    }
2751
2752                    Condition::LS => {
2753                        // LS (unsigned LE): !(a > b) = !(HI), so do HI and invert
2754                        bytes.extend_from_slice(&encode_cmp_reg(rm_lo, rn_lo));
2755                        let rm_hi_bits = reg_to_bits(rm_hi);
2756                        let rn_hi_bits = reg_to_bits(rn_hi);
2757                        let hw1: u16 = (0xEB70 | rm_hi_bits) as u16;
2758                        let hw2: u16 = ((rd_bits as u32) << 8 | rn_hi_bits) as u16;
2759                        bytes.extend_from_slice(&hw1.to_le_bytes());
2760                        bytes.extend_from_slice(&hw2.to_le_bytes());
2761                        bytes.extend_from_slice(&encode_setcond(0x2, rd_bits)); // HS = 0x2 (CS) = !LO
2762                    }
2763
2764                    Condition::HS => {
2765                        // HS (unsigned GE): !(a < b) = !(LO)
2766                        bytes.extend_from_slice(&encode_cmp_reg(rn_lo, rm_lo));
2767                        let rn_hi_bits = reg_to_bits(rn_hi);
2768                        let rm_hi_bits = reg_to_bits(rm_hi);
2769                        let hw1: u16 = (0xEB70 | rn_hi_bits) as u16;
2770                        let hw2: u16 = ((rd_bits as u32) << 8 | rm_hi_bits) as u16;
2771                        bytes.extend_from_slice(&hw1.to_le_bytes());
2772                        bytes.extend_from_slice(&hw2.to_le_bytes());
2773                        bytes.extend_from_slice(&encode_setcond(0x2, rd_bits)); // HS = 0x2 (CS) = !LO
2774                    }
2775                }
2776
2777                Ok(bytes)
2778            }
2779
2780            // I64SetCondZ: Test if i64 register pair is zero, result 0/1 in rd
2781            // ORR.W rd, rn_lo, rn_hi; CMP rd, #0; ITE EQ; MOV 1; MOV 0
2782            ArmOp::I64SetCondZ { rd, rn_lo, rn_hi } => {
2783                let rd_bits = reg_to_bits(rd);
2784                let rn_lo_bits = reg_to_bits(rn_lo);
2785                let rn_hi_bits = reg_to_bits(rn_hi);
2786                let mut bytes = Vec::new();
2787
2788                // ORR.W rd, rn_lo, rn_hi: EA40 rn_lo | 0000 rd 0000 rn_hi
2789                let hw1: u16 = (0xEA40 | rn_lo_bits) as u16;
2790                let hw2: u16 = ((rd_bits << 8) | rn_hi_bits) as u16;
2791                bytes.extend_from_slice(&hw1.to_le_bytes());
2792                bytes.extend_from_slice(&hw2.to_le_bytes());
2793
2794                // CMP rd, #0 (16-bit): 0010 1 Rd 0000 0000
2795                let cmp_instr: u16 = 0x2800 | ((rd_bits as u16) << 8);
2796                bytes.extend_from_slice(&cmp_instr.to_le_bytes());
2797
2798                // ITE EQ; MOV rd, #1; MOV rd, #0
2799                let mask = 0xC_u16; // ITE EQ mask: firstcond[0]=0, mask=0xC
2800                let ite_instr: u16 = 0xBF00 | mask;
2801                bytes.extend_from_slice(&ite_instr.to_le_bytes());
2802                let mov_one: u16 = 0x2001 | ((rd_bits as u16) << 8);
2803                let mov_zero: u16 = 0x2000 | ((rd_bits as u16) << 8);
2804                bytes.extend_from_slice(&mov_one.to_le_bytes());
2805                bytes.extend_from_slice(&mov_zero.to_le_bytes());
2806
2807                Ok(bytes)
2808            }
2809
2810            // I64Mul: 64-bit multiply using UMULL + MLA cross products
2811            // Formula: result = (a_lo * b_lo) + ((a_lo * b_hi + a_hi * b_lo) << 32)
2812            // Uses R12 as scratch register
2813            ArmOp::I64Mul {
2814                rd_lo,
2815                rd_hi,
2816                rn_lo,
2817                rn_hi,
2818                rm_lo,
2819                rm_hi,
2820            } => {
2821                let rd_lo_bits = reg_to_bits(rd_lo);
2822                let rd_hi_bits = reg_to_bits(rd_hi);
2823                let rn_lo_bits = reg_to_bits(rn_lo);
2824                let rn_hi_bits = reg_to_bits(rn_hi);
2825                let rm_lo_bits = reg_to_bits(rm_lo);
2826                let rm_hi_bits = reg_to_bits(rm_hi);
2827                let r12: u32 = 12; // IP scratch register
2828                let mut bytes = Vec::new();
2829
2830                // 1. MUL R12, rn_lo, rm_hi  (R12 = a_lo * b_hi)
2831                // Thumb-2 MUL: hw1=0xFB00|Rn, hw2=0xF000|(Rd<<8)|Rm
2832                let hw1: u16 = (0xFB00 | rn_lo_bits) as u16;
2833                let hw2: u16 = (0xF000 | (r12 << 8) | rm_hi_bits) as u16;
2834                bytes.extend_from_slice(&hw1.to_le_bytes());
2835                bytes.extend_from_slice(&hw2.to_le_bytes());
2836
2837                // 2. MLA R12, rn_hi, rm_lo, R12  (R12 += a_hi * b_lo)
2838                // Thumb-2 MLA: hw1=0xFB00|Rn, hw2=(Ra<<12)|(Rd<<8)|Rm
2839                let hw1: u16 = (0xFB00 | rn_hi_bits) as u16;
2840                let hw2: u16 = ((r12 << 12) | (r12 << 8) | rm_lo_bits) as u16;
2841                bytes.extend_from_slice(&hw1.to_le_bytes());
2842                bytes.extend_from_slice(&hw2.to_le_bytes());
2843
2844                // 3. UMULL rd_lo, rd_hi, rn_lo, rm_lo  (rd_lo:rd_hi = a_lo * b_lo)
2845                // Thumb-2 UMULL: hw1=0xFBA0|Rn, hw2=(RdLo<<12)|(RdHi<<8)|Rm
2846                let hw1: u16 = (0xFBA0 | rn_lo_bits) as u16;
2847                let hw2: u16 = ((rd_lo_bits << 12) | (rd_hi_bits << 8) | rm_lo_bits) as u16;
2848                bytes.extend_from_slice(&hw1.to_le_bytes());
2849                bytes.extend_from_slice(&hw2.to_le_bytes());
2850
2851                // 4. ADD rd_hi, R12  (rd_hi += cross products)
2852                // 16-bit high reg ADD: 01000100 D Rm Rdn[2:0]
2853                let d_bit = (rd_hi_bits >> 3) & 1;
2854                let add_instr: u16 =
2855                    (0x4400 | (d_bit << 7) | (r12 << 3) | (rd_hi_bits & 0x7)) as u16;
2856                bytes.extend_from_slice(&add_instr.to_le_bytes());
2857
2858                Ok(bytes)
2859            }
2860
2861            // I64Shl: 64-bit shift left with branch for n<32 vs n>=32
2862            // rm_hi (R3) is used as temp register
2863            ArmOp::I64Shl {
2864                rd_lo,
2865                rd_hi,
2866                rn_lo,
2867                rn_hi,
2868                rm_lo,
2869                rm_hi,
2870            } => {
2871                let rd_lo_bits = reg_to_bits(rd_lo);
2872                let rd_hi_bits = reg_to_bits(rd_hi);
2873                let rn_lo_bits = reg_to_bits(rn_lo);
2874                let rn_hi_bits = reg_to_bits(rn_hi);
2875                let rm_lo_bits = reg_to_bits(rm_lo);
2876                let rm_hi_bits = reg_to_bits(rm_hi); // temp
2877                let mut bytes = Vec::new();
2878
2879                // AND.W rm_lo, rm_lo, #63  (mask shift amount to 6 bits)
2880                let hw1: u16 = (0xF000 | rm_lo_bits) as u16;
2881                let hw2: u16 = ((rm_lo_bits << 8) | 0x3F) as u16;
2882                bytes.extend_from_slice(&hw1.to_le_bytes());
2883                bytes.extend_from_slice(&hw2.to_le_bytes());
2884
2885                // SUBS.W rm_hi, rm_lo, #32  (rm_hi = n-32, sets flags)
2886                let hw1: u16 = (0xF1B0 | rm_lo_bits) as u16;
2887                let hw2: u16 = ((rm_hi_bits << 8) | 0x20) as u16;
2888                bytes.extend_from_slice(&hw1.to_le_bytes());
2889                bytes.extend_from_slice(&hw2.to_le_bytes());
2890
2891                // BPL .large (branch if n >= 32, offset = +10 halfwords)
2892                let bpl: u16 = 0xD50A;
2893                bytes.extend_from_slice(&bpl.to_le_bytes());
2894
2895                // --- Small shift (n < 32) ---
2896                // RSB.W rm_hi, rm_lo, #32  (rm_hi = 32-n)
2897                let hw1: u16 = (0xF1C0 | rm_lo_bits) as u16;
2898                let hw2: u16 = ((rm_hi_bits << 8) | 0x20) as u16;
2899                bytes.extend_from_slice(&hw1.to_le_bytes());
2900                bytes.extend_from_slice(&hw2.to_le_bytes());
2901
2902                // LSR.W rm_hi, rn_lo, rm_hi  (rm_hi = lo >> (32-n), overflow bits)
2903                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
2904                let hw2: u16 = (0xF000 | (rm_hi_bits << 8) | rm_hi_bits) as u16;
2905                bytes.extend_from_slice(&hw1.to_le_bytes());
2906                bytes.extend_from_slice(&hw2.to_le_bytes());
2907
2908                // LSL.W rd_hi, rn_hi, rm_lo  (hi <<= n)
2909                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
2910                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | rm_lo_bits) as u16;
2911                bytes.extend_from_slice(&hw1.to_le_bytes());
2912                bytes.extend_from_slice(&hw2.to_le_bytes());
2913
2914                // ORR.W rd_hi, rd_hi, rm_hi  (hi |= overflow bits from lo)
2915                let hw1: u16 = (0xEA40 | rd_hi_bits) as u16;
2916                let hw2: u16 = ((rd_hi_bits << 8) | rm_hi_bits) as u16;
2917                bytes.extend_from_slice(&hw1.to_le_bytes());
2918                bytes.extend_from_slice(&hw2.to_le_bytes());
2919
2920                // LSL.W rd_lo, rn_lo, rm_lo  (lo <<= n)
2921                let hw1: u16 = (0xFA00 | rn_lo_bits) as u16;
2922                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | rm_lo_bits) as u16;
2923                bytes.extend_from_slice(&hw1.to_le_bytes());
2924                bytes.extend_from_slice(&hw2.to_le_bytes());
2925
2926                // B .done (skip large shift: +2 halfwords)
2927                let b_done: u16 = 0xE002;
2928                bytes.extend_from_slice(&b_done.to_le_bytes());
2929
2930                // --- Large shift (n >= 32) ---
2931                // LSL.W rd_hi, rn_lo, rm_hi  (hi = lo << (n-32))
2932                let hw1: u16 = (0xFA00 | rn_lo_bits) as u16;
2933                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | rm_hi_bits) as u16;
2934                bytes.extend_from_slice(&hw1.to_le_bytes());
2935                bytes.extend_from_slice(&hw2.to_le_bytes());
2936
2937                // MOV rd_lo, #0
2938                let mov_zero: u16 = 0x2000 | ((rd_lo_bits as u16) << 8);
2939                bytes.extend_from_slice(&mov_zero.to_le_bytes());
2940
2941                Ok(bytes) // Total: 38 bytes
2942            }
2943
2944            // I64ShrU: 64-bit logical shift right with branch for n<32 vs n>=32
2945            ArmOp::I64ShrU {
2946                rd_lo,
2947                rd_hi,
2948                rn_lo,
2949                rn_hi,
2950                rm_lo,
2951                rm_hi,
2952            } => {
2953                let rd_lo_bits = reg_to_bits(rd_lo);
2954                let rd_hi_bits = reg_to_bits(rd_hi);
2955                let rn_lo_bits = reg_to_bits(rn_lo);
2956                let rn_hi_bits = reg_to_bits(rn_hi);
2957                let rm_lo_bits = reg_to_bits(rm_lo);
2958                let rm_hi_bits = reg_to_bits(rm_hi); // temp
2959                let mut bytes = Vec::new();
2960
2961                // AND.W rm_lo, rm_lo, #63
2962                let hw1: u16 = (0xF000 | rm_lo_bits) as u16;
2963                let hw2: u16 = ((rm_lo_bits << 8) | 0x3F) as u16;
2964                bytes.extend_from_slice(&hw1.to_le_bytes());
2965                bytes.extend_from_slice(&hw2.to_le_bytes());
2966
2967                // SUBS.W rm_hi, rm_lo, #32
2968                let hw1: u16 = (0xF1B0 | rm_lo_bits) as u16;
2969                let hw2: u16 = ((rm_hi_bits << 8) | 0x20) as u16;
2970                bytes.extend_from_slice(&hw1.to_le_bytes());
2971                bytes.extend_from_slice(&hw2.to_le_bytes());
2972
2973                // BPL .large (+10 halfwords)
2974                let bpl: u16 = 0xD50A;
2975                bytes.extend_from_slice(&bpl.to_le_bytes());
2976
2977                // --- Small shift (n < 32) ---
2978                // RSB.W rm_hi, rm_lo, #32  (rm_hi = 32-n)
2979                let hw1: u16 = (0xF1C0 | rm_lo_bits) as u16;
2980                let hw2: u16 = ((rm_hi_bits << 8) | 0x20) as u16;
2981                bytes.extend_from_slice(&hw1.to_le_bytes());
2982                bytes.extend_from_slice(&hw2.to_le_bytes());
2983
2984                // LSL.W rm_hi, rn_hi, rm_hi  (rm_hi = hi << (32-n), bits flowing to lo)
2985                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
2986                let hw2: u16 = (0xF000 | (rm_hi_bits << 8) | rm_hi_bits) as u16;
2987                bytes.extend_from_slice(&hw1.to_le_bytes());
2988                bytes.extend_from_slice(&hw2.to_le_bytes());
2989
2990                // LSR.W rd_lo, rn_lo, rm_lo  (lo >>= n)
2991                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
2992                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | rm_lo_bits) as u16;
2993                bytes.extend_from_slice(&hw1.to_le_bytes());
2994                bytes.extend_from_slice(&hw2.to_le_bytes());
2995
2996                // ORR.W rd_lo, rd_lo, rm_hi  (lo |= overflow from hi)
2997                let hw1: u16 = (0xEA40 | rd_lo_bits) as u16;
2998                let hw2: u16 = ((rd_lo_bits << 8) | rm_hi_bits) as u16;
2999                bytes.extend_from_slice(&hw1.to_le_bytes());
3000                bytes.extend_from_slice(&hw2.to_le_bytes());
3001
3002                // LSR.W rd_hi, rn_hi, rm_lo  (hi >>= n, logical)
3003                let hw1: u16 = (0xFA20 | rn_hi_bits) as u16;
3004                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | rm_lo_bits) as u16;
3005                bytes.extend_from_slice(&hw1.to_le_bytes());
3006                bytes.extend_from_slice(&hw2.to_le_bytes());
3007
3008                // B .done (+2 halfwords)
3009                let b_done: u16 = 0xE002;
3010                bytes.extend_from_slice(&b_done.to_le_bytes());
3011
3012                // --- Large shift (n >= 32) ---
3013                // LSR.W rd_lo, rn_hi, rm_hi  (lo = hi >> (n-32))
3014                let hw1: u16 = (0xFA20 | rn_hi_bits) as u16;
3015                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | rm_hi_bits) as u16;
3016                bytes.extend_from_slice(&hw1.to_le_bytes());
3017                bytes.extend_from_slice(&hw2.to_le_bytes());
3018
3019                // MOV rd_hi, #0
3020                let mov_zero: u16 = 0x2000 | ((rd_hi_bits as u16) << 8);
3021                bytes.extend_from_slice(&mov_zero.to_le_bytes());
3022
3023                Ok(bytes) // Total: 38 bytes
3024            }
3025
3026            // I64ShrS: 64-bit arithmetic shift right with branch for n<32 vs n>=32
3027            ArmOp::I64ShrS {
3028                rd_lo,
3029                rd_hi,
3030                rn_lo,
3031                rn_hi,
3032                rm_lo,
3033                rm_hi,
3034            } => {
3035                let rd_lo_bits = reg_to_bits(rd_lo);
3036                let rd_hi_bits = reg_to_bits(rd_hi);
3037                let rn_lo_bits = reg_to_bits(rn_lo);
3038                let rn_hi_bits = reg_to_bits(rn_hi);
3039                let rm_lo_bits = reg_to_bits(rm_lo);
3040                let rm_hi_bits = reg_to_bits(rm_hi); // temp
3041                let mut bytes = Vec::new();
3042
3043                // AND.W rm_lo, rm_lo, #63
3044                let hw1: u16 = (0xF000 | rm_lo_bits) as u16;
3045                let hw2: u16 = ((rm_lo_bits << 8) | 0x3F) as u16;
3046                bytes.extend_from_slice(&hw1.to_le_bytes());
3047                bytes.extend_from_slice(&hw2.to_le_bytes());
3048
3049                // SUBS.W rm_hi, rm_lo, #32
3050                let hw1: u16 = (0xF1B0 | rm_lo_bits) as u16;
3051                let hw2: u16 = ((rm_hi_bits << 8) | 0x20) as u16;
3052                bytes.extend_from_slice(&hw1.to_le_bytes());
3053                bytes.extend_from_slice(&hw2.to_le_bytes());
3054
3055                // BPL .large (+10 halfwords)
3056                let bpl: u16 = 0xD50A;
3057                bytes.extend_from_slice(&bpl.to_le_bytes());
3058
3059                // --- Small shift (n < 32) ---
3060                // RSB.W rm_hi, rm_lo, #32
3061                let hw1: u16 = (0xF1C0 | rm_lo_bits) as u16;
3062                let hw2: u16 = ((rm_hi_bits << 8) | 0x20) as u16;
3063                bytes.extend_from_slice(&hw1.to_le_bytes());
3064                bytes.extend_from_slice(&hw2.to_le_bytes());
3065
3066                // LSL.W rm_hi, rn_hi, rm_hi  (rm_hi = hi << (32-n), bits flowing to lo)
3067                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
3068                let hw2: u16 = (0xF000 | (rm_hi_bits << 8) | rm_hi_bits) as u16;
3069                bytes.extend_from_slice(&hw1.to_le_bytes());
3070                bytes.extend_from_slice(&hw2.to_le_bytes());
3071
3072                // LSR.W rd_lo, rn_lo, rm_lo  (lo >>= n, logical for lo word)
3073                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
3074                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | rm_lo_bits) as u16;
3075                bytes.extend_from_slice(&hw1.to_le_bytes());
3076                bytes.extend_from_slice(&hw2.to_le_bytes());
3077
3078                // ORR.W rd_lo, rd_lo, rm_hi  (lo |= overflow from hi)
3079                let hw1: u16 = (0xEA40 | rd_lo_bits) as u16;
3080                let hw2: u16 = ((rd_lo_bits << 8) | rm_hi_bits) as u16;
3081                bytes.extend_from_slice(&hw1.to_le_bytes());
3082                bytes.extend_from_slice(&hw2.to_le_bytes());
3083
3084                // ASR.W rd_hi, rn_hi, rm_lo  (hi >>= n, arithmetic/sign-extending)
3085                let hw1: u16 = (0xFA40 | rn_hi_bits) as u16;
3086                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | rm_lo_bits) as u16;
3087                bytes.extend_from_slice(&hw1.to_le_bytes());
3088                bytes.extend_from_slice(&hw2.to_le_bytes());
3089
3090                // B .done (+3 halfwords, large shift is 8 bytes)
3091                let b_done: u16 = 0xE003;
3092                bytes.extend_from_slice(&b_done.to_le_bytes());
3093
3094                // --- Large shift (n >= 32) ---
3095                // ASR.W rd_lo, rn_hi, rm_hi  (lo = hi >>> (n-32))
3096                let hw1: u16 = (0xFA40 | rn_hi_bits) as u16;
3097                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | rm_hi_bits) as u16;
3098                bytes.extend_from_slice(&hw1.to_le_bytes());
3099                bytes.extend_from_slice(&hw2.to_le_bytes());
3100
3101                // ASR.W rd_hi, rn_hi, #31  (hi = sign extension, all 0s or all 1s)
3102                // Thumb-2 ASR immediate: hw1=0xEA4F, hw2=imm3:Rd:imm2:10:Rm
3103                // imm5=31=11111 → imm3=111, imm2=11
3104                let hw1: u16 = 0xEA4F;
3105                let hw2: u16 = (0x7000 | (rd_hi_bits << 8) | 0x00E0 | rn_hi_bits) as u16;
3106                bytes.extend_from_slice(&hw1.to_le_bytes());
3107                bytes.extend_from_slice(&hw2.to_le_bytes());
3108
3109                Ok(bytes) // Total: 40 bytes
3110            }
3111
3112            // I64Rotl: 64-bit rotate left
3113            // For n < 32: new_hi = (hi << n) | (lo >> (32-n)), new_lo = (lo << n) | (hi >> (32-n))
3114            // For n >= 32: same formula but with lo/hi conceptually swapped, shift by (n-32)
3115            // Uses R4 (saved/restored) and R12 as scratch
3116            ArmOp::I64Rotl {
3117                rdlo,
3118                rdhi,
3119                rnlo,
3120                rnhi,
3121                shift,
3122            } => {
3123                let rd_lo_bits = reg_to_bits(rdlo);
3124                let rd_hi_bits = reg_to_bits(rdhi);
3125                let rn_lo_bits = reg_to_bits(rnlo);
3126                let rn_hi_bits = reg_to_bits(rnhi);
3127                let shift_bits = reg_to_bits(shift);
3128                let r12: u32 = 12; // IP scratch
3129                let r3: u32 = 3; // Scratch (high word of shift amount, unused)
3130                let r4: u32 = 4; // Scratch (saved/restored)
3131                let mut bytes = Vec::new();
3132
3133                // PUSH {R4}
3134                bytes.extend_from_slice(&0xB410u16.to_le_bytes());
3135
3136                // AND.W shift, shift, #63 (mask to 6 bits)
3137                let hw1: u16 = (0xF000 | shift_bits) as u16;
3138                let hw2: u16 = ((shift_bits << 8) | 0x3F) as u16;
3139                bytes.extend_from_slice(&hw1.to_le_bytes());
3140                bytes.extend_from_slice(&hw2.to_le_bytes());
3141
3142                // SUBS.W R3, shift, #32 (R3 = n-32, sets flags)
3143                let hw1: u16 = (0xF1B0 | shift_bits) as u16;
3144                let hw2: u16 = ((r3 << 8) | 0x20) as u16;
3145                bytes.extend_from_slice(&hw1.to_le_bytes());
3146                bytes.extend_from_slice(&hw2.to_le_bytes());
3147
3148                // BPL .large (branch if n >= 32, offset = +14 halfwords)
3149                let bpl: u16 = 0xD50E;
3150                bytes.extend_from_slice(&bpl.to_le_bytes());
3151
3152                // === Small rotation (n < 32) ===
3153                // RSB.W R3, shift, #32 (R3 = 32-n)
3154                let hw1: u16 = (0xF1C0 | shift_bits) as u16;
3155                let hw2: u16 = ((r3 << 8) | 0x20) as u16;
3156                bytes.extend_from_slice(&hw1.to_le_bytes());
3157                bytes.extend_from_slice(&hw2.to_le_bytes());
3158
3159                // LSR.W R4, rn_lo, R3 (R4 = lo >> (32-n), will go to new_hi)
3160                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
3161                let hw2: u16 = (0xF000 | (r4 << 8) | r3) as u16;
3162                bytes.extend_from_slice(&hw1.to_le_bytes());
3163                bytes.extend_from_slice(&hw2.to_le_bytes());
3164
3165                // LSR.W R12, rn_hi, R3 (R12 = hi >> (32-n), will go to new_lo)
3166                let hw1: u16 = (0xFA20 | rn_hi_bits) as u16;
3167                let hw2: u16 = (0xF000 | (r12 << 8) | r3) as u16;
3168                bytes.extend_from_slice(&hw1.to_le_bytes());
3169                bytes.extend_from_slice(&hw2.to_le_bytes());
3170
3171                // LSL.W rd_hi, rn_hi, shift (rd_hi = hi << n)
3172                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
3173                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | shift_bits) as u16;
3174                bytes.extend_from_slice(&hw1.to_le_bytes());
3175                bytes.extend_from_slice(&hw2.to_le_bytes());
3176
3177                // ORR.W rd_hi, rd_hi, R4 (rd_hi = (hi << n) | (lo >> (32-n)))
3178                let hw1: u16 = (0xEA40 | rd_hi_bits) as u16;
3179                let hw2: u16 = ((rd_hi_bits << 8) | r4) as u16;
3180                bytes.extend_from_slice(&hw1.to_le_bytes());
3181                bytes.extend_from_slice(&hw2.to_le_bytes());
3182
3183                // LSL.W rd_lo, rn_lo, shift (rd_lo = lo << n)
3184                let hw1: u16 = (0xFA00 | rn_lo_bits) as u16;
3185                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | shift_bits) as u16;
3186                bytes.extend_from_slice(&hw1.to_le_bytes());
3187                bytes.extend_from_slice(&hw2.to_le_bytes());
3188
3189                // ORR.W rd_lo, rd_lo, R12 (rd_lo = (lo << n) | (hi >> (32-n)))
3190                let hw1: u16 = (0xEA40 | rd_lo_bits) as u16;
3191                let hw2: u16 = ((rd_lo_bits << 8) | r12) as u16;
3192                bytes.extend_from_slice(&hw1.to_le_bytes());
3193                bytes.extend_from_slice(&hw2.to_le_bytes());
3194
3195                // B .done (skip large block, offset = +14 halfwords)
3196                let b_done: u16 = 0xE00E;
3197                bytes.extend_from_slice(&b_done.to_le_bytes());
3198
3199                // === Large rotation (n >= 32) ===
3200                // R3 already has n-32 from the SUBS
3201                // RSB.W R4, R3, #32 (R4 = 32-(n-32) = 64-n)
3202                let hw1: u16 = (0xF1C0 | r3) as u16;
3203                let hw2: u16 = ((r4 << 8) | 0x20) as u16;
3204                bytes.extend_from_slice(&hw1.to_le_bytes());
3205                bytes.extend_from_slice(&hw2.to_le_bytes());
3206
3207                // LSR.W R12, rn_hi, R4 (R12 = hi >> (64-n), goes to new_hi low bits)
3208                let hw1: u16 = (0xFA20 | rn_hi_bits) as u16;
3209                let hw2: u16 = (0xF000 | (r12 << 8) | r4) as u16;
3210                bytes.extend_from_slice(&hw1.to_le_bytes());
3211                bytes.extend_from_slice(&hw2.to_le_bytes());
3212
3213                // LSR.W R4, rn_lo, R4 (R4 = lo >> (64-n), goes to new_lo low bits)
3214                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
3215                let hw2: u16 = (0xF000 | (r4 << 8) | r4) as u16;
3216                bytes.extend_from_slice(&hw1.to_le_bytes());
3217                bytes.extend_from_slice(&hw2.to_le_bytes());
3218
3219                // LSL.W shift, rn_lo, R3 (shift = lo << (n-32), new_hi high bits)
3220                let hw1: u16 = (0xFA00 | rn_lo_bits) as u16;
3221                let hw2: u16 = (0xF000 | (shift_bits << 8) | r3) as u16;
3222                bytes.extend_from_slice(&hw1.to_le_bytes());
3223                bytes.extend_from_slice(&hw2.to_le_bytes());
3224
3225                // ORR.W shift, shift, R12 (shift = (lo << (n-32)) | (hi >> (64-n)) = new_hi)
3226                let hw1: u16 = (0xEA40 | shift_bits) as u16;
3227                let hw2: u16 = ((shift_bits << 8) | r12) as u16;
3228                bytes.extend_from_slice(&hw1.to_le_bytes());
3229                bytes.extend_from_slice(&hw2.to_le_bytes());
3230
3231                // LSL.W rd_lo, rn_hi, R3 (rd_lo = hi << (n-32), new_lo high bits)
3232                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
3233                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | r3) as u16;
3234                bytes.extend_from_slice(&hw1.to_le_bytes());
3235                bytes.extend_from_slice(&hw2.to_le_bytes());
3236
3237                // ORR.W rd_lo, rd_lo, R4 (rd_lo = (hi << (n-32)) | (lo >> (64-n)) = new_lo)
3238                let hw1: u16 = (0xEA40 | rd_lo_bits) as u16;
3239                let hw2: u16 = ((rd_lo_bits << 8) | r4) as u16;
3240                bytes.extend_from_slice(&hw1.to_le_bytes());
3241                bytes.extend_from_slice(&hw2.to_le_bytes());
3242
3243                // MOV rd_hi, shift (rd_hi = new_hi)
3244                let d_bit = (rd_hi_bits >> 3) & 1;
3245                let mov_instr: u16 =
3246                    (0x4600 | (d_bit << 7) | (shift_bits << 3) | (rd_hi_bits & 0x7)) as u16;
3247                bytes.extend_from_slice(&mov_instr.to_le_bytes());
3248
3249                // POP {R4}
3250                bytes.extend_from_slice(&0xBC10u16.to_le_bytes());
3251
3252                Ok(bytes) // Total: 74 bytes
3253            }
3254
3255            // I64Rotr: 64-bit rotate right
3256            // rotr(x, n) = rotl(x, 64-n)
3257            // For n < 32: new_lo = (lo >> n) | (hi << (32-n)), new_hi = (hi >> n) | (lo << (32-n))
3258            // For n >= 32: same formula but with lo/hi swapped, shift by (n-32)
3259            ArmOp::I64Rotr {
3260                rdlo,
3261                rdhi,
3262                rnlo,
3263                rnhi,
3264                shift,
3265            } => {
3266                let rd_lo_bits = reg_to_bits(rdlo);
3267                let rd_hi_bits = reg_to_bits(rdhi);
3268                let rn_lo_bits = reg_to_bits(rnlo);
3269                let rn_hi_bits = reg_to_bits(rnhi);
3270                let shift_bits = reg_to_bits(shift);
3271                let r12: u32 = 12;
3272                let r3: u32 = 3;
3273                let r4: u32 = 4;
3274                let mut bytes = Vec::new();
3275
3276                // PUSH {R4}
3277                bytes.extend_from_slice(&0xB410u16.to_le_bytes());
3278
3279                // AND.W shift, shift, #63
3280                let hw1: u16 = (0xF000 | shift_bits) as u16;
3281                let hw2: u16 = ((shift_bits << 8) | 0x3F) as u16;
3282                bytes.extend_from_slice(&hw1.to_le_bytes());
3283                bytes.extend_from_slice(&hw2.to_le_bytes());
3284
3285                // SUBS.W R3, shift, #32
3286                let hw1: u16 = (0xF1B0 | shift_bits) as u16;
3287                let hw2: u16 = ((r3 << 8) | 0x20) as u16;
3288                bytes.extend_from_slice(&hw1.to_le_bytes());
3289                bytes.extend_from_slice(&hw2.to_le_bytes());
3290
3291                // BPL .large (+14 halfwords)
3292                let bpl: u16 = 0xD50E;
3293                bytes.extend_from_slice(&bpl.to_le_bytes());
3294
3295                // === Small rotation (n < 32) ===
3296                // RSB.W R3, shift, #32 (R3 = 32-n)
3297                let hw1: u16 = (0xF1C0 | shift_bits) as u16;
3298                let hw2: u16 = ((r3 << 8) | 0x20) as u16;
3299                bytes.extend_from_slice(&hw1.to_le_bytes());
3300                bytes.extend_from_slice(&hw2.to_le_bytes());
3301
3302                // LSL.W R4, rn_hi, R3 (R4 = hi << (32-n), will go to new_lo)
3303                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
3304                let hw2: u16 = (0xF000 | (r4 << 8) | r3) as u16;
3305                bytes.extend_from_slice(&hw1.to_le_bytes());
3306                bytes.extend_from_slice(&hw2.to_le_bytes());
3307
3308                // LSL.W R12, rn_lo, R3 (R12 = lo << (32-n), will go to new_hi)
3309                let hw1: u16 = (0xFA00 | rn_lo_bits) as u16;
3310                let hw2: u16 = (0xF000 | (r12 << 8) | r3) as u16;
3311                bytes.extend_from_slice(&hw1.to_le_bytes());
3312                bytes.extend_from_slice(&hw2.to_le_bytes());
3313
3314                // LSR.W rd_lo, rn_lo, shift (rd_lo = lo >> n)
3315                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
3316                let hw2: u16 = (0xF000 | (rd_lo_bits << 8) | shift_bits) as u16;
3317                bytes.extend_from_slice(&hw1.to_le_bytes());
3318                bytes.extend_from_slice(&hw2.to_le_bytes());
3319
3320                // ORR.W rd_lo, rd_lo, R4 (rd_lo = (lo >> n) | (hi << (32-n)))
3321                let hw1: u16 = (0xEA40 | rd_lo_bits) as u16;
3322                let hw2: u16 = ((rd_lo_bits << 8) | r4) as u16;
3323                bytes.extend_from_slice(&hw1.to_le_bytes());
3324                bytes.extend_from_slice(&hw2.to_le_bytes());
3325
3326                // LSR.W rd_hi, rn_hi, shift (rd_hi = hi >> n)
3327                let hw1: u16 = (0xFA20 | rn_hi_bits) as u16;
3328                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | shift_bits) as u16;
3329                bytes.extend_from_slice(&hw1.to_le_bytes());
3330                bytes.extend_from_slice(&hw2.to_le_bytes());
3331
3332                // ORR.W rd_hi, rd_hi, R12 (rd_hi = (hi >> n) | (lo << (32-n)))
3333                let hw1: u16 = (0xEA40 | rd_hi_bits) as u16;
3334                let hw2: u16 = ((rd_hi_bits << 8) | r12) as u16;
3335                bytes.extend_from_slice(&hw1.to_le_bytes());
3336                bytes.extend_from_slice(&hw2.to_le_bytes());
3337
3338                // B .done (+14 halfwords)
3339                let b_done: u16 = 0xE00E;
3340                bytes.extend_from_slice(&b_done.to_le_bytes());
3341
3342                // === Large rotation (n >= 32) ===
3343                // RSB.W R4, R3, #32 (R4 = 64-n)
3344                let hw1: u16 = (0xF1C0 | r3) as u16;
3345                let hw2: u16 = ((r4 << 8) | 0x20) as u16;
3346                bytes.extend_from_slice(&hw1.to_le_bytes());
3347                bytes.extend_from_slice(&hw2.to_le_bytes());
3348
3349                // LSL.W R12, rn_lo, R4 (R12 = lo << (64-n), goes to new_lo low bits)
3350                let hw1: u16 = (0xFA00 | rn_lo_bits) as u16;
3351                let hw2: u16 = (0xF000 | (r12 << 8) | r4) as u16;
3352                bytes.extend_from_slice(&hw1.to_le_bytes());
3353                bytes.extend_from_slice(&hw2.to_le_bytes());
3354
3355                // LSL.W R4, rn_hi, R4 (R4 = hi << (64-n), goes to new_hi low bits)
3356                let hw1: u16 = (0xFA00 | rn_hi_bits) as u16;
3357                let hw2: u16 = (0xF000 | (r4 << 8) | r4) as u16;
3358                bytes.extend_from_slice(&hw1.to_le_bytes());
3359                bytes.extend_from_slice(&hw2.to_le_bytes());
3360
3361                // LSR.W shift, rn_hi, R3 (shift = hi >> (n-32), new_lo high bits)
3362                let hw1: u16 = (0xFA20 | rn_hi_bits) as u16;
3363                let hw2: u16 = (0xF000 | (shift_bits << 8) | r3) as u16;
3364                bytes.extend_from_slice(&hw1.to_le_bytes());
3365                bytes.extend_from_slice(&hw2.to_le_bytes());
3366
3367                // ORR.W shift, shift, R12 (shift = (hi >> (n-32)) | (lo << (64-n)) = new_lo)
3368                let hw1: u16 = (0xEA40 | shift_bits) as u16;
3369                let hw2: u16 = ((shift_bits << 8) | r12) as u16;
3370                bytes.extend_from_slice(&hw1.to_le_bytes());
3371                bytes.extend_from_slice(&hw2.to_le_bytes());
3372
3373                // LSR.W rd_hi, rn_lo, R3 (rd_hi = lo >> (n-32), new_hi high bits)
3374                let hw1: u16 = (0xFA20 | rn_lo_bits) as u16;
3375                let hw2: u16 = (0xF000 | (rd_hi_bits << 8) | r3) as u16;
3376                bytes.extend_from_slice(&hw1.to_le_bytes());
3377                bytes.extend_from_slice(&hw2.to_le_bytes());
3378
3379                // ORR.W rd_hi, rd_hi, R4 (rd_hi = (lo >> (n-32)) | (hi << (64-n)) = new_hi)
3380                let hw1: u16 = (0xEA40 | rd_hi_bits) as u16;
3381                let hw2: u16 = ((rd_hi_bits << 8) | r4) as u16;
3382                bytes.extend_from_slice(&hw1.to_le_bytes());
3383                bytes.extend_from_slice(&hw2.to_le_bytes());
3384
3385                // MOV rd_lo, shift (rd_lo = new_lo)
3386                let d_bit = (rd_lo_bits >> 3) & 1;
3387                let mov_instr: u16 =
3388                    (0x4600 | (d_bit << 7) | (shift_bits << 3) | (rd_lo_bits & 0x7)) as u16;
3389                bytes.extend_from_slice(&mov_instr.to_le_bytes());
3390
3391                // POP {R4}
3392                bytes.extend_from_slice(&0xBC10u16.to_le_bytes());
3393
3394                Ok(bytes) // Total: 74 bytes
3395            }
3396
3397            // I64Clz: Count leading zeros in 64-bit value
3398            // If hi != 0: result = CLZ(hi)
3399            // If hi == 0: result = 32 + CLZ(lo)
3400            //
3401            // Layout (using CMP+BNE approach for consistency):
3402            // 0: CMP.W rnhi, #0 (4 bytes)
3403            // 4: BEQ .hi_zero (2 bytes) - branch forward to offset 14
3404            // 6: CLZ.W rd, rnhi (4 bytes)
3405            // 10: B .done (2 bytes) - branch forward to offset 22
3406            // 12: NOP (2 bytes) - padding for alignment
3407            // 14: .hi_zero: CLZ.W rd, rnlo (4 bytes)
3408            // 18: ADD.W rd, rd, #32 (4 bytes)
3409            // 22: .done
3410            ArmOp::I64Clz { rd, rnlo, rnhi } => {
3411                let rd_bits = reg_to_bits(rd);
3412                let rn_lo_bits = reg_to_bits(rnlo);
3413                let rn_hi_bits = reg_to_bits(rnhi);
3414                let mut bytes = Vec::new();
3415
3416                // CMP.W rnhi, #0 (4 bytes at offset 0)
3417                let hw1: u16 = (0xF1B0 | rn_hi_bits) as u16;
3418                let hw2: u16 = 0x0F00;
3419                bytes.extend_from_slice(&hw1.to_le_bytes());
3420                bytes.extend_from_slice(&hw2.to_le_bytes());
3421
3422                // BEQ .hi_zero (2 bytes at offset 4)
3423                // PC = 4 + 4 = 8, target = 14, offset = 6, imm8 = 3
3424                let beq: u16 = 0xD003;
3425                bytes.extend_from_slice(&beq.to_le_bytes());
3426
3427                // CLZ.W rd, rnhi (4 bytes at offset 6)
3428                // CLZ T1: hw1 = 0xFAB<Rm>, hw2 = 0xF<Rd>8<Rm>
3429                let hw1: u16 = (0xFAB0 | rn_hi_bits) as u16;
3430                let hw2: u16 = (0xF080 | (rd_bits << 8) | rn_hi_bits) as u16;
3431                bytes.extend_from_slice(&hw1.to_le_bytes());
3432                bytes.extend_from_slice(&hw2.to_le_bytes());
3433
3434                // B .done (2 bytes at offset 10)
3435                // PC = 10 + 4 = 14, target = 22, offset = 8, imm11 = 4
3436                let b_done: u16 = 0xE004;
3437                bytes.extend_from_slice(&b_done.to_le_bytes());
3438
3439                // NOP (2 bytes at offset 12) - padding
3440                bytes.extend_from_slice(&0xBF00u16.to_le_bytes());
3441
3442                // .hi_zero: (offset 14)
3443                // CLZ.W rd, rnlo (4 bytes)
3444                // CLZ T1: hw1 = 0xFAB<Rm>, hw2 = 0xF<Rd>8<Rm>
3445                let hw1: u16 = (0xFAB0 | rn_lo_bits) as u16;
3446                let hw2: u16 = (0xF080 | (rd_bits << 8) | rn_lo_bits) as u16;
3447                bytes.extend_from_slice(&hw1.to_le_bytes());
3448                bytes.extend_from_slice(&hw2.to_le_bytes());
3449
3450                // ADD.W rd, rd, #32 (4 bytes at offset 18)
3451                let hw1: u16 = (0xF100 | rd_bits) as u16;
3452                let hw2: u16 = ((rd_bits << 8) | 0x20) as u16;
3453                bytes.extend_from_slice(&hw1.to_le_bytes());
3454                bytes.extend_from_slice(&hw2.to_le_bytes());
3455
3456                // .done: (offset 22)
3457                // i64.clz returns i64, so clear high word: MOV rnhi, #0 (2 bytes)
3458                // MOVS Rn, #0: 0010 0 Rn 00000000
3459                let mov0: u16 = (0x2000 | (rn_hi_bits << 8)) as u16;
3460                bytes.extend_from_slice(&mov0.to_le_bytes());
3461
3462                Ok(bytes)
3463            }
3464
3465            // I64Ctz: Count trailing zeros in 64-bit value
3466            // If lo != 0: result = CTZ(lo) = CLZ(RBIT(lo))
3467            // If lo == 0: result = 32 + CTZ(hi) = 32 + CLZ(RBIT(hi))
3468            //
3469            // Layout:
3470            // 0: CMP.W rnlo, #0 (4 bytes)
3471            // 4: BEQ .lo_zero (2 bytes) - branch to offset 18
3472            // 6: RBIT.W rd, rnlo (4 bytes)
3473            // 10: CLZ.W rd, rd (4 bytes)
3474            // 14: B .done (2 bytes) - branch to offset 30
3475            // 16: NOP (2 bytes) - padding
3476            // 18: .lo_zero: RBIT.W rd, rnhi (4 bytes)
3477            // 22: CLZ.W rd, rd (4 bytes)
3478            // 26: ADD.W rd, rd, #32 (4 bytes)
3479            // 30: .done
3480            ArmOp::I64Ctz { rd, rnlo, rnhi } => {
3481                let rd_bits = reg_to_bits(rd);
3482                let rn_lo_bits = reg_to_bits(rnlo);
3483                let rn_hi_bits = reg_to_bits(rnhi);
3484                let mut bytes = Vec::new();
3485
3486                // CMP.W rnlo, #0 (4 bytes at offset 0)
3487                let hw1: u16 = (0xF1B0 | rn_lo_bits) as u16;
3488                let hw2: u16 = 0x0F00;
3489                bytes.extend_from_slice(&hw1.to_le_bytes());
3490                bytes.extend_from_slice(&hw2.to_le_bytes());
3491
3492                // BEQ .lo_zero (2 bytes at offset 4)
3493                // PC = 4 + 4 = 8, target = 18, offset = 10, imm8 = 5
3494                let beq: u16 = 0xD005;
3495                bytes.extend_from_slice(&beq.to_le_bytes());
3496
3497                // RBIT.W rd, rnlo (4 bytes at offset 6)
3498                // RBIT T1: hw1 = 0xFA9<Rm>, hw2 = 0xF<Rd>A<Rm>
3499                let hw1: u16 = (0xFA90 | rn_lo_bits) as u16;
3500                let hw2: u16 = (0xF0A0 | (rd_bits << 8) | rn_lo_bits) as u16;
3501                bytes.extend_from_slice(&hw1.to_le_bytes());
3502                bytes.extend_from_slice(&hw2.to_le_bytes());
3503
3504                // CLZ.W rd, rd (4 bytes at offset 10)
3505                // CLZ T1: hw1 = 0xFAB<Rm>, hw2 = 0xF<Rd>8<Rm>
3506                let hw1: u16 = (0xFAB0 | rd_bits) as u16;
3507                let hw2: u16 = (0xF080 | (rd_bits << 8) | rd_bits) as u16;
3508                bytes.extend_from_slice(&hw1.to_le_bytes());
3509                bytes.extend_from_slice(&hw2.to_le_bytes());
3510
3511                // B .done (2 bytes at offset 14)
3512                // PC = 14 + 4 = 18, target = 30, offset = 12, imm11 = 6
3513                let b_done: u16 = 0xE006;
3514                bytes.extend_from_slice(&b_done.to_le_bytes());
3515
3516                // NOP (2 bytes at offset 16) - padding
3517                bytes.extend_from_slice(&0xBF00u16.to_le_bytes());
3518
3519                // .lo_zero: (offset 18)
3520                // RBIT.W rd, rnhi (4 bytes)
3521                // RBIT T1: hw1 = 0xFA9<Rm>, hw2 = 0xF<Rd>A<Rm>
3522                let hw1: u16 = (0xFA90 | rn_hi_bits) as u16;
3523                let hw2: u16 = (0xF0A0 | (rd_bits << 8) | rn_hi_bits) as u16;
3524                bytes.extend_from_slice(&hw1.to_le_bytes());
3525                bytes.extend_from_slice(&hw2.to_le_bytes());
3526
3527                // CLZ.W rd, rd (4 bytes at offset 22)
3528                // CLZ T1: hw1 = 0xFAB<Rm>, hw2 = 0xF<Rd>8<Rm>
3529                let hw1: u16 = (0xFAB0 | rd_bits) as u16;
3530                let hw2: u16 = (0xF080 | (rd_bits << 8) | rd_bits) as u16;
3531                bytes.extend_from_slice(&hw1.to_le_bytes());
3532                bytes.extend_from_slice(&hw2.to_le_bytes());
3533
3534                // ADD.W rd, rd, #32 (4 bytes at offset 26)
3535                let hw1: u16 = (0xF100 | rd_bits) as u16;
3536                let hw2: u16 = ((rd_bits << 8) | 0x20) as u16;
3537                bytes.extend_from_slice(&hw1.to_le_bytes());
3538                bytes.extend_from_slice(&hw2.to_le_bytes());
3539
3540                // .done: (offset 30)
3541                // i64.ctz returns i64, so clear high word: MOV rnhi, #0 (2 bytes)
3542                let mov0: u16 = (0x2000 | (rn_hi_bits << 8)) as u16;
3543                bytes.extend_from_slice(&mov0.to_le_bytes());
3544
3545                Ok(bytes)
3546            }
3547
3548            // I64Popcnt: Population count of 64-bit value
3549            // result = POPCNT(lo) + POPCNT(hi)
3550            // Using SIMD-style parallel bit counting algorithm
3551            ArmOp::I64Popcnt { rd, rnlo, rnhi } => {
3552                let rd_bits = reg_to_bits(rd);
3553                let rn_lo_bits = reg_to_bits(rnlo);
3554                let rn_hi_bits = reg_to_bits(rnhi);
3555                let r12: u32 = 12; // IP scratch
3556                let r3: u32 = 3; // Scratch for hi popcnt result
3557                let mut bytes = Vec::new();
3558
3559                // PUSH {R3, R4, R5} - save scratch registers
3560                bytes.extend_from_slice(&0xB438u16.to_le_bytes());
3561
3562                // Strategy: compute popcnt(lo) -> R4, popcnt(hi) -> R5, add them -> rd
3563                // Using lookup table approach for each byte would be too large
3564                // Using shift-and-add approach instead
3565
3566                // For simplicity and correctness, use the efficient parallel algorithm
3567                // but implement it as a series of inline operations
3568
3569                // MOV R4, rnlo
3570                let d_bit: u32 = 0; // R4 < 8, so high bit is 0
3571                let mov: u16 = (0x4600 | (d_bit << 7) | (rn_lo_bits << 3) | (4 & 0x7)) as u16;
3572                bytes.extend_from_slice(&mov.to_le_bytes());
3573
3574                // MOV R5, rnhi
3575                let d_bit: u32 = 0; // R5 < 8, so high bit is 0
3576                let mov: u16 = (0x4600 | (d_bit << 7) | (rn_hi_bits << 3) | (5 & 0x7)) as u16;
3577                bytes.extend_from_slice(&mov.to_le_bytes());
3578
3579                // --- POPCNT for R4 (lo word) ---
3580                // Step 1: x = x - ((x >> 1) & 0x55555555)
3581                // LSR.W R12, R4, #1
3582                let hw1: u16 = 0xEA4F;
3583                let hw2: u16 = ((r12 << 8) | 0x50 | 4) as u16;
3584                bytes.extend_from_slice(&hw1.to_le_bytes());
3585                bytes.extend_from_slice(&hw2.to_le_bytes());
3586
3587                // Load 0x55555555 into R3 using MOVW/MOVT
3588                // MOVW R3, #0x5555
3589                bytes.extend_from_slice(&0xF245u16.to_le_bytes());
3590                bytes.extend_from_slice(&0x5355u16.to_le_bytes());
3591                // MOVT R3, #0x5555
3592                bytes.extend_from_slice(&0xF2C5u16.to_le_bytes());
3593                bytes.extend_from_slice(&0x5355u16.to_le_bytes());
3594
3595                // AND.W R12, R12, R3
3596                let hw1: u16 = (0xEA00 | r12) as u16;
3597                let hw2: u16 = ((r12 << 8) | r3) as u16;
3598                bytes.extend_from_slice(&hw1.to_le_bytes());
3599                bytes.extend_from_slice(&hw2.to_le_bytes());
3600
3601                // SUB.W R4, R4, R12
3602                let hw1: u16 = (0xEBA0 | 4) as u16;
3603                let hw2: u16 = ((4 << 8) | r12) as u16;
3604                bytes.extend_from_slice(&hw1.to_le_bytes());
3605                bytes.extend_from_slice(&hw2.to_le_bytes());
3606
3607                // Step 2: x = (x & 0x33333333) + ((x >> 2) & 0x33333333)
3608                // Load 0x33333333 into R3
3609                // MOVW R3, #0x3333
3610                bytes.extend_from_slice(&0xF243u16.to_le_bytes());
3611                bytes.extend_from_slice(&0x3333u16.to_le_bytes());
3612                // MOVT R3, #0x3333
3613                bytes.extend_from_slice(&0xF2C3u16.to_le_bytes());
3614                bytes.extend_from_slice(&0x3333u16.to_le_bytes());
3615
3616                // AND.W R12, R4, R3
3617                let hw1: u16 = (0xEA00 | 4) as u16;
3618                let hw2: u16 = ((r12 << 8) | r3) as u16;
3619                bytes.extend_from_slice(&hw1.to_le_bytes());
3620                bytes.extend_from_slice(&hw2.to_le_bytes());
3621
3622                // LSR.W R4, R4, #2
3623                let hw1: u16 = 0xEA4F;
3624                let hw2: u16 = ((4 << 8) | 0x90 | 4) as u16;
3625                bytes.extend_from_slice(&hw1.to_le_bytes());
3626                bytes.extend_from_slice(&hw2.to_le_bytes());
3627
3628                // AND.W R4, R4, R3
3629                let hw1: u16 = (0xEA00 | 4) as u16;
3630                let hw2: u16 = ((4 << 8) | r3) as u16;
3631                bytes.extend_from_slice(&hw1.to_le_bytes());
3632                bytes.extend_from_slice(&hw2.to_le_bytes());
3633
3634                // ADD.W R4, R4, R12
3635                let hw1: u16 = (0xEB00 | 4) as u16;
3636                let hw2: u16 = ((4 << 8) | r12) as u16;
3637                bytes.extend_from_slice(&hw1.to_le_bytes());
3638                bytes.extend_from_slice(&hw2.to_le_bytes());
3639
3640                // Step 3: x = (x + (x >> 4)) & 0x0F0F0F0F
3641                // LSR.W R12, R4, #4
3642                // hw2 = (imm3 << 12) | (Rd << 8) | (imm2 << 6) | (type << 4) | Rm
3643                // imm5=4=00100 → imm3=1, imm2=0, type=01(LSR)
3644                let hw1: u16 = 0xEA4F;
3645                let hw2: u16 = (0x1000 | (r12 << 8) | 0x10 | 4) as u16;
3646                bytes.extend_from_slice(&hw1.to_le_bytes());
3647                bytes.extend_from_slice(&hw2.to_le_bytes());
3648
3649                // ADD.W R4, R4, R12
3650                let hw1: u16 = (0xEB00 | 4) as u16;
3651                let hw2: u16 = ((4 << 8) | r12) as u16;
3652                bytes.extend_from_slice(&hw1.to_le_bytes());
3653                bytes.extend_from_slice(&hw2.to_le_bytes());
3654
3655                // Load 0x0F0F0F0F into R3
3656                // MOVW R3, #0x0F0F (imm4=0, i=1, imm3=7, imm8=0x0F)
3657                // hw1 = 11110 1 10 0100 0000 = 0xF640
3658                // hw2 = 0 111 0011 00001111 = 0x730F
3659                bytes.extend_from_slice(&0xF640u16.to_le_bytes());
3660                bytes.extend_from_slice(&0x730Fu16.to_le_bytes());
3661                // MOVT R3, #0x0F0F
3662                bytes.extend_from_slice(&0xF6C0u16.to_le_bytes());
3663                bytes.extend_from_slice(&0x730Fu16.to_le_bytes());
3664
3665                // AND.W R4, R4, R3
3666                let hw1: u16 = (0xEA00 | 4) as u16;
3667                let hw2: u16 = ((4 << 8) | r3) as u16;
3668                bytes.extend_from_slice(&hw1.to_le_bytes());
3669                bytes.extend_from_slice(&hw2.to_le_bytes());
3670
3671                // Step 4: x = x * 0x01010101 >> 24
3672                // Load 0x01010101 into R3
3673                // MOVW R3, #0x0101
3674                bytes.extend_from_slice(&0xF240u16.to_le_bytes());
3675                bytes.extend_from_slice(&0x1301u16.to_le_bytes());
3676                // MOVT R3, #0x0101
3677                bytes.extend_from_slice(&0xF2C0u16.to_le_bytes());
3678                bytes.extend_from_slice(&0x1301u16.to_le_bytes());
3679
3680                // MUL R4, R4, R3
3681                // MUL T2: hw1 = 0xFB00|Rn, hw2 = 0xF000|(Rd<<8)|Rm
3682                let hw1: u16 = (0xFB00 | 4) as u16;
3683                let hw2: u16 = (0xF000 | (4 << 8) | r3) as u16;
3684                bytes.extend_from_slice(&hw1.to_le_bytes());
3685                bytes.extend_from_slice(&hw2.to_le_bytes());
3686
3687                // LSR.W R4, R4, #24
3688                // imm5=24=11000 → imm3=6, imm2=0, type=01(LSR)
3689                let hw1: u16 = 0xEA4F;
3690                let hw2: u16 = (0x6000 | (4 << 8) | 0x10 | 4) as u16;
3691                bytes.extend_from_slice(&hw1.to_le_bytes());
3692                bytes.extend_from_slice(&hw2.to_le_bytes());
3693
3694                // --- POPCNT for R5 (hi word) - same algorithm ---
3695                // Step 1
3696                let hw1: u16 = 0xEA4F;
3697                let hw2: u16 = ((r12 << 8) | 0x50 | 5) as u16;
3698                bytes.extend_from_slice(&hw1.to_le_bytes());
3699                bytes.extend_from_slice(&hw2.to_le_bytes());
3700
3701                // Load 0x55555555 into R3
3702                bytes.extend_from_slice(&0xF245u16.to_le_bytes());
3703                bytes.extend_from_slice(&0x5355u16.to_le_bytes());
3704                bytes.extend_from_slice(&0xF2C5u16.to_le_bytes());
3705                bytes.extend_from_slice(&0x5355u16.to_le_bytes());
3706
3707                let hw1: u16 = (0xEA00 | r12) as u16;
3708                let hw2: u16 = ((r12 << 8) | r3) as u16;
3709                bytes.extend_from_slice(&hw1.to_le_bytes());
3710                bytes.extend_from_slice(&hw2.to_le_bytes());
3711
3712                let hw1: u16 = (0xEBA0 | 5) as u16;
3713                let hw2: u16 = ((5 << 8) | r12) as u16;
3714                bytes.extend_from_slice(&hw1.to_le_bytes());
3715                bytes.extend_from_slice(&hw2.to_le_bytes());
3716
3717                // Step 2
3718                bytes.extend_from_slice(&0xF243u16.to_le_bytes());
3719                bytes.extend_from_slice(&0x3333u16.to_le_bytes());
3720                bytes.extend_from_slice(&0xF2C3u16.to_le_bytes());
3721                bytes.extend_from_slice(&0x3333u16.to_le_bytes());
3722
3723                let hw1: u16 = (0xEA00 | 5) as u16;
3724                let hw2: u16 = ((r12 << 8) | r3) as u16;
3725                bytes.extend_from_slice(&hw1.to_le_bytes());
3726                bytes.extend_from_slice(&hw2.to_le_bytes());
3727
3728                let hw1: u16 = 0xEA4F;
3729                let hw2: u16 = ((5 << 8) | 0x90 | 5) as u16;
3730                bytes.extend_from_slice(&hw1.to_le_bytes());
3731                bytes.extend_from_slice(&hw2.to_le_bytes());
3732
3733                let hw1: u16 = (0xEA00 | 5) as u16;
3734                let hw2: u16 = ((5 << 8) | r3) as u16;
3735                bytes.extend_from_slice(&hw1.to_le_bytes());
3736                bytes.extend_from_slice(&hw2.to_le_bytes());
3737
3738                let hw1: u16 = (0xEB00 | 5) as u16;
3739                let hw2: u16 = ((5 << 8) | r12) as u16;
3740                bytes.extend_from_slice(&hw1.to_le_bytes());
3741                bytes.extend_from_slice(&hw2.to_le_bytes());
3742
3743                // Step 3: LSR.W R12, R5, #4
3744                // imm5=4=00100 → imm3=1, imm2=0, type=01(LSR)
3745                let hw1: u16 = 0xEA4F;
3746                let hw2: u16 = (0x1000 | (r12 << 8) | 0x10 | 5) as u16;
3747                bytes.extend_from_slice(&hw1.to_le_bytes());
3748                bytes.extend_from_slice(&hw2.to_le_bytes());
3749
3750                let hw1: u16 = (0xEB00 | 5) as u16;
3751                let hw2: u16 = ((5 << 8) | r12) as u16;
3752                bytes.extend_from_slice(&hw1.to_le_bytes());
3753                bytes.extend_from_slice(&hw2.to_le_bytes());
3754
3755                // Load 0x0F0F0F0F into R3 (for hi-word)
3756                bytes.extend_from_slice(&0xF640u16.to_le_bytes());
3757                bytes.extend_from_slice(&0x730Fu16.to_le_bytes());
3758                bytes.extend_from_slice(&0xF6C0u16.to_le_bytes());
3759                bytes.extend_from_slice(&0x730Fu16.to_le_bytes());
3760
3761                let hw1: u16 = (0xEA00 | 5) as u16;
3762                let hw2: u16 = ((5 << 8) | r3) as u16;
3763                bytes.extend_from_slice(&hw1.to_le_bytes());
3764                bytes.extend_from_slice(&hw2.to_le_bytes());
3765
3766                // Step 4
3767                bytes.extend_from_slice(&0xF240u16.to_le_bytes());
3768                bytes.extend_from_slice(&0x1301u16.to_le_bytes());
3769                bytes.extend_from_slice(&0xF2C0u16.to_le_bytes());
3770                bytes.extend_from_slice(&0x1301u16.to_le_bytes());
3771
3772                // MUL R5, R5, R3
3773                // MUL T2: hw1 = 0xFB00|Rn, hw2 = 0xF000|(Rd<<8)|Rm
3774                let hw1: u16 = (0xFB00 | 5) as u16;
3775                let hw2: u16 = (0xF000 | (5 << 8) | r3) as u16;
3776                bytes.extend_from_slice(&hw1.to_le_bytes());
3777                bytes.extend_from_slice(&hw2.to_le_bytes());
3778
3779                // LSR.W R5, R5, #24
3780                // imm5=24=11000 → imm3=6, imm2=0, type=01(LSR)
3781                let hw1: u16 = 0xEA4F;
3782                let hw2: u16 = (0x6000 | (5 << 8) | 0x10 | 5) as u16;
3783                bytes.extend_from_slice(&hw1.to_le_bytes());
3784                bytes.extend_from_slice(&hw2.to_le_bytes());
3785
3786                // ADD rd, R4, R5 (combine lo and hi counts)
3787                // ADDS Rd, Rn, Rm (T1): 0001 100 Rm Rn Rd = 0x1800 | (Rm<<6) | (Rn<<3) | Rd
3788                let rd_bits_u16 = rd_bits as u16;
3789                let instr: u16 = 0x1800 | (5 << 6) | (4 << 3) | rd_bits_u16;
3790                bytes.extend_from_slice(&instr.to_le_bytes());
3791
3792                // POP {R3, R4, R5}
3793                bytes.extend_from_slice(&0xBC38u16.to_le_bytes());
3794
3795                // i64.popcnt returns i64, so clear high word: MOV rnhi, #0 (2 bytes)
3796                let mov0: u16 = (0x2000 | (rn_hi_bits << 8)) as u16;
3797                bytes.extend_from_slice(&mov0.to_le_bytes());
3798
3799                Ok(bytes)
3800            }
3801
3802            // I64Extend8S: Sign-extend low 8 bits to 64 bits
3803            // Result: rdlo = sign_extend_8(rnlo), rdhi = rdlo >> 31
3804            ArmOp::I64Extend8S { rdlo, rdhi, rnlo } => {
3805                let rdlo_bits = reg_to_bits(rdlo);
3806                let rdhi_bits = reg_to_bits(rdhi);
3807                let rnlo_bits = reg_to_bits(rnlo);
3808                let mut bytes = Vec::new();
3809
3810                // SXTB.W rdlo, rnlo (sign-extend byte to 32-bit)
3811                // SXTB T2: hw1 = 0xFA4F, hw2 = 0xF0<Rd><Rm>
3812                let hw1: u16 = 0xFA4F_u16;
3813                let hw2: u16 = (0xF080 | (rdlo_bits << 8) | rnlo_bits) as u16;
3814                bytes.extend_from_slice(&hw1.to_le_bytes());
3815                bytes.extend_from_slice(&hw2.to_le_bytes());
3816
3817                // ASR.W rdhi, rdlo, #31 (sign-extend to high word)
3818                // ASR (immediate): hw1 = 0xEA4F, hw2 = imm3:Rd:imm2:type:Rm
3819                // For imm5=31: imm3=111, imm2=11, type=10 (ASR)
3820                // hw2 = (7 << 12) | (rdhi << 8) | (3 << 6) | (2 << 4) | rdlo
3821                let hw1: u16 = 0xEA4F;
3822                let hw2: u16 = (0x70E0 | (rdhi_bits << 8) | rdlo_bits) as u16;
3823                bytes.extend_from_slice(&hw1.to_le_bytes());
3824                bytes.extend_from_slice(&hw2.to_le_bytes());
3825
3826                Ok(bytes)
3827            }
3828
3829            // I64Extend16S: Sign-extend low 16 bits to 64 bits
3830            // Result: rdlo = sign_extend_16(rnlo), rdhi = rdlo >> 31
3831            ArmOp::I64Extend16S { rdlo, rdhi, rnlo } => {
3832                let rdlo_bits = reg_to_bits(rdlo);
3833                let rdhi_bits = reg_to_bits(rdhi);
3834                let rnlo_bits = reg_to_bits(rnlo);
3835                let mut bytes = Vec::new();
3836
3837                // SXTH.W rdlo, rnlo (sign-extend halfword to 32-bit)
3838                // SXTH T2: hw1 = 0xFA0F, hw2 = 0xF0<Rd><Rm>
3839                let hw1: u16 = 0xFA0F_u16;
3840                let hw2: u16 = (0xF080 | (rdlo_bits << 8) | rnlo_bits) as u16;
3841                bytes.extend_from_slice(&hw1.to_le_bytes());
3842                bytes.extend_from_slice(&hw2.to_le_bytes());
3843
3844                // ASR.W rdhi, rdlo, #31 (sign-extend to high word)
3845                let hw1: u16 = 0xEA4F;
3846                let hw2: u16 = (0x70E0 | (rdhi_bits << 8) | rdlo_bits) as u16;
3847                bytes.extend_from_slice(&hw1.to_le_bytes());
3848                bytes.extend_from_slice(&hw2.to_le_bytes());
3849
3850                Ok(bytes)
3851            }
3852
3853            // I64Extend32S: Sign-extend low 32 bits to 64 bits
3854            // Result: rdlo = rnlo, rdhi = rnlo >> 31
3855            ArmOp::I64Extend32S { rdlo, rdhi, rnlo } => {
3856                let rdlo_bits = reg_to_bits(rdlo);
3857                let rdhi_bits = reg_to_bits(rdhi);
3858                let rnlo_bits = reg_to_bits(rnlo);
3859                let mut bytes = Vec::new();
3860
3861                // MOV rdlo, rnlo (if different)
3862                if rdlo_bits != rnlo_bits {
3863                    // MOV Rd, Rm (16-bit): 0100 0110 D Rm Rd[2:0]
3864                    let d_bit = ((rdlo_bits >> 3) & 1) as u16;
3865                    let mov: u16 = 0x4600
3866                        | (d_bit << 7)
3867                        | ((rnlo_bits as u16) << 3)
3868                        | ((rdlo_bits & 0x7) as u16);
3869                    bytes.extend_from_slice(&mov.to_le_bytes());
3870                }
3871
3872                // ASR.W rdhi, rnlo, #31 (sign-extend to high word)
3873                let hw1: u16 = 0xEA4F;
3874                let hw2: u16 = (0x70E0 | (rdhi_bits << 8) | rnlo_bits) as u16;
3875                bytes.extend_from_slice(&hw1.to_le_bytes());
3876                bytes.extend_from_slice(&hw2.to_le_bytes());
3877
3878                Ok(bytes)
3879            }
3880
3881            // SelectMove: IT <cond>; MOV{cond} rd, rm
3882            // Conditional move: only execute MOV if condition is true
3883            ArmOp::SelectMove { rd, rm, cond } => {
3884                let rd_bits = reg_to_bits(rd) as u16;
3885                let rm_bits = reg_to_bits(rm) as u16;
3886
3887                // Condition code encoding for IT block
3888                use synth_synthesis::Condition;
3889                let cond_bits: u16 = match cond {
3890                    Condition::EQ => 0x0, // Equal
3891                    Condition::NE => 0x1, // Not equal
3892                    Condition::HS => 0x2, // Higher or same (unsigned >=)
3893                    Condition::LO => 0x3, // Lower (unsigned <)
3894                    Condition::HI => 0x8, // Higher (unsigned >)
3895                    Condition::LS => 0x9, // Lower or same (unsigned <=)
3896                    Condition::GE => 0xA, // Greater or equal (signed)
3897                    Condition::LT => 0xB, // Less than (signed)
3898                    Condition::GT => 0xC, // Greater than (signed)
3899                    Condition::LE => 0xD, // Less or equal (signed)
3900                };
3901
3902                // IT <cond>: single Then block (mask = 0x8 for T only)
3903                // IT instruction: 1011 1111 firstcond mask
3904                let it_instr: u16 = 0xBF00 | (cond_bits << 4) | 0x8;
3905
3906                // MOV Rd, Rm (16-bit): 0100 0110 D Rm Rd[2:0]
3907                // This MOV will only execute if condition is true due to IT block
3908                let d_bit = (rd_bits >> 3) & 1;
3909                let mov_instr: u16 = 0x4600 | (d_bit << 7) | (rm_bits << 3) | (rd_bits & 0x7);
3910
3911                // Emit: IT <cond>, MOV rd, rm
3912                let mut bytes = it_instr.to_le_bytes().to_vec();
3913                bytes.extend_from_slice(&mov_instr.to_le_bytes());
3914                Ok(bytes)
3915            }
3916
3917            // Popcnt: Population count (count set bits)
3918            // ARM Cortex-M has no native POPCNT, so we implement the bit manipulation algorithm:
3919            // x = x - ((x >> 1) & 0x55555555);
3920            // x = (x & 0x33333333) + ((x >> 2) & 0x33333333);
3921            // x = (x + (x >> 4)) & 0x0F0F0F0F;
3922            // x = x + (x >> 8);
3923            // x = x + (x >> 16);
3924            // return x & 0x3F;
3925            //
3926            // Uses rd as working register and R12 as scratch for constants
3927            ArmOp::Popcnt { rd, rm } => {
3928                let mut bytes = Vec::new();
3929
3930                // First, move rm to rd if they're different
3931                if rd != rm {
3932                    let rd_bits = reg_to_bits(rd) as u16;
3933                    let rm_bits = reg_to_bits(rm) as u16;
3934                    // MOV Rd, Rm (16-bit): 0100 0110 D Rm Rd[2:0]
3935                    let d_bit = (rd_bits >> 3) & 1;
3936                    let mov_instr: u16 = 0x4600 | (d_bit << 7) | (rm_bits << 3) | (rd_bits & 0x7);
3937                    bytes.extend_from_slice(&mov_instr.to_le_bytes());
3938                }
3939
3940                // Step 1: x = x - ((x >> 1) & 0x55555555)
3941                // Load 0x55555555 into R12
3942                bytes.extend_from_slice(&self.encode_thumb32_movw_raw(12, 0x5555)?);
3943                bytes.extend_from_slice(&self.encode_thumb32_movt_raw(12, 0x5555)?);
3944
3945                // R12_temp = rd >> 1
3946                // We need a second scratch register. Use R11.
3947                bytes.extend_from_slice(&self.encode_thumb32_lsr_raw(11, reg_to_bits(rd), 1)?);
3948
3949                // R11 = R11 & R12 (R11 = (x >> 1) & 0x55555555)
3950                bytes.extend_from_slice(&self.encode_thumb32_and_reg_raw(11, 11, 12)?);
3951
3952                // rd = rd - R11
3953                bytes.extend_from_slice(&self.encode_thumb32_sub_reg_raw(
3954                    reg_to_bits(rd),
3955                    reg_to_bits(rd),
3956                    11,
3957                )?);
3958
3959                // Step 2: x = (x & 0x33333333) + ((x >> 2) & 0x33333333)
3960                // Load 0x33333333 into R12
3961                bytes.extend_from_slice(&self.encode_thumb32_movw_raw(12, 0x3333)?);
3962                bytes.extend_from_slice(&self.encode_thumb32_movt_raw(12, 0x3333)?);
3963
3964                // R11 = rd & R12
3965                bytes.extend_from_slice(&self.encode_thumb32_and_reg_raw(
3966                    11,
3967                    reg_to_bits(rd),
3968                    12,
3969                )?);
3970
3971                // rd = rd >> 2
3972                bytes.extend_from_slice(&self.encode_thumb32_lsr_raw(
3973                    reg_to_bits(rd),
3974                    reg_to_bits(rd),
3975                    2,
3976                )?);
3977
3978                // rd = rd & R12
3979                bytes.extend_from_slice(&self.encode_thumb32_and_reg_raw(
3980                    reg_to_bits(rd),
3981                    reg_to_bits(rd),
3982                    12,
3983                )?);
3984
3985                // rd = rd + R11
3986                bytes.extend_from_slice(&self.encode_thumb32_add_reg_raw(
3987                    reg_to_bits(rd),
3988                    reg_to_bits(rd),
3989                    11,
3990                )?);
3991
3992                // Step 3: x = (x + (x >> 4)) & 0x0F0F0F0F
3993                // R11 = rd >> 4
3994                bytes.extend_from_slice(&self.encode_thumb32_lsr_raw(11, reg_to_bits(rd), 4)?);
3995
3996                // rd = rd + R11
3997                bytes.extend_from_slice(&self.encode_thumb32_add_reg_raw(
3998                    reg_to_bits(rd),
3999                    reg_to_bits(rd),
4000                    11,
4001                )?);
4002
4003                // Load 0x0F0F0F0F into R12
4004                bytes.extend_from_slice(&self.encode_thumb32_movw_raw(12, 0x0F0F)?);
4005                bytes.extend_from_slice(&self.encode_thumb32_movt_raw(12, 0x0F0F)?);
4006
4007                // rd = rd & R12
4008                bytes.extend_from_slice(&self.encode_thumb32_and_reg_raw(
4009                    reg_to_bits(rd),
4010                    reg_to_bits(rd),
4011                    12,
4012                )?);
4013
4014                // Step 4: x = x + (x >> 8)
4015                // R11 = rd >> 8
4016                bytes.extend_from_slice(&self.encode_thumb32_lsr_raw(11, reg_to_bits(rd), 8)?);
4017
4018                // rd = rd + R11
4019                bytes.extend_from_slice(&self.encode_thumb32_add_reg_raw(
4020                    reg_to_bits(rd),
4021                    reg_to_bits(rd),
4022                    11,
4023                )?);
4024
4025                // Step 5: x = x + (x >> 16)
4026                // R11 = rd >> 16
4027                bytes.extend_from_slice(&self.encode_thumb32_lsr_raw(11, reg_to_bits(rd), 16)?);
4028
4029                // rd = rd + R11
4030                bytes.extend_from_slice(&self.encode_thumb32_add_reg_raw(
4031                    reg_to_bits(rd),
4032                    reg_to_bits(rd),
4033                    11,
4034                )?);
4035
4036                // Step 6: return x & 0x3F
4037                // AND with 0x3F (small immediate, can use BIC or AND with immediate)
4038                bytes.extend_from_slice(&self.encode_thumb32_and_imm_raw(
4039                    reg_to_bits(rd),
4040                    reg_to_bits(rd),
4041                    0x3F,
4042                )?);
4043
4044                Ok(bytes)
4045            }
4046
4047            // I64DivU: 64-bit unsigned division using binary long division
4048            // Input: R0:R1 = dividend, R2:R3 = divisor
4049            // Output: R0:R1 = quotient
4050            // Uses: R4-R7, R12 as loop counter (avoid R8 for Renode compatibility)
4051            ArmOp::I64DivU {
4052                rdlo: _,
4053                rdhi: _,
4054                rnlo: _,
4055                rnhi: _,
4056                rmlo: _,
4057                rmhi: _,
4058            } => {
4059                let mut bytes = Vec::new();
4060
4061                // PUSH {R4-R7} - save scratch registers (NO LR — this is inline code)
4062                // 16-bit PUSH: 1011 010 M rrrrrrrr where M=0 (no LR), r=R4-R7 = 0xF0
4063                // Encoding: 1011 0100 1111 0000 = 0xB4F0
4064                bytes.extend_from_slice(&0xB4F0u16.to_le_bytes());
4065
4066                // Initialize quotient (R4:R5) = 0
4067                bytes.extend_from_slice(&0x2400u16.to_le_bytes()); // MOV R4, #0
4068                bytes.extend_from_slice(&0x2500u16.to_le_bytes()); // MOV R5, #0
4069
4070                // Initialize remainder (R6:R7) = 0
4071                bytes.extend_from_slice(&0x2600u16.to_le_bytes()); // MOV R6, #0
4072                bytes.extend_from_slice(&0x2700u16.to_le_bytes()); // MOV R7, #0
4073
4074                // Initialize loop counter R12 = 64 (use R12 scratch instead of R8)
4075                // MOV.W R12, #64: F04F 0C40
4076                bytes.extend_from_slice(&0xF04Fu16.to_le_bytes());
4077                bytes.extend_from_slice(&0x0C40u16.to_le_bytes());
4078
4079                // Loop start
4080                let loop_start = bytes.len();
4081
4082                // === Loop body: process one bit ===
4083
4084                // 1. Shift quotient R4:R5 left by 1
4085                // LSLS R5, R5, #1 (16-bit: 0000 0010 1010 1101 = 0x006D -> actually 0x002D for LSL R5,R5,#1)
4086                // LSL Rd, Rm, #imm5: 000 00 imm5 Rm Rd = 000 00 00001 101 101 = 0x006D
4087                bytes.extend_from_slice(&0x006Du16.to_le_bytes()); // LSLS R5, R5, #1
4088                // Get carry from R4 into R5: ORR R5, R5, R4 LSR #31
4089                // Thumb-2 ORR with shifted register: EA45 75D4 = ORR.W R5, R5, R4, LSR #31
4090                // 11101010 010 S Rn | 0 imm3 Rd imm2 type Rm
4091                // type=01 (LSR), imm5=31 (imm3=111, imm2=11)
4092                bytes.extend_from_slice(&0xEA45u16.to_le_bytes());
4093                bytes.extend_from_slice(&0x75D4u16.to_le_bytes()); // ORR.W R5, R5, R4, LSR #31
4094                // LSLS R4, R4, #1: 000 00 00001 100 100 = 0x0064
4095                bytes.extend_from_slice(&0x0064u16.to_le_bytes()); // LSLS R4, R4, #1
4096
4097                // 2. Shift remainder R6:R7 left by 1, OR in MSB of dividend R1
4098                // LSLS R7, R7, #1
4099                bytes.extend_from_slice(&0x007Fu16.to_le_bytes()); // LSLS R7, R7, #1
4100                // ORR.W R7, R7, R6, LSR #31
4101                bytes.extend_from_slice(&0xEA47u16.to_le_bytes());
4102                bytes.extend_from_slice(&0x77D6u16.to_le_bytes());
4103                // LSLS R6, R6, #1
4104                bytes.extend_from_slice(&0x0076u16.to_le_bytes()); // LSLS R6, R6, #1
4105                // ORR.W R6, R6, R1, LSR #31 (bring in MSB of dividend high)
4106                bytes.extend_from_slice(&0xEA46u16.to_le_bytes());
4107                bytes.extend_from_slice(&0x76D1u16.to_le_bytes());
4108
4109                // 3. Shift dividend R0:R1 left by 1
4110                // LSLS R1, R1, #1
4111                bytes.extend_from_slice(&0x0049u16.to_le_bytes()); // LSLS R1, R1, #1
4112                // ORR.W R1, R1, R0, LSR #31
4113                bytes.extend_from_slice(&0xEA41u16.to_le_bytes());
4114                bytes.extend_from_slice(&0x71D0u16.to_le_bytes());
4115                // LSLS R0, R0, #1
4116                bytes.extend_from_slice(&0x0040u16.to_le_bytes()); // LSLS R0, R0, #1
4117
4118                // 4. Compare remainder >= divisor (64-bit unsigned comparison)
4119                // Compare high words first: CMP R7, R3
4120                // CMP Rn, Rm encoding: 0x4280 | (Rm << 3) | Rn
4121                bytes.extend_from_slice(&0x429Fu16.to_le_bytes()); // CMP R7, R3 (16-bit)
4122                // BHI means R7 > R3 (unsigned) - definitely subtract
4123                // BLO means R7 < R3 - definitely don't subtract
4124                // BEQ means need to check low words
4125
4126                // If high > divisor high: branch to subtract (forward +offset)
4127                // BHI.N +6 (skip CMP, skip BLO, do subtract)
4128                // BHI: 1101 1000 offset8 where cond=1000 (HI)
4129                bytes.extend_from_slice(&0xD802u16.to_le_bytes()); // BHI +4 (to subtract block)
4130
4131                // If high < divisor high: branch past subtract
4132                // BLO.N +10 (skip to decrement)
4133                bytes.extend_from_slice(&0xD306u16.to_le_bytes()); // BLO/BCC +12 (past subtract)
4134
4135                // High words equal, compare low: CMP R6, R2
4136                bytes.extend_from_slice(&0x4296u16.to_le_bytes()); // CMP R6, R2 (16-bit)
4137                // BLO/BCC past subtract (skip SUBS+SBC.W+ORR.W = 10 bytes = 4 halfwords from PC+4)
4138                bytes.extend_from_slice(&0xD304u16.to_le_bytes()); // BCC +4 halfwords (past subtract)
4139
4140                // === Subtract block: remainder -= divisor, quotient |= 1 ===
4141                // SUBS R6, R6, R2
4142                bytes.extend_from_slice(&0x1AB6u16.to_le_bytes()); // SUBS R6, R6, R2 (16-bit)
4143                // SBC R7, R7, R3 (with borrow)
4144                // Thumb-2 SBC.W: EB67 0703 = SBC.W R7, R7, R3
4145                bytes.extend_from_slice(&0xEB67u16.to_le_bytes());
4146                bytes.extend_from_slice(&0x0703u16.to_le_bytes());
4147                // ORR R4, R4, #1 (set bit 0 of quotient low)
4148                bytes.extend_from_slice(&0xF044u16.to_le_bytes()); // ORR.W R4, R4, #1
4149                bytes.extend_from_slice(&0x0401u16.to_le_bytes());
4150
4151                // === Decrement counter and loop ===
4152                // SUBS.W R12, R12, #1 (decrement loop counter)
4153                // SUBS.W R12, R12, #1: F1BC 0C01
4154                bytes.extend_from_slice(&0xF1BCu16.to_le_bytes());
4155                bytes.extend_from_slice(&0x0C01u16.to_le_bytes());
4156
4157                // BNE back to loop_start
4158                let branch_offset_bytes = bytes.len() - loop_start + 4; // +4 for pipeline
4159                let offset_halfwords = -((branch_offset_bytes / 2) as i16);
4160                let bne_encoding = 0xD100u16 | ((offset_halfwords as u16) & 0xFF);
4161                bytes.extend_from_slice(&bne_encoding.to_le_bytes());
4162
4163                // === Loop done, move quotient to R0:R1 ===
4164                bytes.extend_from_slice(&0x4620u16.to_le_bytes()); // MOV R0, R4
4165                bytes.extend_from_slice(&0x4629u16.to_le_bytes()); // MOV R1, R5
4166
4167                // POP {R4-R7} - restore scratch registers (NO PC — inline code continues)
4168                // 16-bit POP: 1011 110 P rrrrrrrr where P=0 (no PC), r=R4-R7 = 0xF0
4169                // Encoding: 1011 1100 1111 0000 = 0xBCF0
4170                bytes.extend_from_slice(&0xBCF0u16.to_le_bytes());
4171
4172                Ok(bytes)
4173            }
4174
4175            // I64DivS: 64-bit signed division
4176            // Converts to unsigned, divides, then applies sign
4177            // Input: R0:R1 = dividend (signed), R2:R3 = divisor (signed)
4178            // Output: R0:R1 = quotient (signed)
4179            ArmOp::I64DivS {
4180                rdlo: _,
4181                rdhi: _,
4182                rnlo: _,
4183                rnhi: _,
4184                rmlo: _,
4185                rmhi: _,
4186            } => {
4187                let mut bytes = Vec::new();
4188
4189                // PUSH {R4-R11} - save scratch registers (NO LR — inline code)
4190                bytes.extend_from_slice(&0xE92Du16.to_le_bytes());
4191                bytes.extend_from_slice(&0x0FF0u16.to_le_bytes());
4192
4193                // Save result sign in R9: R9 = R1 XOR R3 (sign bit = MSB)
4194                // EOR.W R9, R1, R3
4195                bytes.extend_from_slice(&0xEA81u16.to_le_bytes());
4196                bytes.extend_from_slice(&0x0903u16.to_le_bytes());
4197
4198                // If dividend negative (R1 MSB set), negate it
4199                // TST R1, R1 (check sign)
4200                bytes.extend_from_slice(&0x4209u16.to_le_bytes()); // TST R1, R1
4201                // BPL skip_neg_dividend (+10 bytes = 5 halfwords)
4202                bytes.extend_from_slice(&0xD504u16.to_le_bytes()); // BPL +8
4203
4204                // Negate R0:R1 (64-bit): RSBS R0, R0, #0; SBC R1, R1, R1 LSL #1
4205                // Actually: MVN R0, R0; MVN R1, R1; ADDS R0, R0, #1; ADC R1, R1, #0
4206                bytes.extend_from_slice(&0x43C0u16.to_le_bytes()); // MVNS R0, R0
4207                bytes.extend_from_slice(&0x43C9u16.to_le_bytes()); // MVNS R1, R1
4208                bytes.extend_from_slice(&0x1C40u16.to_le_bytes()); // ADDS R0, R0, #1
4209                bytes.extend_from_slice(&0xF141u16.to_le_bytes()); // ADC.W R1, R1, #0
4210                bytes.extend_from_slice(&0x0100u16.to_le_bytes());
4211
4212                // If divisor negative (R3 MSB set), negate it
4213                bytes.extend_from_slice(&0x421Bu16.to_le_bytes()); // TST R3, R3
4214                bytes.extend_from_slice(&0xD504u16.to_le_bytes()); // BPL +8
4215
4216                // Negate R2:R3
4217                bytes.extend_from_slice(&0x43D2u16.to_le_bytes()); // MVNS R2, R2
4218                bytes.extend_from_slice(&0x43DBu16.to_le_bytes()); // MVNS R3, R3
4219                bytes.extend_from_slice(&0x1C52u16.to_le_bytes()); // ADDS R2, R2, #1
4220                bytes.extend_from_slice(&0xF143u16.to_le_bytes()); // ADC.W R3, R3, #0
4221                bytes.extend_from_slice(&0x0300u16.to_le_bytes());
4222
4223                // === Now do unsigned division (same as I64DivU) ===
4224                // Initialize quotient (R4:R5) = 0
4225                bytes.extend_from_slice(&0x2400u16.to_le_bytes());
4226                bytes.extend_from_slice(&0x2500u16.to_le_bytes());
4227                // Initialize remainder (R6:R7) = 0
4228                bytes.extend_from_slice(&0x2600u16.to_le_bytes());
4229                bytes.extend_from_slice(&0x2700u16.to_le_bytes());
4230                // Initialize loop counter R8 = 64
4231                bytes.extend_from_slice(&0xF04Fu16.to_le_bytes());
4232                bytes.extend_from_slice(&0x0840u16.to_le_bytes());
4233
4234                let loop_start = bytes.len();
4235
4236                // Shift quotient left
4237                bytes.extend_from_slice(&0x006Du16.to_le_bytes()); // LSLS R5, R5, #1
4238                bytes.extend_from_slice(&0xEA45u16.to_le_bytes()); // ORR.W R5, R5, R4, LSR #31
4239                bytes.extend_from_slice(&0x75D4u16.to_le_bytes());
4240                bytes.extend_from_slice(&0x0064u16.to_le_bytes()); // LSLS R4, R4, #1
4241
4242                // Shift remainder left, OR in MSB of dividend
4243                bytes.extend_from_slice(&0x007Fu16.to_le_bytes()); // LSLS R7, R7, #1
4244                bytes.extend_from_slice(&0xEA47u16.to_le_bytes()); // ORR.W R7, R7, R6, LSR #31
4245                bytes.extend_from_slice(&0x77D6u16.to_le_bytes());
4246                bytes.extend_from_slice(&0x0076u16.to_le_bytes()); // LSLS R6, R6, #1
4247                bytes.extend_from_slice(&0xEA46u16.to_le_bytes()); // ORR.W R6, R6, R1, LSR #31
4248                bytes.extend_from_slice(&0x76D1u16.to_le_bytes());
4249
4250                // Shift dividend left
4251                bytes.extend_from_slice(&0x0049u16.to_le_bytes()); // LSLS R1, R1, #1
4252                bytes.extend_from_slice(&0xEA41u16.to_le_bytes()); // ORR.W R1, R1, R0, LSR #31
4253                bytes.extend_from_slice(&0x71D0u16.to_le_bytes());
4254                bytes.extend_from_slice(&0x0040u16.to_le_bytes()); // LSLS R0, R0, #1
4255
4256                // Compare and conditionally subtract
4257                bytes.extend_from_slice(&0x429Fu16.to_le_bytes()); // CMP R7, R3
4258                bytes.extend_from_slice(&0xD802u16.to_le_bytes()); // BHI +4
4259                bytes.extend_from_slice(&0xD306u16.to_le_bytes()); // BCC +12
4260                bytes.extend_from_slice(&0x4296u16.to_le_bytes()); // CMP R6, R2
4261                bytes.extend_from_slice(&0xD304u16.to_le_bytes()); // BCC +4 halfwords
4262
4263                // Subtract and set quotient bit
4264                bytes.extend_from_slice(&0x1AB6u16.to_le_bytes()); // SUBS R6, R6, R2
4265                bytes.extend_from_slice(&0xEB67u16.to_le_bytes()); // SBC.W R7, R7, R3
4266                bytes.extend_from_slice(&0x0703u16.to_le_bytes());
4267                bytes.extend_from_slice(&0xF044u16.to_le_bytes()); // ORR.W R4, R4, #1
4268                bytes.extend_from_slice(&0x0401u16.to_le_bytes());
4269
4270                // Decrement and loop
4271                bytes.extend_from_slice(&0xF1B8u16.to_le_bytes()); // SUB.W R8, R8, #1
4272                bytes.extend_from_slice(&0x0801u16.to_le_bytes());
4273
4274                let branch_offset_bytes = bytes.len() - loop_start + 4;
4275                let offset_halfwords = -((branch_offset_bytes / 2) as i16);
4276                let bne_encoding = 0xD100u16 | ((offset_halfwords as u16) & 0xFF);
4277                bytes.extend_from_slice(&bne_encoding.to_le_bytes());
4278
4279                // Move quotient to R0:R1
4280                bytes.extend_from_slice(&0x4620u16.to_le_bytes()); // MOV R0, R4
4281                bytes.extend_from_slice(&0x4629u16.to_le_bytes()); // MOV R1, R5
4282
4283                // If result should be negative (R9 MSB set), negate R0:R1
4284                bytes.extend_from_slice(&0xF1B9u16.to_le_bytes()); // TST.W R9, R9 (check MSB)
4285                bytes.extend_from_slice(&0x0F00u16.to_le_bytes());
4286                bytes.extend_from_slice(&0xD504u16.to_le_bytes()); // BPL +8 (skip negation)
4287
4288                // Negate result R0:R1
4289                bytes.extend_from_slice(&0x43C0u16.to_le_bytes()); // MVNS R0, R0
4290                bytes.extend_from_slice(&0x43C9u16.to_le_bytes()); // MVNS R1, R1
4291                bytes.extend_from_slice(&0x1C40u16.to_le_bytes()); // ADDS R0, R0, #1
4292                bytes.extend_from_slice(&0xF141u16.to_le_bytes()); // ADC.W R1, R1, #0
4293                bytes.extend_from_slice(&0x0100u16.to_le_bytes());
4294
4295                // POP {R4-R11} - restore scratch registers (NO PC — inline code continues)
4296                bytes.extend_from_slice(&0xE8BDu16.to_le_bytes());
4297                bytes.extend_from_slice(&0x0FF0u16.to_le_bytes());
4298
4299                Ok(bytes)
4300            }
4301
4302            // I64RemU: 64-bit unsigned remainder using binary long division
4303            // Same algorithm as I64DivU but returns remainder instead of quotient
4304            // Input: R0:R1 = dividend, R2:R3 = divisor
4305            // Output: R0:R1 = remainder
4306            ArmOp::I64RemU {
4307                rdlo: _,
4308                rdhi: _,
4309                rnlo: _,
4310                rnhi: _,
4311                rmlo: _,
4312                rmhi: _,
4313            } => {
4314                let mut bytes = Vec::new();
4315
4316                // PUSH {R4-R8} - save scratch registers (NO LR — inline code)
4317                bytes.extend_from_slice(&0xE92Du16.to_le_bytes());
4318                bytes.extend_from_slice(&0x01F0u16.to_le_bytes());
4319
4320                // Initialize quotient (R4:R5) = 0 (computed but not returned)
4321                bytes.extend_from_slice(&0x2400u16.to_le_bytes());
4322                bytes.extend_from_slice(&0x2500u16.to_le_bytes());
4323                // Initialize remainder (R6:R7) = 0
4324                bytes.extend_from_slice(&0x2600u16.to_le_bytes());
4325                bytes.extend_from_slice(&0x2700u16.to_le_bytes());
4326                // Initialize loop counter R8 = 64
4327                bytes.extend_from_slice(&0xF04Fu16.to_le_bytes());
4328                bytes.extend_from_slice(&0x0840u16.to_le_bytes());
4329
4330                let loop_start = bytes.len();
4331
4332                // Shift quotient left (not needed for result, but keeps algorithm same)
4333                bytes.extend_from_slice(&0x006Du16.to_le_bytes()); // LSLS R5, R5, #1
4334                bytes.extend_from_slice(&0xEA45u16.to_le_bytes()); // ORR.W R5, R5, R4, LSR #31
4335                bytes.extend_from_slice(&0x75D4u16.to_le_bytes());
4336                bytes.extend_from_slice(&0x0064u16.to_le_bytes()); // LSLS R4, R4, #1
4337
4338                // Shift remainder left, OR in MSB of dividend
4339                bytes.extend_from_slice(&0x007Fu16.to_le_bytes()); // LSLS R7, R7, #1
4340                bytes.extend_from_slice(&0xEA47u16.to_le_bytes()); // ORR.W R7, R7, R6, LSR #31
4341                bytes.extend_from_slice(&0x77D6u16.to_le_bytes());
4342                bytes.extend_from_slice(&0x0076u16.to_le_bytes()); // LSLS R6, R6, #1
4343                bytes.extend_from_slice(&0xEA46u16.to_le_bytes()); // ORR.W R6, R6, R1, LSR #31
4344                bytes.extend_from_slice(&0x76D1u16.to_le_bytes());
4345
4346                // Shift dividend left
4347                bytes.extend_from_slice(&0x0049u16.to_le_bytes()); // LSLS R1, R1, #1
4348                bytes.extend_from_slice(&0xEA41u16.to_le_bytes()); // ORR.W R1, R1, R0, LSR #31
4349                bytes.extend_from_slice(&0x71D0u16.to_le_bytes());
4350                bytes.extend_from_slice(&0x0040u16.to_le_bytes()); // LSLS R0, R0, #1
4351
4352                // Compare and conditionally subtract
4353                bytes.extend_from_slice(&0x429Fu16.to_le_bytes()); // CMP R7, R3
4354                bytes.extend_from_slice(&0xD802u16.to_le_bytes()); // BHI +4
4355                bytes.extend_from_slice(&0xD306u16.to_le_bytes()); // BCC +12
4356                bytes.extend_from_slice(&0x4296u16.to_le_bytes()); // CMP R6, R2
4357                bytes.extend_from_slice(&0xD304u16.to_le_bytes()); // BCC +4 halfwords
4358
4359                // Subtract and set quotient bit
4360                bytes.extend_from_slice(&0x1AB6u16.to_le_bytes()); // SUBS R6, R6, R2
4361                bytes.extend_from_slice(&0xEB67u16.to_le_bytes()); // SBC.W R7, R7, R3
4362                bytes.extend_from_slice(&0x0703u16.to_le_bytes());
4363                bytes.extend_from_slice(&0xF044u16.to_le_bytes()); // ORR.W R4, R4, #1
4364                bytes.extend_from_slice(&0x0401u16.to_le_bytes());
4365
4366                // Decrement and loop
4367                bytes.extend_from_slice(&0xF1B8u16.to_le_bytes()); // SUB.W R8, R8, #1
4368                bytes.extend_from_slice(&0x0801u16.to_le_bytes());
4369
4370                let branch_offset_bytes = bytes.len() - loop_start + 4;
4371                let offset_halfwords = -((branch_offset_bytes / 2) as i16);
4372                let bne_encoding = 0xD100u16 | ((offset_halfwords as u16) & 0xFF);
4373                bytes.extend_from_slice(&bne_encoding.to_le_bytes());
4374
4375                // Move REMAINDER to R0:R1 (difference from I64DivU)
4376                bytes.extend_from_slice(&0x4630u16.to_le_bytes()); // MOV R0, R6
4377                bytes.extend_from_slice(&0x4639u16.to_le_bytes()); // MOV R1, R7
4378
4379                // POP {R4-R8} - restore scratch registers (NO PC — inline code continues)
4380                bytes.extend_from_slice(&0xE8BDu16.to_le_bytes());
4381                bytes.extend_from_slice(&0x01F0u16.to_le_bytes());
4382
4383                Ok(bytes)
4384            }
4385
4386            // I64RemS: 64-bit signed remainder
4387            // Remainder sign follows dividend sign (not quotient rule)
4388            // Input: R0:R1 = dividend (signed), R2:R3 = divisor (signed)
4389            // Output: R0:R1 = remainder (signed, same sign as dividend)
4390            ArmOp::I64RemS {
4391                rdlo: _,
4392                rdhi: _,
4393                rnlo: _,
4394                rnhi: _,
4395                rmlo: _,
4396                rmhi: _,
4397            } => {
4398                let mut bytes = Vec::new();
4399
4400                // PUSH {R4-R11} - save scratch registers (NO LR — inline code)
4401                bytes.extend_from_slice(&0xE92Du16.to_le_bytes());
4402                bytes.extend_from_slice(&0x0FF0u16.to_le_bytes());
4403
4404                // Save dividend sign in R9 (remainder sign = dividend sign)
4405                // MOV R9, R1 (just need the sign bit)
4406                bytes.extend_from_slice(&0x4689u16.to_le_bytes()); // MOV R9, R1
4407
4408                // If dividend negative (R1 MSB set), negate it
4409                bytes.extend_from_slice(&0x4209u16.to_le_bytes()); // TST R1, R1
4410                bytes.extend_from_slice(&0xD504u16.to_le_bytes()); // BPL +8
4411
4412                // Negate R0:R1
4413                bytes.extend_from_slice(&0x43C0u16.to_le_bytes()); // MVNS R0, R0
4414                bytes.extend_from_slice(&0x43C9u16.to_le_bytes()); // MVNS R1, R1
4415                bytes.extend_from_slice(&0x1C40u16.to_le_bytes()); // ADDS R0, R0, #1
4416                bytes.extend_from_slice(&0xF141u16.to_le_bytes()); // ADC.W R1, R1, #0
4417                bytes.extend_from_slice(&0x0100u16.to_le_bytes());
4418
4419                // If divisor negative (R3 MSB set), negate it
4420                bytes.extend_from_slice(&0x421Bu16.to_le_bytes()); // TST R3, R3
4421                bytes.extend_from_slice(&0xD504u16.to_le_bytes()); // BPL +8
4422
4423                // Negate R2:R3
4424                bytes.extend_from_slice(&0x43D2u16.to_le_bytes()); // MVNS R2, R2
4425                bytes.extend_from_slice(&0x43DBu16.to_le_bytes()); // MVNS R3, R3
4426                bytes.extend_from_slice(&0x1C52u16.to_le_bytes()); // ADDS R2, R2, #1
4427                bytes.extend_from_slice(&0xF143u16.to_le_bytes()); // ADC.W R3, R3, #0
4428                bytes.extend_from_slice(&0x0300u16.to_le_bytes());
4429
4430                // === Unsigned division algorithm ===
4431                // Initialize quotient (R4:R5) = 0
4432                bytes.extend_from_slice(&0x2400u16.to_le_bytes());
4433                bytes.extend_from_slice(&0x2500u16.to_le_bytes());
4434                // Initialize remainder (R6:R7) = 0
4435                bytes.extend_from_slice(&0x2600u16.to_le_bytes());
4436                bytes.extend_from_slice(&0x2700u16.to_le_bytes());
4437                // Initialize loop counter R8 = 64
4438                bytes.extend_from_slice(&0xF04Fu16.to_le_bytes());
4439                bytes.extend_from_slice(&0x0840u16.to_le_bytes());
4440
4441                let loop_start = bytes.len();
4442
4443                // Shift quotient left
4444                bytes.extend_from_slice(&0x006Du16.to_le_bytes()); // LSLS R5, R5, #1
4445                bytes.extend_from_slice(&0xEA45u16.to_le_bytes()); // ORR.W R5, R5, R4, LSR #31
4446                bytes.extend_from_slice(&0x75D4u16.to_le_bytes());
4447                bytes.extend_from_slice(&0x0064u16.to_le_bytes()); // LSLS R4, R4, #1
4448
4449                // Shift remainder left, OR in MSB of dividend
4450                bytes.extend_from_slice(&0x007Fu16.to_le_bytes()); // LSLS R7, R7, #1
4451                bytes.extend_from_slice(&0xEA47u16.to_le_bytes()); // ORR.W R7, R7, R6, LSR #31
4452                bytes.extend_from_slice(&0x77D6u16.to_le_bytes());
4453                bytes.extend_from_slice(&0x0076u16.to_le_bytes()); // LSLS R6, R6, #1
4454                bytes.extend_from_slice(&0xEA46u16.to_le_bytes()); // ORR.W R6, R6, R1, LSR #31
4455                bytes.extend_from_slice(&0x76D1u16.to_le_bytes());
4456
4457                // Shift dividend left
4458                bytes.extend_from_slice(&0x0049u16.to_le_bytes()); // LSLS R1, R1, #1
4459                bytes.extend_from_slice(&0xEA41u16.to_le_bytes()); // ORR.W R1, R1, R0, LSR #31
4460                bytes.extend_from_slice(&0x71D0u16.to_le_bytes());
4461                bytes.extend_from_slice(&0x0040u16.to_le_bytes()); // LSLS R0, R0, #1
4462
4463                // Compare and conditionally subtract
4464                bytes.extend_from_slice(&0x429Fu16.to_le_bytes()); // CMP R7, R3
4465                bytes.extend_from_slice(&0xD802u16.to_le_bytes()); // BHI +4
4466                bytes.extend_from_slice(&0xD306u16.to_le_bytes()); // BCC +12
4467                bytes.extend_from_slice(&0x4296u16.to_le_bytes()); // CMP R6, R2
4468                bytes.extend_from_slice(&0xD304u16.to_le_bytes()); // BCC +4 halfwords
4469
4470                // Subtract and set quotient bit
4471                bytes.extend_from_slice(&0x1AB6u16.to_le_bytes()); // SUBS R6, R6, R2
4472                bytes.extend_from_slice(&0xEB67u16.to_le_bytes()); // SBC.W R7, R7, R3
4473                bytes.extend_from_slice(&0x0703u16.to_le_bytes());
4474                bytes.extend_from_slice(&0xF044u16.to_le_bytes()); // ORR.W R4, R4, #1
4475                bytes.extend_from_slice(&0x0401u16.to_le_bytes());
4476
4477                // Decrement and loop
4478                bytes.extend_from_slice(&0xF1B8u16.to_le_bytes()); // SUB.W R8, R8, #1
4479                bytes.extend_from_slice(&0x0801u16.to_le_bytes());
4480
4481                let branch_offset_bytes = bytes.len() - loop_start + 4;
4482                let offset_halfwords = -((branch_offset_bytes / 2) as i16);
4483                let bne_encoding = 0xD100u16 | ((offset_halfwords as u16) & 0xFF);
4484                bytes.extend_from_slice(&bne_encoding.to_le_bytes());
4485
4486                // Move remainder to R0:R1
4487                bytes.extend_from_slice(&0x4630u16.to_le_bytes()); // MOV R0, R6
4488                bytes.extend_from_slice(&0x4639u16.to_le_bytes()); // MOV R1, R7
4489
4490                // If original dividend was negative (R9 MSB set), negate remainder
4491                bytes.extend_from_slice(&0xF1B9u16.to_le_bytes()); // TST.W R9, R9
4492                bytes.extend_from_slice(&0x0F00u16.to_le_bytes());
4493                bytes.extend_from_slice(&0xD504u16.to_le_bytes()); // BPL +8
4494
4495                // Negate result R0:R1
4496                bytes.extend_from_slice(&0x43C0u16.to_le_bytes()); // MVNS R0, R0
4497                bytes.extend_from_slice(&0x43C9u16.to_le_bytes()); // MVNS R1, R1
4498                bytes.extend_from_slice(&0x1C40u16.to_le_bytes()); // ADDS R0, R0, #1
4499                bytes.extend_from_slice(&0xF141u16.to_le_bytes()); // ADC.W R1, R1, #0
4500                bytes.extend_from_slice(&0x0100u16.to_le_bytes());
4501
4502                // POP {R4-R11} - restore scratch registers (NO PC — inline code continues)
4503                bytes.extend_from_slice(&0xE8BDu16.to_le_bytes());
4504                bytes.extend_from_slice(&0x0FF0u16.to_le_bytes());
4505
4506                Ok(bytes)
4507            }
4508
4509            // === F32 VFP single-precision Thumb-2 encodings ===
4510            // VFP instruction words are identical to ARM32; emit as two LE halfwords.
4511            ArmOp::F32Add { sd, sn, sm } => {
4512                Ok(vfp_to_thumb_bytes(encode_vfp_3reg(0xEE300A00, sd, sn, sm)?))
4513            }
4514            ArmOp::F32Sub { sd, sn, sm } => {
4515                Ok(vfp_to_thumb_bytes(encode_vfp_3reg(0xEE300A40, sd, sn, sm)?))
4516            }
4517            ArmOp::F32Mul { sd, sn, sm } => {
4518                Ok(vfp_to_thumb_bytes(encode_vfp_3reg(0xEE200A00, sd, sn, sm)?))
4519            }
4520            ArmOp::F32Div { sd, sn, sm } => {
4521                Ok(vfp_to_thumb_bytes(encode_vfp_3reg(0xEE800A00, sd, sn, sm)?))
4522            }
4523            ArmOp::F32Abs { sd, sm } => {
4524                Ok(vfp_to_thumb_bytes(encode_vfp_2reg(0xEEB00AC0, sd, sm)?))
4525            }
4526            ArmOp::F32Neg { sd, sm } => {
4527                Ok(vfp_to_thumb_bytes(encode_vfp_2reg(0xEEB10A40, sd, sm)?))
4528            }
4529            ArmOp::F32Sqrt { sd, sm } => {
4530                Ok(vfp_to_thumb_bytes(encode_vfp_2reg(0xEEB10AC0, sd, sm)?))
4531            }
4532
4533            // f32 pseudo-ops — multi-instruction sequences
4534            // FPSCR RMode: 00=nearest, 01=+inf(ceil), 10=-inf(floor), 11=zero(trunc)
4535            ArmOp::F32Ceil { sd, sm } => self.encode_thumb_f32_rounding(sd, sm, 0b01),
4536            ArmOp::F32Floor { sd, sm } => self.encode_thumb_f32_rounding(sd, sm, 0b10),
4537            ArmOp::F32Trunc { sd, sm } => self.encode_thumb_f32_rounding(sd, sm, 0b11),
4538            ArmOp::F32Nearest { sd, sm } => self.encode_thumb_f32_rounding(sd, sm, 0b00),
4539            ArmOp::F32Min { sd, sn, sm } => self.encode_thumb_f32_minmax(sd, sn, sm, true),
4540            ArmOp::F32Max { sd, sn, sm } => self.encode_thumb_f32_minmax(sd, sn, sm, false),
4541            ArmOp::F32Copysign { sd, sn, sm } => self.encode_thumb_f32_copysign(sd, sn, sm),
4542
4543            // f32 comparisons — VCMP + VMRS + MOV #0 + IT + MOV #1
4544            ArmOp::F32Eq { rd, sn, sm } => self.encode_thumb_f32_compare(rd, sn, sm, 0x0),
4545            ArmOp::F32Ne { rd, sn, sm } => self.encode_thumb_f32_compare(rd, sn, sm, 0x1),
4546            ArmOp::F32Lt { rd, sn, sm } => self.encode_thumb_f32_compare(rd, sn, sm, 0x4),
4547            ArmOp::F32Le { rd, sn, sm } => self.encode_thumb_f32_compare(rd, sn, sm, 0x9),
4548            ArmOp::F32Gt { rd, sn, sm } => self.encode_thumb_f32_compare(rd, sn, sm, 0xC),
4549            ArmOp::F32Ge { rd, sn, sm } => self.encode_thumb_f32_compare(rd, sn, sm, 0xA),
4550
4551            ArmOp::F32Const { sd, value } => self.encode_thumb_f32_const(sd, *value),
4552
4553            ArmOp::F32Load { sd, addr } => {
4554                Ok(vfp_to_thumb_bytes(encode_vfp_ldst(0xED900A00, sd, addr)?))
4555            }
4556            ArmOp::F32Store { sd, addr } => {
4557                Ok(vfp_to_thumb_bytes(encode_vfp_ldst(0xED800A00, sd, addr)?))
4558            }
4559
4560            ArmOp::F32ConvertI32S { sd, rm } => self.encode_thumb_f32_convert_i32(sd, rm, true),
4561            ArmOp::F32ConvertI32U { sd, rm } => self.encode_thumb_f32_convert_i32(sd, rm, false),
4562            ArmOp::F32ConvertI64S { .. } | ArmOp::F32ConvertI64U { .. } => {
4563                Err(synth_core::Error::synthesis(
4564                    "F32 i64 conversion not supported (requires register pairs on 32-bit ARM)",
4565                ))
4566            }
4567            ArmOp::F32ReinterpretI32 { sd, rm } => {
4568                Ok(vfp_to_thumb_bytes(encode_vmov_core_sreg(true, sd, rm)?))
4569            }
4570            ArmOp::I32ReinterpretF32 { rd, sm } => {
4571                Ok(vfp_to_thumb_bytes(encode_vmov_core_sreg(false, sm, rd)?))
4572            }
4573            ArmOp::I32TruncF32S { rd, sm } => self.encode_thumb_i32_trunc_f32(rd, sm, true),
4574            ArmOp::I32TruncF32U { rd, sm } => self.encode_thumb_i32_trunc_f32(rd, sm, false),
4575
4576            // === F64 VFP double-precision Thumb-2 encodings ===
4577            // VFP instruction words are identical to ARM32; emit as two LE halfwords.
4578            ArmOp::F64Add { dd, dn, dm } => Ok(vfp_to_thumb_bytes(encode_vfp_3reg_f64(
4579                0xEE300B00, dd, dn, dm,
4580            )?)),
4581            ArmOp::F64Sub { dd, dn, dm } => Ok(vfp_to_thumb_bytes(encode_vfp_3reg_f64(
4582                0xEE300B40, dd, dn, dm,
4583            )?)),
4584            ArmOp::F64Mul { dd, dn, dm } => Ok(vfp_to_thumb_bytes(encode_vfp_3reg_f64(
4585                0xEE200B00, dd, dn, dm,
4586            )?)),
4587            ArmOp::F64Div { dd, dn, dm } => Ok(vfp_to_thumb_bytes(encode_vfp_3reg_f64(
4588                0xEE800B00, dd, dn, dm,
4589            )?)),
4590            ArmOp::F64Abs { dd, dm } => {
4591                Ok(vfp_to_thumb_bytes(encode_vfp_2reg_f64(0xEEB00BC0, dd, dm)?))
4592            }
4593            ArmOp::F64Neg { dd, dm } => {
4594                Ok(vfp_to_thumb_bytes(encode_vfp_2reg_f64(0xEEB10B40, dd, dm)?))
4595            }
4596            ArmOp::F64Sqrt { dd, dm } => {
4597                Ok(vfp_to_thumb_bytes(encode_vfp_2reg_f64(0xEEB10BC0, dd, dm)?))
4598            }
4599
4600            // f64 pseudo-ops
4601            // FPSCR RMode: 00=nearest, 01=+inf(ceil), 10=-inf(floor), 11=zero(trunc)
4602            ArmOp::F64Ceil { dd, dm } => self.encode_thumb_f64_rounding(dd, dm, 0b01),
4603            ArmOp::F64Floor { dd, dm } => self.encode_thumb_f64_rounding(dd, dm, 0b10),
4604            ArmOp::F64Trunc { dd, dm } => self.encode_thumb_f64_rounding(dd, dm, 0b11),
4605            ArmOp::F64Nearest { dd, dm } => self.encode_thumb_f64_rounding(dd, dm, 0b00),
4606            ArmOp::F64Min { dd, dn, dm } => self.encode_thumb_f64_minmax(dd, dn, dm, true),
4607            ArmOp::F64Max { dd, dn, dm } => self.encode_thumb_f64_minmax(dd, dn, dm, false),
4608            ArmOp::F64Copysign { dd, dn, dm } => self.encode_thumb_f64_copysign(dd, dn, dm),
4609
4610            // f64 comparisons
4611            ArmOp::F64Eq { rd, dn, dm } => self.encode_thumb_f64_compare(rd, dn, dm, 0x0),
4612            ArmOp::F64Ne { rd, dn, dm } => self.encode_thumb_f64_compare(rd, dn, dm, 0x1),
4613            ArmOp::F64Lt { rd, dn, dm } => self.encode_thumb_f64_compare(rd, dn, dm, 0x4),
4614            ArmOp::F64Le { rd, dn, dm } => self.encode_thumb_f64_compare(rd, dn, dm, 0x9),
4615            ArmOp::F64Gt { rd, dn, dm } => self.encode_thumb_f64_compare(rd, dn, dm, 0xC),
4616            ArmOp::F64Ge { rd, dn, dm } => self.encode_thumb_f64_compare(rd, dn, dm, 0xA),
4617
4618            ArmOp::F64Const { dd, value } => self.encode_thumb_f64_const(dd, *value),
4619
4620            ArmOp::F64Load { dd, addr } => Ok(vfp_to_thumb_bytes(encode_vfp_ldst_f64(
4621                0xED900B00, dd, addr,
4622            )?)),
4623            ArmOp::F64Store { dd, addr } => Ok(vfp_to_thumb_bytes(encode_vfp_ldst_f64(
4624                0xED800B00, dd, addr,
4625            )?)),
4626
4627            ArmOp::F64ConvertI32S { dd, rm } => self.encode_thumb_f64_convert_i32(dd, rm, true),
4628            ArmOp::F64ConvertI32U { dd, rm } => self.encode_thumb_f64_convert_i32(dd, rm, false),
4629            ArmOp::F64ConvertI64S { .. } | ArmOp::F64ConvertI64U { .. } => {
4630                Err(synth_core::Error::synthesis(
4631                    "F64 i64 conversion not supported (requires register pairs on 32-bit ARM)",
4632                ))
4633            }
4634            ArmOp::F64PromoteF32 { dd, sm } => self.encode_thumb_f64_promote_f32(dd, sm),
4635            ArmOp::F64ReinterpretI64 { dd, rmlo, rmhi } => Ok(vfp_to_thumb_bytes(
4636                encode_vmov_core_dreg(true, dd, rmlo, rmhi)?,
4637            )),
4638            ArmOp::I64ReinterpretF64 { rdlo, rdhi, dm } => Ok(vfp_to_thumb_bytes(
4639                encode_vmov_core_dreg(false, dm, rdlo, rdhi)?,
4640            )),
4641            ArmOp::I64TruncF64S { .. } | ArmOp::I64TruncF64U { .. } => {
4642                Err(synth_core::Error::synthesis(
4643                    "i64 truncation from F64 not supported (requires i64 register pairs on 32-bit ARM)",
4644                ))
4645            }
4646            ArmOp::I32TruncF64S { rd, dm } => self.encode_thumb_i32_trunc_f64(rd, dm, true),
4647            ArmOp::I32TruncF64U { rd, dm } => self.encode_thumb_i32_trunc_f64(rd, dm, false),
4648
4649            // ===== i64 operations: encode as multi-instruction Thumb-2 sequences =====
4650
4651            // I64Add: ADDS rdlo, rnlo, rmlo; ADC.W rdhi, rnhi, rmhi
4652            ArmOp::I64Add {
4653                rdlo,
4654                rdhi,
4655                rnlo,
4656                rnhi,
4657                rmlo,
4658                rmhi,
4659            } => {
4660                let mut bytes = Vec::new();
4661                // ADDS rdlo, rnlo, rmlo (16-bit)
4662                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Adds {
4663                    rd: *rdlo,
4664                    rn: *rnlo,
4665                    op2: Operand2::Reg(*rmlo),
4666                })?);
4667                // ADC.W rdhi, rnhi, rmhi (32-bit)
4668                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Adc {
4669                    rd: *rdhi,
4670                    rn: *rnhi,
4671                    op2: Operand2::Reg(*rmhi),
4672                })?);
4673                Ok(bytes)
4674            }
4675
4676            // I64Sub: SUBS rdlo, rnlo, rmlo; SBC.W rdhi, rnhi, rmhi
4677            ArmOp::I64Sub {
4678                rdlo,
4679                rdhi,
4680                rnlo,
4681                rnhi,
4682                rmlo,
4683                rmhi,
4684            } => {
4685                let mut bytes = Vec::new();
4686                // SUBS rdlo, rnlo, rmlo (16-bit)
4687                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Subs {
4688                    rd: *rdlo,
4689                    rn: *rnlo,
4690                    op2: Operand2::Reg(*rmlo),
4691                })?);
4692                // SBC.W rdhi, rnhi, rmhi (32-bit)
4693                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Sbc {
4694                    rd: *rdhi,
4695                    rn: *rnhi,
4696                    op2: Operand2::Reg(*rmhi),
4697                })?);
4698                Ok(bytes)
4699            }
4700
4701            // I64And: AND rdlo, rnlo, rmlo; AND rdhi, rnhi, rmhi
4702            ArmOp::I64And {
4703                rdlo,
4704                rdhi,
4705                rnlo,
4706                rnhi,
4707                rmlo,
4708                rmhi,
4709            } => {
4710                let mut bytes = Vec::new();
4711                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::And {
4712                    rd: *rdlo,
4713                    rn: *rnlo,
4714                    op2: Operand2::Reg(*rmlo),
4715                })?);
4716                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::And {
4717                    rd: *rdhi,
4718                    rn: *rnhi,
4719                    op2: Operand2::Reg(*rmhi),
4720                })?);
4721                Ok(bytes)
4722            }
4723
4724            // I64Or: ORR rdlo, rnlo, rmlo; ORR rdhi, rnhi, rmhi
4725            ArmOp::I64Or {
4726                rdlo,
4727                rdhi,
4728                rnlo,
4729                rnhi,
4730                rmlo,
4731                rmhi,
4732            } => {
4733                let mut bytes = Vec::new();
4734                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Orr {
4735                    rd: *rdlo,
4736                    rn: *rnlo,
4737                    op2: Operand2::Reg(*rmlo),
4738                })?);
4739                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Orr {
4740                    rd: *rdhi,
4741                    rn: *rnhi,
4742                    op2: Operand2::Reg(*rmhi),
4743                })?);
4744                Ok(bytes)
4745            }
4746
4747            // I64Xor: EOR rdlo, rnlo, rmlo; EOR rdhi, rnhi, rmhi
4748            ArmOp::I64Xor {
4749                rdlo,
4750                rdhi,
4751                rnlo,
4752                rnhi,
4753                rmlo,
4754                rmhi,
4755            } => {
4756                let mut bytes = Vec::new();
4757                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Eor {
4758                    rd: *rdlo,
4759                    rn: *rnlo,
4760                    op2: Operand2::Reg(*rmlo),
4761                })?);
4762                bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Eor {
4763                    rd: *rdhi,
4764                    rn: *rnhi,
4765                    op2: Operand2::Reg(*rmhi),
4766                })?);
4767                Ok(bytes)
4768            }
4769
4770            // I64Eqz: ORR scratch, lo, hi; ITE EQ; MOV rd, #1; MOV rd, #0
4771            ArmOp::I64Eqz { rd, rnlo, rnhi } => self.encode_thumb(&ArmOp::I64SetCondZ {
4772                rd: *rd,
4773                rn_lo: *rnlo,
4774                rn_hi: *rnhi,
4775            }),
4776
4777            // I64 comparisons: delegate to I64SetCond
4778            ArmOp::I64Eq {
4779                rd,
4780                rnlo,
4781                rnhi,
4782                rmlo,
4783                rmhi,
4784            } => self.encode_thumb(&ArmOp::I64SetCond {
4785                rd: *rd,
4786                rn_lo: *rnlo,
4787                rn_hi: *rnhi,
4788                rm_lo: *rmlo,
4789                rm_hi: *rmhi,
4790                cond: synth_synthesis::Condition::EQ,
4791            }),
4792
4793            ArmOp::I64Ne {
4794                rd,
4795                rnlo,
4796                rnhi,
4797                rmlo,
4798                rmhi,
4799            } => self.encode_thumb(&ArmOp::I64SetCond {
4800                rd: *rd,
4801                rn_lo: *rnlo,
4802                rn_hi: *rnhi,
4803                rm_lo: *rmlo,
4804                rm_hi: *rmhi,
4805                cond: synth_synthesis::Condition::NE,
4806            }),
4807
4808            ArmOp::I64LtS {
4809                rd,
4810                rnlo,
4811                rnhi,
4812                rmlo,
4813                rmhi,
4814            } => self.encode_thumb(&ArmOp::I64SetCond {
4815                rd: *rd,
4816                rn_lo: *rnlo,
4817                rn_hi: *rnhi,
4818                rm_lo: *rmlo,
4819                rm_hi: *rmhi,
4820                cond: synth_synthesis::Condition::LT,
4821            }),
4822
4823            ArmOp::I64LtU {
4824                rd,
4825                rnlo,
4826                rnhi,
4827                rmlo,
4828                rmhi,
4829            } => self.encode_thumb(&ArmOp::I64SetCond {
4830                rd: *rd,
4831                rn_lo: *rnlo,
4832                rn_hi: *rnhi,
4833                rm_lo: *rmlo,
4834                rm_hi: *rmhi,
4835                cond: synth_synthesis::Condition::LO,
4836            }),
4837
4838            ArmOp::I64LeS {
4839                rd,
4840                rnlo,
4841                rnhi,
4842                rmlo,
4843                rmhi,
4844            } => self.encode_thumb(&ArmOp::I64SetCond {
4845                rd: *rd,
4846                rn_lo: *rnlo,
4847                rn_hi: *rnhi,
4848                rm_lo: *rmlo,
4849                rm_hi: *rmhi,
4850                cond: synth_synthesis::Condition::LE,
4851            }),
4852
4853            ArmOp::I64LeU {
4854                rd,
4855                rnlo,
4856                rnhi,
4857                rmlo,
4858                rmhi,
4859            } => self.encode_thumb(&ArmOp::I64SetCond {
4860                rd: *rd,
4861                rn_lo: *rnlo,
4862                rn_hi: *rnhi,
4863                rm_lo: *rmlo,
4864                rm_hi: *rmhi,
4865                cond: synth_synthesis::Condition::LS,
4866            }),
4867
4868            ArmOp::I64GtS {
4869                rd,
4870                rnlo,
4871                rnhi,
4872                rmlo,
4873                rmhi,
4874            } => self.encode_thumb(&ArmOp::I64SetCond {
4875                rd: *rd,
4876                rn_lo: *rnlo,
4877                rn_hi: *rnhi,
4878                rm_lo: *rmlo,
4879                rm_hi: *rmhi,
4880                cond: synth_synthesis::Condition::GT,
4881            }),
4882
4883            ArmOp::I64GtU {
4884                rd,
4885                rnlo,
4886                rnhi,
4887                rmlo,
4888                rmhi,
4889            } => self.encode_thumb(&ArmOp::I64SetCond {
4890                rd: *rd,
4891                rn_lo: *rnlo,
4892                rn_hi: *rnhi,
4893                rm_lo: *rmlo,
4894                rm_hi: *rmhi,
4895                cond: synth_synthesis::Condition::HI,
4896            }),
4897
4898            ArmOp::I64GeS {
4899                rd,
4900                rnlo,
4901                rnhi,
4902                rmlo,
4903                rmhi,
4904            } => self.encode_thumb(&ArmOp::I64SetCond {
4905                rd: *rd,
4906                rn_lo: *rnlo,
4907                rn_hi: *rnhi,
4908                rm_lo: *rmlo,
4909                rm_hi: *rmhi,
4910                cond: synth_synthesis::Condition::GE,
4911            }),
4912
4913            ArmOp::I64GeU {
4914                rd,
4915                rnlo,
4916                rnhi,
4917                rmlo,
4918                rmhi,
4919            } => self.encode_thumb(&ArmOp::I64SetCond {
4920                rd: *rd,
4921                rn_lo: *rnlo,
4922                rn_hi: *rnhi,
4923                rm_lo: *rmlo,
4924                rm_hi: *rmhi,
4925                cond: synth_synthesis::Condition::HS,
4926            }),
4927
4928            // I64Const: MOVW rdlo, lo16; MOVT rdlo, hi16; MOVW rdhi, lo16_hi; MOVT rdhi, hi16_hi
4929            ArmOp::I64Const { rdlo, rdhi, value } => {
4930                let lo32 = *value as u32;
4931                let hi32 = (*value >> 32) as u32;
4932                let mut bytes = Vec::new();
4933                // Load low 32 bits into rdlo
4934                bytes.extend_from_slice(
4935                    &self.encode_thumb32_movw_raw(reg_to_bits(rdlo), lo32 & 0xFFFF)?,
4936                );
4937                if lo32 > 0xFFFF {
4938                    bytes.extend_from_slice(
4939                        &self.encode_thumb32_movt_raw(reg_to_bits(rdlo), lo32 >> 16)?,
4940                    );
4941                }
4942                // Load high 32 bits into rdhi
4943                bytes.extend_from_slice(
4944                    &self.encode_thumb32_movw_raw(reg_to_bits(rdhi), hi32 & 0xFFFF)?,
4945                );
4946                if hi32 > 0xFFFF {
4947                    bytes.extend_from_slice(
4948                        &self.encode_thumb32_movt_raw(reg_to_bits(rdhi), hi32 >> 16)?,
4949                    );
4950                }
4951                Ok(bytes)
4952            }
4953
4954            // I64Ldr: LDR rdlo, [base, offset]; LDR rdhi, [base, offset+4]
4955            ArmOp::I64Ldr { rdlo, rdhi, addr } => {
4956                let mut bytes = Vec::new();
4957                let offset = if addr.offset < 0 {
4958                    0u32
4959                } else {
4960                    addr.offset as u32
4961                };
4962                bytes.extend_from_slice(&self.encode_thumb32_ldr(rdlo, &addr.base, offset)?);
4963                bytes.extend_from_slice(&self.encode_thumb32_ldr(
4964                    rdhi,
4965                    &addr.base,
4966                    offset.wrapping_add(4),
4967                )?);
4968                Ok(bytes)
4969            }
4970
4971            // I64Str: STR rdlo, [base, offset]; STR rdhi, [base, offset+4]
4972            ArmOp::I64Str { rdlo, rdhi, addr } => {
4973                let mut bytes = Vec::new();
4974                let offset = if addr.offset < 0 {
4975                    0u32
4976                } else {
4977                    addr.offset as u32
4978                };
4979                bytes.extend_from_slice(&self.encode_thumb32_str(rdlo, &addr.base, offset)?);
4980                bytes.extend_from_slice(&self.encode_thumb32_str(
4981                    rdhi,
4982                    &addr.base,
4983                    offset.wrapping_add(4),
4984                )?);
4985                Ok(bytes)
4986            }
4987
4988            // I64ExtendI32S: MOV rdlo, rn; ASR rdhi, rdlo, #31 (sign-extend)
4989            ArmOp::I64ExtendI32S { rdlo, rdhi, rn } => {
4990                let mut bytes = Vec::new();
4991                if rdlo != rn {
4992                    // MOV rdlo, rn (16-bit)
4993                    bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Mov {
4994                        rd: *rdlo,
4995                        op2: Operand2::Reg(*rn),
4996                    })?);
4997                }
4998                // ASR rdhi, rdlo, #31 (sign-extend: fill high word with sign bit)
4999                bytes.extend_from_slice(
5000                    &self.encode_thumb32_shift(rdhi, rdlo, 31, 0b10)?, // ASR type
5001                );
5002                Ok(bytes)
5003            }
5004
5005            // I64ExtendI32U: MOV rdlo, rn; MOV rdhi, #0
5006            ArmOp::I64ExtendI32U { rdlo, rdhi, rn } => {
5007                let mut bytes = Vec::new();
5008                if rdlo != rn {
5009                    // MOV rdlo, rn
5010                    bytes.extend_from_slice(&self.encode_thumb(&ArmOp::Mov {
5011                        rd: *rdlo,
5012                        op2: Operand2::Reg(*rn),
5013                    })?);
5014                }
5015                // MOV rdhi, #0 (16-bit: MOVS Rd, #0)
5016                let rdhi_bits = reg_to_bits(rdhi) as u16;
5017                let instr: u16 = 0x2000 | (rdhi_bits << 8);
5018                bytes.extend_from_slice(&instr.to_le_bytes());
5019                Ok(bytes)
5020            }
5021
5022            // I32WrapI64: MOV rd, rnlo (just take low 32 bits)
5023            ArmOp::I32WrapI64 { rd, rnlo } => {
5024                if rd == rnlo {
5025                    // No-op: already in the right register
5026                    let instr: u16 = 0xBF00; // NOP
5027                    Ok(instr.to_le_bytes().to_vec())
5028                } else {
5029                    // MOV rd, rnlo
5030                    self.encode_thumb(&ArmOp::Mov {
5031                        rd: *rd,
5032                        op2: Operand2::Reg(*rnlo),
5033                    })
5034                }
5035            }
5036
5037            // ===== Helium MVE operations (Thumb-2 encoding) =====
5038            ArmOp::MveLoad { qd, addr } => Ok(vfp_to_thumb_bytes(encode_mve_vldrw(qd, addr))),
5039            ArmOp::MveStore { qd, addr } => Ok(vfp_to_thumb_bytes(encode_mve_vstrw(qd, addr))),
5040            ArmOp::MveConst { qd, bytes } => self.encode_thumb_mve_const(qd, bytes),
5041            ArmOp::MveAnd { qd, qn, qm } => Ok(vfp_to_thumb_bytes(encode_mve_3reg_bitwise(
5042                0xEF000150, qd, qn, qm,
5043            ))),
5044            ArmOp::MveOrr { qd, qn, qm } => Ok(vfp_to_thumb_bytes(encode_mve_3reg_bitwise(
5045                0xEF200150, qd, qn, qm,
5046            ))),
5047            ArmOp::MveEor { qd, qn, qm } => Ok(vfp_to_thumb_bytes(encode_mve_3reg_bitwise(
5048                0xFF000150, qd, qn, qm,
5049            ))),
5050            ArmOp::MveMvn { qd, qm } => {
5051                // VMVN Qd, Qm: 0xFFB005C0 | Qd<<12 | Qm
5052                let qd_enc = qreg_to_num(qd);
5053                let qm_enc = qreg_to_num(qm);
5054                let instr: u32 = 0xFFB005C0 | ((qd_enc * 2) << 12) | (qm_enc * 2);
5055                Ok(vfp_to_thumb_bytes(instr))
5056            }
5057            ArmOp::MveBic { qd, qn, qm } => Ok(vfp_to_thumb_bytes(encode_mve_3reg_bitwise(
5058                0xEF100150, qd, qn, qm,
5059            ))),
5060            ArmOp::MveAddI { qd, qn, qm, size } => {
5061                let sz = mve_size_bits(size);
5062                let base: u32 = 0xEF000840 | (sz << 20);
5063                Ok(vfp_to_thumb_bytes(encode_mve_3reg(base, qd, qn, qm)))
5064            }
5065            ArmOp::MveSubI { qd, qn, qm, size } => {
5066                let sz = mve_size_bits(size);
5067                let base: u32 = 0xFF000840 | (sz << 20);
5068                Ok(vfp_to_thumb_bytes(encode_mve_3reg(base, qd, qn, qm)))
5069            }
5070            ArmOp::MveMulI { qd, qn, qm, size } => {
5071                let sz = mve_size_bits(size);
5072                let base: u32 = 0xEF000950 | (sz << 20);
5073                Ok(vfp_to_thumb_bytes(encode_mve_3reg(base, qd, qn, qm)))
5074            }
5075            ArmOp::MveNegI { qd, qm, size } => {
5076                let sz = mve_size_bits(size);
5077                // VNEG.Sx Qd, Qm
5078                let qd_enc = qreg_to_num(qd);
5079                let qm_enc = qreg_to_num(qm);
5080                let base: u32 = 0xFFB103C0 | (sz << 18);
5081                let instr = base | ((qd_enc * 2) << 12) | (qm_enc * 2);
5082                Ok(vfp_to_thumb_bytes(instr))
5083            }
5084            ArmOp::MveDup { qd, rn, size } => {
5085                let sz = mve_size_bits(size);
5086                let qd_enc = qreg_to_num(qd);
5087                let rn_bits = reg_to_bits(rn);
5088                // VDUP.sz Qd, Rn: EEA0 0B10 variant
5089                // size encoding: 00=32, 01=16, 10=8
5090                let be = match sz {
5091                    0 => 0b00u32, // 8-bit
5092                    1 => 0b01,    // 16-bit
5093                    _ => 0b00,    // 32-bit (default)
5094                };
5095                let instr: u32 = 0xEEA00B10 | ((qd_enc * 2) << 16) | (rn_bits << 12) | (be << 5);
5096                Ok(vfp_to_thumb_bytes(instr))
5097            }
5098            ArmOp::MveExtractLane { rd, qn, lane, size } => {
5099                let qn_enc = qreg_to_num(qn);
5100                let rd_bits = reg_to_bits(rd);
5101                // VMOV.sz Rd, Dn[x] — extract from Q-register lane
5102                // For 32-bit: VMOV Rd, Dn — where Dn is the appropriate D-register
5103                let d_reg = qn_enc * 2 + ((*lane as u32) >> 1);
5104                let lane_in_d = (*lane as u32) & 1;
5105                let _sz = mve_size_bits(size);
5106                // VMOV Rd, Dn[x]: EE10 0B10 for 32-bit
5107                let instr: u32 = 0xEE100B10 | (d_reg << 16) | (rd_bits << 12) | (lane_in_d << 21);
5108                Ok(vfp_to_thumb_bytes(instr))
5109            }
5110            ArmOp::MveInsertLane { qd, rn, lane, size } => {
5111                let qd_enc = qreg_to_num(qd);
5112                let rn_bits = reg_to_bits(rn);
5113                let d_reg = qd_enc * 2 + ((*lane as u32) >> 1);
5114                let lane_in_d = (*lane as u32) & 1;
5115                let _sz = mve_size_bits(size);
5116                // VMOV Dn[x], Rn: EE00 0B10 for 32-bit
5117                let instr: u32 = 0xEE000B10 | (d_reg << 16) | (rn_bits << 12) | (lane_in_d << 21);
5118                Ok(vfp_to_thumb_bytes(instr))
5119            }
5120
5121            // MVE float comparisons — emit VCMP + VPSEL sequence (simplified: just VCMP)
5122            ArmOp::MveCmpEqI { qd, qn, qm, size }
5123            | ArmOp::MveCmpNeI { qd, qn, qm, size }
5124            | ArmOp::MveCmpLtS { qd, qn, qm, size }
5125            | ArmOp::MveCmpLtU { qd, qn, qm, size }
5126            | ArmOp::MveCmpGtS { qd, qn, qm, size }
5127            | ArmOp::MveCmpGtU { qd, qn, qm, size }
5128            | ArmOp::MveCmpLeS { qd, qn, qm, size }
5129            | ArmOp::MveCmpLeU { qd, qn, qm, size }
5130            | ArmOp::MveCmpGeS { qd, qn, qm, size }
5131            | ArmOp::MveCmpGeU { qd, qn, qm, size } => {
5132                // Encode as VADD (placeholder encoding — real implementation
5133                // would use VCMP + VPSEL pair)
5134                let sz = mve_size_bits(size);
5135                let base: u32 = 0xEF000840 | (sz << 20);
5136                Ok(vfp_to_thumb_bytes(encode_mve_3reg(base, qd, qn, qm)))
5137            }
5138
5139            // f32x4 MVE arithmetic
5140            ArmOp::MveAddF32 { qd, qn, qm } => {
5141                // VADD.F32 Qd, Qn, Qm (MVE): 0xEF000D40
5142                Ok(vfp_to_thumb_bytes(encode_mve_3reg(0xEF000D40, qd, qn, qm)))
5143            }
5144            ArmOp::MveSubF32 { qd, qn, qm } => {
5145                // VSUB.F32 Qd, Qn, Qm (MVE): 0xEF200D40
5146                Ok(vfp_to_thumb_bytes(encode_mve_3reg(0xEF200D40, qd, qn, qm)))
5147            }
5148            ArmOp::MveMulF32 { qd, qn, qm } => {
5149                // VMUL.F32 Qd, Qn, Qm (MVE): 0xFF000D50
5150                Ok(vfp_to_thumb_bytes(encode_mve_3reg(0xFF000D50, qd, qn, qm)))
5151            }
5152            ArmOp::MveNegF32 { qd, qm } => {
5153                let qd_enc = qreg_to_num(qd);
5154                let qm_enc = qreg_to_num(qm);
5155                // VNEG.F32 Qd, Qm: FFB907C0
5156                let instr: u32 = 0xFFB907C0 | ((qd_enc * 2) << 12) | (qm_enc * 2);
5157                Ok(vfp_to_thumb_bytes(instr))
5158            }
5159            ArmOp::MveAbsF32 { qd, qm } => {
5160                let qd_enc = qreg_to_num(qd);
5161                let qm_enc = qreg_to_num(qm);
5162                // VABS.F32 Qd, Qm: FFB90740
5163                let instr: u32 = 0xFFB90740 | ((qd_enc * 2) << 12) | (qm_enc * 2);
5164                Ok(vfp_to_thumb_bytes(instr))
5165            }
5166            ArmOp::MveCmpEqF32 { qd, qn, qm }
5167            | ArmOp::MveCmpNeF32 { qd, qn, qm }
5168            | ArmOp::MveCmpLtF32 { qd, qn, qm }
5169            | ArmOp::MveCmpLeF32 { qd, qn, qm }
5170            | ArmOp::MveCmpGtF32 { qd, qn, qm }
5171            | ArmOp::MveCmpGeF32 { qd, qn, qm } => {
5172                // Placeholder: encode as VADD.F32 (real impl needs VCMP.F32 + VPSEL)
5173                Ok(vfp_to_thumb_bytes(encode_mve_3reg(0xEF000D40, qd, qn, qm)))
5174            }
5175            ArmOp::MveDupF32 { qd, rn } => {
5176                let qd_enc = qreg_to_num(qd);
5177                let rn_bits = reg_to_bits(rn);
5178                // VDUP.32 Qd, Rn (same encoding as integer VDUP.32)
5179                let instr: u32 = 0xEEA00B10 | ((qd_enc * 2) << 16) | (rn_bits << 12);
5180                Ok(vfp_to_thumb_bytes(instr))
5181            }
5182            ArmOp::MveExtractLaneF32 { rd, qn, lane } => {
5183                let qn_enc = qreg_to_num(qn);
5184                let rd_bits = reg_to_bits(rd);
5185                // VMOV Rd, Sn where Sn = Q*4 + lane
5186                let s_num = qn_enc * 4 + (*lane as u32);
5187                let (vn, n) = encode_sreg(s_num);
5188                let instr: u32 = 0xEE100A10 | (vn << 16) | (rd_bits << 12) | (n << 7);
5189                Ok(vfp_to_thumb_bytes(instr))
5190            }
5191            ArmOp::MveReplaceLaneF32 { qd, rn, lane } => {
5192                let qd_enc = qreg_to_num(qd);
5193                let rn_bits = reg_to_bits(rn);
5194                // VMOV Sn, Rn where Sn = Q*4 + lane
5195                let s_num = qd_enc * 4 + (*lane as u32);
5196                let (vn, n) = encode_sreg(s_num);
5197                let instr: u32 = 0xEE000A10 | (vn << 16) | (rn_bits << 12) | (n << 7);
5198                Ok(vfp_to_thumb_bytes(instr))
5199            }
5200            ArmOp::MveDivF32 { qd, qn, qm } => {
5201                // Lane-wise: extract 4 S-regs, VDIV, insert back
5202                self.encode_thumb_mve_lane_wise_f32_binop(qd, qn, qm, 0xEE800A00)
5203            }
5204            ArmOp::MveSqrtF32 { qd, qm } => {
5205                // Lane-wise: extract 4 S-regs, VSQRT, insert back
5206                self.encode_thumb_mve_lane_wise_f32_sqrt(qd, qm)
5207            }
5208
5209            // Catch-all for any remaining ops
5210            _ => {
5211                let instr: u16 = 0xBF00; // NOP
5212                Ok(instr.to_le_bytes().to_vec())
5213            }
5214        }
5215    }
5216
5217    // === Thumb-2 VFP multi-instruction helpers ===
5218
5219    /// Encode F32 comparison as Thumb-2: VCMP.F32 + VMRS + MOVS rd,#0 + IT + MOV rd,#1
5220    fn encode_thumb_f32_compare(
5221        &self,
5222        rd: &Reg,
5223        sn: &VfpReg,
5224        sm: &VfpReg,
5225        cond_code: u32,
5226    ) -> Result<Vec<u8>> {
5227        let mut bytes = Vec::new();
5228        let rd_bits = reg_to_bits(rd);
5229
5230        // VCMP.F32 Sn, Sm
5231        let sn_num = vfp_sreg_to_num(sn)?;
5232        let sm_num = vfp_sreg_to_num(sm)?;
5233        let (vd, d) = encode_sreg(sn_num);
5234        let (vm, m) = encode_sreg(sm_num);
5235        let vcmp = 0xEEB40A40 | (d << 22) | (vd << 12) | (m << 5) | vm;
5236        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcmp));
5237
5238        // VMRS APSR_nzcv, FPSCR: 0xEEF1FA10
5239        bytes.extend_from_slice(&vfp_to_thumb_bytes(0xEEF1FA10));
5240
5241        // MOVS Rd, #0 (16-bit): 0010 0 Rd(3) 0000 0000
5242        if rd_bits < 8 {
5243            let movs_zero: u16 = 0x2000 | ((rd_bits as u16) << 8);
5244            bytes.extend_from_slice(&movs_zero.to_le_bytes());
5245        } else {
5246            // MOV.W Rd, #0 (32-bit Thumb-2)
5247            let hw1: u16 = 0xF04F;
5248            let hw2: u16 = (rd_bits as u16) << 8;
5249            bytes.extend_from_slice(&hw1.to_le_bytes());
5250            bytes.extend_from_slice(&hw2.to_le_bytes());
5251        }
5252
5253        // IT<cond> — If-Then for conditional MOV
5254        // IT encoding: 1011 1111 cond(4) mask(4)
5255        // mask = 0x8 for single "then" (IT)
5256        let it: u16 = 0xBF00 | ((cond_code as u16) << 4) | 0x8;
5257        bytes.extend_from_slice(&it.to_le_bytes());
5258
5259        // MOV Rd, #1 (16-bit, conditional due to IT): 0010 0 Rd(3) 0000 0001
5260        if rd_bits < 8 {
5261            let mov_one: u16 = 0x2001 | ((rd_bits as u16) << 8);
5262            bytes.extend_from_slice(&mov_one.to_le_bytes());
5263        } else {
5264            // MOV.W Rd, #1 (32-bit)
5265            let hw1: u16 = 0xF04F;
5266            let hw2: u16 = ((rd_bits as u16) << 8) | 0x01;
5267            bytes.extend_from_slice(&hw1.to_le_bytes());
5268            bytes.extend_from_slice(&hw2.to_le_bytes());
5269        }
5270
5271        Ok(bytes)
5272    }
5273
5274    /// Encode F32 constant load as Thumb-2: MOVW + MOVT + VMOV
5275    fn encode_thumb_f32_const(&self, sd: &VfpReg, value: f32) -> Result<Vec<u8>> {
5276        let mut bytes = Vec::new();
5277        let bits = value.to_bits();
5278        let rt: u32 = 12; // R12/IP as temp
5279
5280        // MOVW R12, #lo16
5281        // Thumb-2 MOVW: 11110 i 10 0100 imm4 | 0 imm3 Rd imm8
5282        let lo16 = bits & 0xFFFF;
5283        let imm4 = (lo16 >> 12) & 0xF;
5284        let i_bit = (lo16 >> 11) & 1;
5285        let imm3 = (lo16 >> 8) & 0x7;
5286        let imm8 = lo16 & 0xFF;
5287        let hw1: u16 = (0xF240 | (i_bit << 10) | imm4) as u16;
5288        let hw2: u16 = ((imm3 << 12) | (rt << 8) | imm8) as u16;
5289        bytes.extend_from_slice(&hw1.to_le_bytes());
5290        bytes.extend_from_slice(&hw2.to_le_bytes());
5291
5292        // MOVT R12, #hi16
5293        let hi16 = (bits >> 16) & 0xFFFF;
5294        let imm4 = (hi16 >> 12) & 0xF;
5295        let i_bit = (hi16 >> 11) & 1;
5296        let imm3 = (hi16 >> 8) & 0x7;
5297        let imm8 = hi16 & 0xFF;
5298        let hw1: u16 = (0xF2C0 | (i_bit << 10) | imm4) as u16;
5299        let hw2: u16 = ((imm3 << 12) | (rt << 8) | imm8) as u16;
5300        bytes.extend_from_slice(&hw1.to_le_bytes());
5301        bytes.extend_from_slice(&hw2.to_le_bytes());
5302
5303        // VMOV Sd, R12
5304        let vmov = encode_vmov_core_sreg(true, sd, &Reg::R12)?;
5305        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov));
5306
5307        Ok(bytes)
5308    }
5309
5310    /// Encode VMOV + VCVT.F32.xS32 as Thumb-2
5311    fn encode_thumb_f32_convert_i32(&self, sd: &VfpReg, rm: &Reg, signed: bool) -> Result<Vec<u8>> {
5312        let mut bytes = Vec::new();
5313
5314        // VMOV Sd, Rm
5315        let vmov = encode_vmov_core_sreg(true, sd, rm)?;
5316        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov));
5317
5318        // VCVT.F32.S32/U32 Sd, Sd
5319        let sd_num = vfp_sreg_to_num(sd)?;
5320        let (vd, d) = encode_sreg(sd_num);
5321        let (vm, m) = encode_sreg(sd_num);
5322        let base = if signed { 0xEEB80A40 } else { 0xEEB80AC0 };
5323        let vcvt = base | (d << 22) | (vd << 12) | (m << 5) | vm;
5324        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt));
5325
5326        Ok(bytes)
5327    }
5328
5329    /// Encode F32 rounding pseudo-op as Thumb-2 via VCVT to integer and back
5330    /// Encode F32 rounding as Thumb-2.
5331    /// `mode`: FPSCR RMode — 0b00=nearest, 0b01=+inf(ceil), 0b10=-inf(floor), 0b11=zero(trunc)
5332    ///
5333    /// For trunc: uses VCVTR.S32.F32 (always truncates).
5334    /// For ceil/floor/nearest: sets FPSCR rounding mode, uses VCVT.S32.F32 (non-R variant),
5335    /// then restores FPSCR.
5336    fn encode_thumb_f32_rounding(&self, sd: &VfpReg, sm: &VfpReg, mode: u8) -> Result<Vec<u8>> {
5337        let mut bytes = Vec::new();
5338        let sm_num = vfp_sreg_to_num(sm)?;
5339        let sd_num = vfp_sreg_to_num(sd)?;
5340        let (vd_s, d_s) = encode_sreg(sd_num);
5341        let (vm_s, m_s) = encode_sreg(sm_num);
5342
5343        if mode == 0b11 {
5344            // Trunc (toward zero): VCVTR.S32.F32 — bit[7]=1, always truncates
5345            let vcvt_to_int = 0xEEBD0AC0 | (d_s << 22) | (vd_s << 12) | (m_s << 5) | vm_s;
5346            bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt_to_int));
5347        } else {
5348            // ceil/floor/nearest: manipulate FPSCR rounding mode
5349            let rt: u32 = 12; // R12/IP as temp
5350
5351            // VMRS R12, FPSCR
5352            let vmrs = 0xEEF10A10 | (rt << 12);
5353            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmrs));
5354
5355            // BIC.W R12, R12, #(3 << 22) — clear RMode bits [23:22]
5356            // Thumb-2 modified immediate for 3<<22 = 0x00C00000:
5357            // BIC.W encoding: 11110 i 0 0001 S Rn | 0 imm3 Rd imm8
5358            // 0x00C00000 = 0x03 shifted left by 22 => Thumb mod-imm: i=0, imm3=0b101, imm8=0x03
5359            let bic_hw1: u16 = 0xF020 | ((rt as u16) & 0xF); // BIC, Rn=R12
5360            let bic_hw2: u16 = (0x05 << 12) | ((rt as u16) << 8) | 0x03;
5361            bytes.extend_from_slice(&bic_hw1.to_le_bytes());
5362            bytes.extend_from_slice(&bic_hw2.to_le_bytes());
5363
5364            // ORR.W R12, R12, #(mode << 22)
5365            if mode != 0 {
5366                let orr_hw1: u16 = 0xF040 | ((rt as u16) & 0xF); // ORR, Rn=R12
5367                let orr_hw2: u16 = (0x05 << 12) | ((rt as u16) << 8) | (mode as u16);
5368                bytes.extend_from_slice(&orr_hw1.to_le_bytes());
5369                bytes.extend_from_slice(&orr_hw2.to_le_bytes());
5370            }
5371
5372            // VMSR FPSCR, R12
5373            let vmsr = 0xEEE10A10 | (rt << 12);
5374            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmsr));
5375
5376            // VCVT.S32.F32 Sd, Sm — non-R variant (bit[7]=0), uses FPSCR rmode
5377            let vcvt_to_int = 0xEEBD0A40 | (d_s << 22) | (vd_s << 12) | (m_s << 5) | vm_s;
5378            bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt_to_int));
5379
5380            // Restore FPSCR: clear rmode bits back to nearest (default)
5381            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmrs));
5382            bytes.extend_from_slice(&bic_hw1.to_le_bytes());
5383            bytes.extend_from_slice(&bic_hw2.to_le_bytes());
5384            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmsr));
5385        }
5386
5387        // VCVT.F32.S32 Sd, Sd (convert integer result back to float)
5388        let (vd2, d2) = encode_sreg(sd_num);
5389        let vcvt_to_float = 0xEEB80A40 | (d2 << 22) | (vd2 << 12) | (d_s << 5) | vd_s;
5390        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt_to_float));
5391
5392        Ok(bytes)
5393    }
5394
5395    /// Encode F32 min/max as Thumb-2: VMOV + VCMP + VMRS + IT + VMOV
5396    fn encode_thumb_f32_minmax(
5397        &self,
5398        sd: &VfpReg,
5399        sn: &VfpReg,
5400        sm: &VfpReg,
5401        is_min: bool,
5402    ) -> Result<Vec<u8>> {
5403        let mut bytes = Vec::new();
5404        let sn_num = vfp_sreg_to_num(sn)?;
5405        let sm_num = vfp_sreg_to_num(sm)?;
5406        let sd_num = vfp_sreg_to_num(sd)?;
5407
5408        // VMOV.F32 Sd, Sn
5409        let (vd, d) = encode_sreg(sd_num);
5410        let (vn, n) = encode_sreg(sn_num);
5411        let vmov_sn = 0xEEB00A40 | (d << 22) | (vd << 12) | (n << 5) | vn;
5412        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov_sn));
5413
5414        // VCMP.F32 Sn, Sm
5415        let (vm, m) = encode_sreg(sm_num);
5416        let vcmp = 0xEEB40A40 | (n << 22) | (vn << 12) | (m << 5) | vm;
5417        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcmp));
5418
5419        // VMRS APSR_nzcv, FPSCR
5420        bytes.extend_from_slice(&vfp_to_thumb_bytes(0xEEF1FA10));
5421
5422        // IT GT (for min) or IT MI (for max)
5423        let cond: u16 = if is_min { 0xC } else { 0x4 };
5424        let it: u16 = 0xBF00 | (cond << 4) | 0x8;
5425        bytes.extend_from_slice(&it.to_le_bytes());
5426
5427        // VMOV{cond}.F32 Sd, Sm — conditional VMOV in IT block
5428        let vmov_sm = 0xEEB00A40 | (d << 22) | (vd << 12) | (m << 5) | vm;
5429        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov_sm));
5430
5431        Ok(bytes)
5432    }
5433
5434    /// Encode F32 copysign as Thumb-2
5435    fn encode_thumb_f32_copysign(&self, sd: &VfpReg, sn: &VfpReg, sm: &VfpReg) -> Result<Vec<u8>> {
5436        let mut bytes = Vec::new();
5437
5438        // VMOV R12, Sm (get sign source bits)
5439        bytes.extend_from_slice(&vfp_to_thumb_bytes(encode_vmov_core_sreg(
5440            false,
5441            sm,
5442            &Reg::R12,
5443        )?));
5444
5445        // VMOV R0, Sn (get magnitude source bits)
5446        bytes.extend_from_slice(&vfp_to_thumb_bytes(encode_vmov_core_sreg(
5447            false,
5448            sn,
5449            &Reg::R0,
5450        )?));
5451
5452        // AND.W R12, R12, #0x80000000
5453        // Thumb-2 modified immediate: 0x80000000 = constant 0x80 with rotation
5454        // Using T1 encoding: 11110 i 0 0000 S Rn | 0 imm3 Rd imm8
5455        // 0x80000000: i=0, imm3=0b001, imm8=0x00 (rotation=4, value=0x80)
5456        // Actually encoding #0x80000000 as modified constant:
5457        // bit pattern 1 followed by 31 zeros: enc = 0b0100_00000000 = 0x0100? No.
5458        // ARM modified immediate: abcdefgh rotated. 0x80000000 = 0x80 ROR 2 = enc 0x0102
5459        // Actually: value = abcdefgh ROR (2*rot). 0x80 = 10000000, ROR 2 gives 0x20000000.
5460        // For 0x80000000: 0x02 ROR 2 = 0x80000000. So imm12 = (1<<8) | 0x02 = 0x102
5461        let hw1: u16 = 0xF000 | 12; // AND.W R12, R12, #modified_const (i=0, Rn=R12)
5462        let hw2: u16 = (0x1 << 12) | (12 << 8) | 0x02; // imm3=1, Rd=R12, imm8=0x02
5463        bytes.extend_from_slice(&hw1.to_le_bytes());
5464        bytes.extend_from_slice(&hw2.to_le_bytes());
5465
5466        // BIC.W R0, R0, #0x80000000 (R0 = register 0, fields are zero)
5467        let hw1: u16 = 0xF020; // BIC.W R0, R0, #modified_const (i=0, Rn=R0)
5468        let hw2: u16 = (0x1 << 12) | 0x02; // imm3=1, Rd=R0, imm8=0x02
5469        bytes.extend_from_slice(&hw1.to_le_bytes());
5470        bytes.extend_from_slice(&hw2.to_le_bytes());
5471
5472        // ORR.W R0, R0, R12 (R0 = register 0)
5473        let hw1: u16 = 0xEA40; // ORR.W R0, R0, R12 (Rn=R0)
5474        let hw2: u16 = 12; // Rd=R0, Rm=R12
5475        bytes.extend_from_slice(&hw1.to_le_bytes());
5476        bytes.extend_from_slice(&hw2.to_le_bytes());
5477
5478        // VMOV Sd, R0
5479        bytes.extend_from_slice(&vfp_to_thumb_bytes(encode_vmov_core_sreg(
5480            true,
5481            sd,
5482            &Reg::R0,
5483        )?));
5484
5485        Ok(bytes)
5486    }
5487
5488    /// Encode F64 comparison as Thumb-2: VCMP.F64 + VMRS + MOV #0 + IT + MOV #1
5489    fn encode_thumb_f64_compare(
5490        &self,
5491        rd: &Reg,
5492        dn: &VfpReg,
5493        dm: &VfpReg,
5494        cond_code: u32,
5495    ) -> Result<Vec<u8>> {
5496        let mut bytes = Vec::new();
5497        let rd_bits = reg_to_bits(rd);
5498
5499        // VCMP.F64 Dn, Dm
5500        let dn_num = vfp_dreg_to_num(dn)?;
5501        let dm_num = vfp_dreg_to_num(dm)?;
5502        let (vd, d) = encode_dreg(dn_num);
5503        let (vm, m) = encode_dreg(dm_num);
5504        let vcmp = 0xEEB40B40 | (d << 22) | (vd << 12) | (m << 5) | vm;
5505        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcmp));
5506
5507        // VMRS APSR_nzcv, FPSCR
5508        bytes.extend_from_slice(&vfp_to_thumb_bytes(0xEEF1FA10));
5509
5510        // MOVS Rd, #0
5511        if rd_bits < 8 {
5512            let movs_zero: u16 = 0x2000 | ((rd_bits as u16) << 8);
5513            bytes.extend_from_slice(&movs_zero.to_le_bytes());
5514        } else {
5515            let hw1: u16 = 0xF04F;
5516            let hw2: u16 = (rd_bits as u16) << 8;
5517            bytes.extend_from_slice(&hw1.to_le_bytes());
5518            bytes.extend_from_slice(&hw2.to_le_bytes());
5519        }
5520
5521        // IT<cond>
5522        let it: u16 = 0xBF00 | ((cond_code as u16) << 4) | 0x8;
5523        bytes.extend_from_slice(&it.to_le_bytes());
5524
5525        // MOV Rd, #1
5526        if rd_bits < 8 {
5527            let mov_one: u16 = 0x2001 | ((rd_bits as u16) << 8);
5528            bytes.extend_from_slice(&mov_one.to_le_bytes());
5529        } else {
5530            let hw1: u16 = 0xF04F;
5531            let hw2: u16 = ((rd_bits as u16) << 8) | 0x01;
5532            bytes.extend_from_slice(&hw1.to_le_bytes());
5533            bytes.extend_from_slice(&hw2.to_le_bytes());
5534        }
5535
5536        Ok(bytes)
5537    }
5538
5539    /// Encode F64 constant load as Thumb-2: MOVW+MOVT (lo32 into R0) + MOVW+MOVT (hi32 into R12) + VMOV Dd, R0, R12
5540    fn encode_thumb_f64_const(&self, dd: &VfpReg, value: f64) -> Result<Vec<u8>> {
5541        let mut bytes = Vec::new();
5542        let bits = value.to_bits();
5543        let lo32 = bits as u32;
5544        let hi32 = (bits >> 32) as u32;
5545
5546        // MOVW R0, #lo16(lo32)
5547        let lo16 = lo32 & 0xFFFF;
5548        bytes.extend_from_slice(&self.encode_thumb32_movw_raw(0, lo16)?);
5549
5550        // MOVT R0, #hi16(lo32)
5551        let hi16 = (lo32 >> 16) & 0xFFFF;
5552        bytes.extend_from_slice(&self.encode_thumb32_movt_raw(0, hi16)?);
5553
5554        // MOVW R12, #lo16(hi32)
5555        let lo16 = hi32 & 0xFFFF;
5556        bytes.extend_from_slice(&self.encode_thumb32_movw_raw(12, lo16)?);
5557
5558        // MOVT R12, #hi16(hi32)
5559        let hi16 = (hi32 >> 16) & 0xFFFF;
5560        bytes.extend_from_slice(&self.encode_thumb32_movt_raw(12, hi16)?);
5561
5562        // VMOV Dd, R0, R12
5563        let vmov = encode_vmov_core_dreg(true, dd, &Reg::R0, &Reg::R12)?;
5564        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov));
5565
5566        Ok(bytes)
5567    }
5568
5569    /// Encode VMOV Sd, Rm + VCVT.F64.S32/U32 Dd, Sd as Thumb-2
5570    fn encode_thumb_f64_convert_i32(&self, dd: &VfpReg, rm: &Reg, signed: bool) -> Result<Vec<u8>> {
5571        let mut bytes = Vec::new();
5572
5573        // VMOV S0, Rm
5574        let vmov = encode_vmov_core_sreg(true, &VfpReg::S0, rm)?;
5575        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov));
5576
5577        // VCVT.F64.S32 Dd, S0 or VCVT.F64.U32 Dd, S0
5578        let dd_num = vfp_dreg_to_num(dd)?;
5579        let (vd, d) = encode_dreg(dd_num);
5580        let base = if signed { 0xEEB80B40 } else { 0xEEB80BC0 };
5581        let vcvt = base | (d << 22) | (vd << 12);
5582        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt));
5583
5584        Ok(bytes)
5585    }
5586
5587    /// Encode VCVT.F64.F32 Dd, Sm as Thumb-2
5588    fn encode_thumb_f64_promote_f32(&self, dd: &VfpReg, sm: &VfpReg) -> Result<Vec<u8>> {
5589        let dd_num = vfp_dreg_to_num(dd)?;
5590        let sm_num = vfp_sreg_to_num(sm)?;
5591        let (vd, d) = encode_dreg(dd_num);
5592        let (vm, m) = encode_sreg(sm_num);
5593
5594        let vcvt = 0xEEB70AC0 | (d << 22) | (vd << 12) | (m << 5) | vm;
5595        Ok(vfp_to_thumb_bytes(vcvt))
5596    }
5597
5598    /// Encode VCVT.S32/U32.F64 S0, Dm + VMOV Rd, S0 as Thumb-2
5599    fn encode_thumb_i32_trunc_f64(&self, rd: &Reg, dm: &VfpReg, signed: bool) -> Result<Vec<u8>> {
5600        let mut bytes = Vec::new();
5601        let dm_num = vfp_dreg_to_num(dm)?;
5602        let (vm, m) = encode_dreg(dm_num);
5603
5604        // VCVT.S32.F64 S0, Dm or VCVT.U32.F64 S0, Dm
5605        let base = if signed { 0xEEBD0BC0 } else { 0xEEBC0BC0 };
5606        let vcvt = base | (m << 5) | vm;
5607        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt));
5608
5609        // VMOV Rd, S0
5610        let vmov = encode_vmov_core_sreg(false, &VfpReg::S0, rd)?;
5611        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov));
5612
5613        Ok(bytes)
5614    }
5615
5616    /// Encode F64 rounding pseudo-op as Thumb-2 via VCVT to integer and back
5617    /// Encode F64 rounding as Thumb-2.
5618    /// `mode`: FPSCR RMode — 0b00=nearest, 0b01=+inf(ceil), 0b10=-inf(floor), 0b11=zero(trunc)
5619    fn encode_thumb_f64_rounding(&self, dd: &VfpReg, dm: &VfpReg, mode: u8) -> Result<Vec<u8>> {
5620        let mut bytes = Vec::new();
5621        let dm_num = vfp_dreg_to_num(dm)?;
5622        let dd_num = vfp_dreg_to_num(dd)?;
5623        let (vm, m) = encode_dreg(dm_num);
5624        let (vd, d) = encode_dreg(dd_num);
5625
5626        if mode == 0b11 {
5627            // Trunc: VCVTR.S32.F64 — bit[7]=1, always truncates
5628            let vcvt_to_int = 0xEEBD0BC0 | (m << 5) | vm;
5629            bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt_to_int));
5630        } else {
5631            let rt: u32 = 12;
5632
5633            // VMRS R12, FPSCR
5634            let vmrs = 0xEEF10A10 | (rt << 12);
5635            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmrs));
5636
5637            // BIC.W R12, R12, #(3 << 22)
5638            let bic_hw1: u16 = 0xF020 | ((rt as u16) & 0xF);
5639            let bic_hw2: u16 = (0x05 << 12) | ((rt as u16) << 8) | 0x03;
5640            bytes.extend_from_slice(&bic_hw1.to_le_bytes());
5641            bytes.extend_from_slice(&bic_hw2.to_le_bytes());
5642
5643            // ORR.W R12, R12, #(mode << 22)
5644            if mode != 0 {
5645                let orr_hw1: u16 = 0xF040 | ((rt as u16) & 0xF);
5646                let orr_hw2: u16 = (0x05 << 12) | ((rt as u16) << 8) | (mode as u16);
5647                bytes.extend_from_slice(&orr_hw1.to_le_bytes());
5648                bytes.extend_from_slice(&orr_hw2.to_le_bytes());
5649            }
5650
5651            // VMSR FPSCR, R12
5652            let vmsr = 0xEEE10A10 | (rt << 12);
5653            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmsr));
5654
5655            // VCVT.S32.F64 S0, Dm — non-R variant (bit[7]=0)
5656            let vcvt_to_int = 0xEEBD0B40 | (m << 5) | vm;
5657            bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt_to_int));
5658
5659            // Restore FPSCR
5660            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmrs));
5661            bytes.extend_from_slice(&bic_hw1.to_le_bytes());
5662            bytes.extend_from_slice(&bic_hw2.to_le_bytes());
5663            bytes.extend_from_slice(&vfp_to_thumb_bytes(vmsr));
5664        }
5665
5666        // VCVT.F64.S32 Dd, S0
5667        let vcvt_to_float = 0xEEB80B40 | (d << 22) | (vd << 12);
5668        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt_to_float));
5669
5670        Ok(bytes)
5671    }
5672
5673    /// Encode F64 min/max as Thumb-2
5674    fn encode_thumb_f64_minmax(
5675        &self,
5676        dd: &VfpReg,
5677        dn: &VfpReg,
5678        dm: &VfpReg,
5679        is_min: bool,
5680    ) -> Result<Vec<u8>> {
5681        let mut bytes = Vec::new();
5682        let dn_num = vfp_dreg_to_num(dn)?;
5683        let dm_num = vfp_dreg_to_num(dm)?;
5684        let dd_num = vfp_dreg_to_num(dd)?;
5685
5686        // VMOV.F64 Dd, Dn
5687        let (vd, d) = encode_dreg(dd_num);
5688        let (vn, n) = encode_dreg(dn_num);
5689        let vmov_dn = 0xEEB00B40 | (d << 22) | (vd << 12) | (n << 5) | vn;
5690        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov_dn));
5691
5692        // VCMP.F64 Dn, Dm
5693        let (vm, m) = encode_dreg(dm_num);
5694        let vcmp = 0xEEB40B40 | (n << 22) | (vn << 12) | (m << 5) | vm;
5695        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcmp));
5696
5697        // VMRS APSR_nzcv, FPSCR
5698        bytes.extend_from_slice(&vfp_to_thumb_bytes(0xEEF1FA10));
5699
5700        // IT GT (for min) or IT MI (for max)
5701        let cond: u16 = if is_min { 0xC } else { 0x4 };
5702        let it: u16 = 0xBF00 | (cond << 4) | 0x8;
5703        bytes.extend_from_slice(&it.to_le_bytes());
5704
5705        // VMOV{cond}.F64 Dd, Dm
5706        let vmov_dm = 0xEEB00B40 | (d << 22) | (vd << 12) | (m << 5) | vm;
5707        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov_dm));
5708
5709        Ok(bytes)
5710    }
5711
5712    /// Encode F64 copysign as Thumb-2
5713    fn encode_thumb_f64_copysign(&self, dd: &VfpReg, dn: &VfpReg, dm: &VfpReg) -> Result<Vec<u8>> {
5714        let mut bytes = Vec::new();
5715
5716        // VMOV R0, R12, Dm (get sign source)
5717        bytes.extend_from_slice(&vfp_to_thumb_bytes(encode_vmov_core_dreg(
5718            false,
5719            dm,
5720            &Reg::R0,
5721            &Reg::R12,
5722        )?));
5723
5724        // VMOV R1, R2, Dn (get magnitude source)
5725        bytes.extend_from_slice(&vfp_to_thumb_bytes(encode_vmov_core_dreg(
5726            false,
5727            dn,
5728            &Reg::R1,
5729            &Reg::R2,
5730        )?));
5731
5732        // AND.W R12, R12, #0x80000000 (i=0, Rn=R12)
5733        let hw1: u16 = 0xF000 | 12;
5734        let hw2: u16 = (0x1 << 12) | (12 << 8) | 0x02;
5735        bytes.extend_from_slice(&hw1.to_le_bytes());
5736        bytes.extend_from_slice(&hw2.to_le_bytes());
5737
5738        // BIC.W R2, R2, #0x80000000 (i=0, Rn=R2)
5739        let hw1: u16 = 0xF020 | 2;
5740        let hw2: u16 = (0x1 << 12) | (2 << 8) | 0x02;
5741        bytes.extend_from_slice(&hw1.to_le_bytes());
5742        bytes.extend_from_slice(&hw2.to_le_bytes());
5743
5744        // ORR.W R2, R2, R12
5745        let hw1: u16 = 0xEA40 | 2;
5746        let hw2: u16 = (2 << 8) | 12;
5747        bytes.extend_from_slice(&hw1.to_le_bytes());
5748        bytes.extend_from_slice(&hw2.to_le_bytes());
5749
5750        // VMOV Dd, R1, R2
5751        bytes.extend_from_slice(&vfp_to_thumb_bytes(encode_vmov_core_dreg(
5752            true,
5753            dd,
5754            &Reg::R1,
5755            &Reg::R2,
5756        )?));
5757
5758        Ok(bytes)
5759    }
5760
5761    /// Encode VCVT.S32/U32.F32 + VMOV as Thumb-2
5762    fn encode_thumb_i32_trunc_f32(&self, rd: &Reg, sm: &VfpReg, signed: bool) -> Result<Vec<u8>> {
5763        let mut bytes = Vec::new();
5764
5765        let sm_num = vfp_sreg_to_num(sm)?;
5766        let (vd, d) = encode_sreg(sm_num);
5767        let (vm, m) = encode_sreg(sm_num);
5768        let base = if signed { 0xEEBD0AC0 } else { 0xEEBC0AC0 };
5769        let vcvt = base | (d << 22) | (vd << 12) | (m << 5) | vm;
5770        bytes.extend_from_slice(&vfp_to_thumb_bytes(vcvt));
5771
5772        // VMOV Rd, Sm
5773        let vmov = encode_vmov_core_sreg(false, sm, rd)?;
5774        bytes.extend_from_slice(&vfp_to_thumb_bytes(vmov));
5775
5776        Ok(bytes)
5777    }
5778
5779    // === Thumb-2 32-bit encoding helpers ===
5780
5781    /// Encode Thumb-2 32-bit ADD with immediate
5782    fn encode_thumb32_add(&self, rd: &Reg, rn: &Reg, imm: u32) -> Result<Vec<u8>> {
5783        let rd_bits = reg_to_bits(rd);
5784        let rn_bits = reg_to_bits(rn);
5785
5786        // ADD.W Rd, Rn, #imm12
5787        // First halfword: 1111 0 i 0 1000 S Rn
5788        // Second halfword: 0 imm3 Rd imm8
5789        let i_bit = (imm >> 11) & 1;
5790        let imm3 = (imm >> 8) & 0x7;
5791        let imm8 = imm & 0xFF;
5792
5793        let hw1: u16 = (0xF100 | (i_bit << 10) | rn_bits) as u16;
5794        let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
5795
5796        let mut bytes = hw1.to_le_bytes().to_vec();
5797        bytes.extend_from_slice(&hw2.to_le_bytes());
5798        Ok(bytes)
5799    }
5800
5801    /// Encode Thumb-2 32-bit SUB with immediate
5802    fn encode_thumb32_sub(&self, rd: &Reg, rn: &Reg, imm: u32) -> Result<Vec<u8>> {
5803        let rd_bits = reg_to_bits(rd);
5804        let rn_bits = reg_to_bits(rn);
5805
5806        let i_bit = (imm >> 11) & 1;
5807        let imm3 = (imm >> 8) & 0x7;
5808        let imm8 = imm & 0xFF;
5809
5810        let hw1: u16 = (0xF1A0 | (i_bit << 10) | rn_bits) as u16;
5811        let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
5812
5813        let mut bytes = hw1.to_le_bytes().to_vec();
5814        bytes.extend_from_slice(&hw2.to_le_bytes());
5815        Ok(bytes)
5816    }
5817
5818    /// Encode Thumb-2 32-bit ADDS with immediate (sets flags)
5819    fn encode_thumb32_adds(&self, rd: &Reg, rn: &Reg, imm: u32) -> Result<Vec<u8>> {
5820        let rd_bits = reg_to_bits(rd);
5821        let rn_bits = reg_to_bits(rn);
5822
5823        let i_bit = (imm >> 11) & 1;
5824        let imm3 = (imm >> 8) & 0x7;
5825        let imm8 = imm & 0xFF;
5826
5827        // ADDS.W Rd, Rn, #imm (with S=1)
5828        // First halfword: 1111 0 i 0 1000 1 Rn = F110 | i<<10 | Rn
5829        let hw1: u16 = (0xF110 | (i_bit << 10) | rn_bits) as u16;
5830        let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
5831
5832        let mut bytes = hw1.to_le_bytes().to_vec();
5833        bytes.extend_from_slice(&hw2.to_le_bytes());
5834        Ok(bytes)
5835    }
5836
5837    /// Encode Thumb-2 32-bit SUBS with immediate (sets flags)
5838    fn encode_thumb32_subs(&self, rd: &Reg, rn: &Reg, imm: u32) -> Result<Vec<u8>> {
5839        let rd_bits = reg_to_bits(rd);
5840        let rn_bits = reg_to_bits(rn);
5841
5842        let i_bit = (imm >> 11) & 1;
5843        let imm3 = (imm >> 8) & 0x7;
5844        let imm8 = imm & 0xFF;
5845
5846        // SUBS.W Rd, Rn, #imm (with S=1)
5847        // First halfword: 1111 0 i 0 1101 1 Rn = F1B0 | i<<10 | Rn
5848        let hw1: u16 = (0xF1B0 | (i_bit << 10) | rn_bits) as u16;
5849        let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
5850
5851        let mut bytes = hw1.to_le_bytes().to_vec();
5852        bytes.extend_from_slice(&hw2.to_le_bytes());
5853        Ok(bytes)
5854    }
5855
5856    /// Encode Thumb-2 32-bit MOVW (16-bit immediate)
5857    ///
5858    /// # Contract (Verus-style)
5859    /// ```text
5860    /// requires rd <= R14
5861    /// ensures result.len() == 4
5862    /// ensures (imm & 0xFFFF) can be reconstructed from the encoding
5863    /// ```
5864    fn encode_thumb32_movw(&self, rd: &Reg, imm: u32) -> Result<Vec<u8>> {
5865        let rd_bits = reg_to_bits(rd);
5866        encoding_contracts::verify_reg_bits(rd_bits);
5867        let imm16 = imm & 0xFFFF;
5868
5869        // MOVW Rd, #imm16
5870        // 1111 0 i 10 0 1 0 0 imm4 | 0 imm3 Rd imm8
5871        let imm4 = (imm16 >> 12) & 0xF;
5872        let i_bit = (imm16 >> 11) & 1;
5873        let imm3 = (imm16 >> 8) & 0x7;
5874        let imm8 = imm16 & 0xFF;
5875
5876        let hw1: u16 = (0xF240 | (i_bit << 10) | imm4) as u16;
5877        let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
5878
5879        let mut bytes = hw1.to_le_bytes().to_vec();
5880        bytes.extend_from_slice(&hw2.to_le_bytes());
5881        encoding_contracts::verify_thumb32(&bytes);
5882        Ok(bytes)
5883    }
5884
5885    /// Encode Thumb-2 32-bit shift with immediate
5886    ///
5887    /// # Contract (Verus-style)
5888    /// ```text
5889    /// requires rd <= R14, rm <= R14
5890    /// ensures result.len() == 4
5891    /// ```
5892    fn encode_thumb32_shift(
5893        &self,
5894        rd: &Reg,
5895        rm: &Reg,
5896        shift: u32,
5897        shift_type: u8,
5898    ) -> Result<Vec<u8>> {
5899        let rd_bits = reg_to_bits(rd);
5900        let rm_bits = reg_to_bits(rm);
5901        encoding_contracts::verify_reg_bits(rd_bits);
5902        encoding_contracts::verify_reg_bits(rm_bits);
5903        let imm5 = shift & 0x1F;
5904        let imm2 = imm5 & 0x3;
5905        let imm3 = (imm5 >> 2) & 0x7;
5906
5907        // MOV.W Rd, Rm, <shift> #imm
5908        // EA4F 0 imm3 Rd imm2 type Rm
5909        let hw1: u16 = 0xEA4F;
5910        let hw2: u16 =
5911            ((imm3 << 12) | (rd_bits << 8) | (imm2 << 6) | ((shift_type as u32) << 4) | rm_bits)
5912                as u16;
5913
5914        let mut bytes = hw1.to_le_bytes().to_vec();
5915        bytes.extend_from_slice(&hw2.to_le_bytes());
5916        Ok(bytes)
5917    }
5918
5919    /// Encode Thumb-2 32-bit shift by register
5920    /// Encoding: 11111010 0xx0 Rn | 1111 Rd 0000 Rm
5921    /// shift_type: 00=LSL, 01=LSR, 10=ASR, 11=ROR
5922    fn encode_thumb32_shift_reg(
5923        &self,
5924        rd: &Reg,
5925        rn: &Reg,
5926        rm: &Reg,
5927        shift_type: u8,
5928    ) -> Result<Vec<u8>> {
5929        let rd_bits = reg_to_bits(rd);
5930        let rn_bits = reg_to_bits(rn);
5931        let rm_bits = reg_to_bits(rm);
5932
5933        // hw1: 1111 1010 0xx0 Rn
5934        let hw1: u16 = (0xFA00 | ((shift_type as u32) << 5) | rn_bits) as u16;
5935        // hw2: 1111 Rd 0000 Rm
5936        let hw2: u16 = (0xF000 | (rd_bits << 8) | rm_bits) as u16;
5937
5938        let mut bytes = hw1.to_le_bytes().to_vec();
5939        bytes.extend_from_slice(&hw2.to_le_bytes());
5940        Ok(bytes)
5941    }
5942
5943    /// Encode Thumb-2 32-bit CMP with immediate
5944    fn encode_thumb32_cmp_imm(&self, rn: &Reg, imm: u32) -> Result<Vec<u8>> {
5945        let rn_bits = reg_to_bits(rn);
5946
5947        let i_bit = (imm >> 11) & 1;
5948        let imm3 = (imm >> 8) & 0x7;
5949        let imm8 = imm & 0xFF;
5950
5951        // CMP.W Rn, #imm
5952        let hw1: u16 = (0xF1B0 | (i_bit << 10) | rn_bits) as u16;
5953        let hw2: u16 = ((imm3 << 12) | 0x0F00 | imm8) as u16;
5954
5955        let mut bytes = hw1.to_le_bytes().to_vec();
5956        bytes.extend_from_slice(&hw2.to_le_bytes());
5957        Ok(bytes)
5958    }
5959
5960    /// Encode Thumb-2 32-bit LDR
5961    fn encode_thumb32_ldr(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
5962        let rd_bits = reg_to_bits(rd);
5963        let base_bits = reg_to_bits(base);
5964
5965        // LDR.W Rd, [Rn, #imm12]
5966        let hw1: u16 = (0xF8D0 | base_bits) as u16;
5967        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
5968
5969        let mut bytes = hw1.to_le_bytes().to_vec();
5970        bytes.extend_from_slice(&hw2.to_le_bytes());
5971        Ok(bytes)
5972    }
5973
5974    /// Encode Thumb-2 32-bit STR
5975    fn encode_thumb32_str(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
5976        let rd_bits = reg_to_bits(rd);
5977        let base_bits = reg_to_bits(base);
5978
5979        // STR.W Rd, [Rn, #imm12]
5980        let hw1: u16 = (0xF8C0 | base_bits) as u16;
5981        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
5982
5983        let mut bytes = hw1.to_le_bytes().to_vec();
5984        bytes.extend_from_slice(&hw2.to_le_bytes());
5985        Ok(bytes)
5986    }
5987
5988    /// Encode Thumb-2 32-bit LDR with register offset: LDR.W Rd, [Rn, Rm]
5989    fn encode_thumb32_ldr_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
5990        let rd_bits = reg_to_bits(rd);
5991        let base_bits = reg_to_bits(base);
5992        let rm_bits = reg_to_bits(offset_reg);
5993
5994        // LDR.W Rd, [Rn, Rm, LSL #0]
5995        // Encoding: 1111 1000 0101 Rn | Rt 0000 00 imm2 Rm
5996        // imm2 = 00 for no shift (LSL #0)
5997        let hw1: u16 = (0xF850 | base_bits) as u16;
5998        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
5999
6000        let mut bytes = hw1.to_le_bytes().to_vec();
6001        bytes.extend_from_slice(&hw2.to_le_bytes());
6002        Ok(bytes)
6003    }
6004
6005    /// Encode Thumb-2 32-bit STR with register offset: STR.W Rd, [Rn, Rm]
6006    fn encode_thumb32_str_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6007        let rd_bits = reg_to_bits(rd);
6008        let base_bits = reg_to_bits(base);
6009        let rm_bits = reg_to_bits(offset_reg);
6010
6011        // STR.W Rd, [Rn, Rm, LSL #0]
6012        // Encoding: 1111 1000 0100 Rn | Rt 0000 00 imm2 Rm
6013        // imm2 = 00 for no shift (LSL #0)
6014        let hw1: u16 = (0xF840 | base_bits) as u16;
6015        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6016
6017        let mut bytes = hw1.to_le_bytes().to_vec();
6018        bytes.extend_from_slice(&hw2.to_le_bytes());
6019        Ok(bytes)
6020    }
6021
6022    // === Sub-word load/store Thumb-2 encoding helpers ===
6023
6024    /// Encode Thumb-2 32-bit LDRB with immediate: LDRB.W Rd, [Rn, #imm12]
6025    fn encode_thumb32_ldrb_imm(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
6026        let rd_bits = reg_to_bits(rd);
6027        let base_bits = reg_to_bits(base);
6028        // LDRB.W Rd, [Rn, #imm12]: 1111 1000 1001 Rn | Rt imm12
6029        let hw1: u16 = (0xF890 | base_bits) as u16;
6030        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
6031        let mut bytes = hw1.to_le_bytes().to_vec();
6032        bytes.extend_from_slice(&hw2.to_le_bytes());
6033        Ok(bytes)
6034    }
6035
6036    /// Encode Thumb-2 32-bit LDRB with register: LDRB.W Rd, [Rn, Rm]
6037    fn encode_thumb32_ldrb_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6038        let rd_bits = reg_to_bits(rd);
6039        let base_bits = reg_to_bits(base);
6040        let rm_bits = reg_to_bits(offset_reg);
6041        // LDRB.W Rd, [Rn, Rm, LSL #0]: 1111 1000 0001 Rn | Rt 0000 00 imm2 Rm
6042        let hw1: u16 = (0xF810 | base_bits) as u16;
6043        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6044        let mut bytes = hw1.to_le_bytes().to_vec();
6045        bytes.extend_from_slice(&hw2.to_le_bytes());
6046        Ok(bytes)
6047    }
6048
6049    /// Encode Thumb-2 32-bit LDRSB with immediate: LDRSB.W Rd, [Rn, #imm12]
6050    fn encode_thumb32_ldrsb_imm(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
6051        let rd_bits = reg_to_bits(rd);
6052        let base_bits = reg_to_bits(base);
6053        // LDRSB.W Rd, [Rn, #imm12]: 1111 1001 1001 Rn | Rt imm12
6054        let hw1: u16 = (0xF990 | base_bits) as u16;
6055        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
6056        let mut bytes = hw1.to_le_bytes().to_vec();
6057        bytes.extend_from_slice(&hw2.to_le_bytes());
6058        Ok(bytes)
6059    }
6060
6061    /// Encode Thumb-2 32-bit LDRSB with register: LDRSB.W Rd, [Rn, Rm]
6062    fn encode_thumb32_ldrsb_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6063        let rd_bits = reg_to_bits(rd);
6064        let base_bits = reg_to_bits(base);
6065        let rm_bits = reg_to_bits(offset_reg);
6066        // LDRSB.W Rd, [Rn, Rm, LSL #0]: 1111 1001 0001 Rn | Rt 0000 00 imm2 Rm
6067        let hw1: u16 = (0xF910 | base_bits) as u16;
6068        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6069        let mut bytes = hw1.to_le_bytes().to_vec();
6070        bytes.extend_from_slice(&hw2.to_le_bytes());
6071        Ok(bytes)
6072    }
6073
6074    /// Encode Thumb-2 32-bit LDRH with immediate: LDRH.W Rd, [Rn, #imm12]
6075    fn encode_thumb32_ldrh_imm(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
6076        let rd_bits = reg_to_bits(rd);
6077        let base_bits = reg_to_bits(base);
6078        // LDRH.W Rd, [Rn, #imm12]: 1111 1000 1011 Rn | Rt imm12
6079        let hw1: u16 = (0xF8B0 | base_bits) as u16;
6080        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
6081        let mut bytes = hw1.to_le_bytes().to_vec();
6082        bytes.extend_from_slice(&hw2.to_le_bytes());
6083        Ok(bytes)
6084    }
6085
6086    /// Encode Thumb-2 32-bit LDRH with register: LDRH.W Rd, [Rn, Rm]
6087    fn encode_thumb32_ldrh_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6088        let rd_bits = reg_to_bits(rd);
6089        let base_bits = reg_to_bits(base);
6090        let rm_bits = reg_to_bits(offset_reg);
6091        // LDRH.W Rd, [Rn, Rm, LSL #0]: 1111 1000 0011 Rn | Rt 0000 00 imm2 Rm
6092        let hw1: u16 = (0xF830 | base_bits) as u16;
6093        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6094        let mut bytes = hw1.to_le_bytes().to_vec();
6095        bytes.extend_from_slice(&hw2.to_le_bytes());
6096        Ok(bytes)
6097    }
6098
6099    /// Encode Thumb-2 32-bit LDRSH with immediate: LDRSH.W Rd, [Rn, #imm12]
6100    fn encode_thumb32_ldrsh_imm(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
6101        let rd_bits = reg_to_bits(rd);
6102        let base_bits = reg_to_bits(base);
6103        // LDRSH.W Rd, [Rn, #imm12]: 1111 1001 1011 Rn | Rt imm12
6104        let hw1: u16 = (0xF9B0 | base_bits) as u16;
6105        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
6106        let mut bytes = hw1.to_le_bytes().to_vec();
6107        bytes.extend_from_slice(&hw2.to_le_bytes());
6108        Ok(bytes)
6109    }
6110
6111    /// Encode Thumb-2 32-bit LDRSH with register: LDRSH.W Rd, [Rn, Rm]
6112    fn encode_thumb32_ldrsh_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6113        let rd_bits = reg_to_bits(rd);
6114        let base_bits = reg_to_bits(base);
6115        let rm_bits = reg_to_bits(offset_reg);
6116        // LDRSH.W Rd, [Rn, Rm, LSL #0]: 1111 1001 0011 Rn | Rt 0000 00 imm2 Rm
6117        let hw1: u16 = (0xF930 | base_bits) as u16;
6118        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6119        let mut bytes = hw1.to_le_bytes().to_vec();
6120        bytes.extend_from_slice(&hw2.to_le_bytes());
6121        Ok(bytes)
6122    }
6123
6124    /// Encode Thumb-2 32-bit STRB with immediate: STRB.W Rd, [Rn, #imm12]
6125    fn encode_thumb32_strb_imm(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
6126        let rd_bits = reg_to_bits(rd);
6127        let base_bits = reg_to_bits(base);
6128        // STRB.W Rd, [Rn, #imm12]: 1111 1000 1000 Rn | Rt imm12
6129        let hw1: u16 = (0xF880 | base_bits) as u16;
6130        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
6131        let mut bytes = hw1.to_le_bytes().to_vec();
6132        bytes.extend_from_slice(&hw2.to_le_bytes());
6133        Ok(bytes)
6134    }
6135
6136    /// Encode Thumb-2 32-bit STRB with register: STRB.W Rd, [Rn, Rm]
6137    fn encode_thumb32_strb_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6138        let rd_bits = reg_to_bits(rd);
6139        let base_bits = reg_to_bits(base);
6140        let rm_bits = reg_to_bits(offset_reg);
6141        // STRB.W Rd, [Rn, Rm, LSL #0]: 1111 1000 0000 Rn | Rt 0000 00 imm2 Rm
6142        let hw1: u16 = (0xF800 | base_bits) as u16;
6143        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6144        let mut bytes = hw1.to_le_bytes().to_vec();
6145        bytes.extend_from_slice(&hw2.to_le_bytes());
6146        Ok(bytes)
6147    }
6148
6149    /// Encode Thumb-2 32-bit STRH with immediate: STRH.W Rd, [Rn, #imm12]
6150    fn encode_thumb32_strh_imm(&self, rd: &Reg, base: &Reg, offset: u32) -> Result<Vec<u8>> {
6151        let rd_bits = reg_to_bits(rd);
6152        let base_bits = reg_to_bits(base);
6153        // STRH.W Rd, [Rn, #imm12]: 1111 1000 1010 Rn | Rt imm12
6154        let hw1: u16 = (0xF8A0 | base_bits) as u16;
6155        let hw2: u16 = ((rd_bits << 12) | (offset & 0xFFF)) as u16;
6156        let mut bytes = hw1.to_le_bytes().to_vec();
6157        bytes.extend_from_slice(&hw2.to_le_bytes());
6158        Ok(bytes)
6159    }
6160
6161    /// Encode Thumb-2 32-bit STRH with register: STRH.W Rd, [Rn, Rm]
6162    fn encode_thumb32_strh_reg(&self, rd: &Reg, base: &Reg, offset_reg: &Reg) -> Result<Vec<u8>> {
6163        let rd_bits = reg_to_bits(rd);
6164        let base_bits = reg_to_bits(base);
6165        let rm_bits = reg_to_bits(offset_reg);
6166        // STRH.W Rd, [Rn, Rm, LSL #0]: 1111 1000 0010 Rn | Rt 0000 00 imm2 Rm
6167        let hw1: u16 = (0xF820 | base_bits) as u16;
6168        let hw2: u16 = ((rd_bits << 12) | rm_bits) as u16;
6169        let mut bytes = hw1.to_le_bytes().to_vec();
6170        bytes.extend_from_slice(&hw2.to_le_bytes());
6171        Ok(bytes)
6172    }
6173
6174    /// Encode Thumb-2 32-bit ADD with immediate: ADD.W Rd, Rn, #imm
6175    fn encode_thumb32_add_imm(&self, rd: &Reg, rn: &Reg, imm: u32) -> Result<Vec<u8>> {
6176        let rd_bits = reg_to_bits(rd);
6177        let rn_bits = reg_to_bits(rn);
6178
6179        // For small immediates, use ADD.W Rd, Rn, #imm12
6180        // Encoding: 1111 0 i 0 1 0 0 0 S Rn | 0 imm3 Rd imm8
6181        // S = 0 (don't update flags)
6182        // The 12-bit immediate is encoded as: i:imm3:imm8
6183        // For simplicity, we only support imm <= 0xFFF (direct encoding)
6184        if imm <= 0xFFF {
6185            let i_bit = (imm >> 11) & 1;
6186            let imm3 = (imm >> 8) & 0x7;
6187            let imm8 = imm & 0xFF;
6188
6189            let hw1: u16 = (0xF100 | (i_bit << 10) | rn_bits) as u16;
6190            let hw2: u16 = ((imm3 << 12) | (rd_bits << 8) | imm8) as u16;
6191
6192            let mut bytes = hw1.to_le_bytes().to_vec();
6193            bytes.extend_from_slice(&hw2.to_le_bytes());
6194            Ok(bytes)
6195        } else {
6196            // For larger immediates, would need MOVW/MOVT + ADD
6197            // For now, return error
6198            Err(synth_core::Error::synthesis(
6199                "ADD immediate too large for single instruction",
6200            ))
6201        }
6202    }
6203
6204    // === Raw encoding helpers for POPCNT (take register numbers directly) ===
6205
6206    /// Encode Thumb-2 32-bit MOVW (16-bit immediate) - raw version
6207    ///
6208    /// # Contract (Verus-style)
6209    /// ```text
6210    /// requires rd <= 14, imm16 <= 0xFFFF
6211    /// ensures result.len() == 4
6212    /// ```
6213    fn encode_thumb32_movw_raw(&self, rd: u32, imm16: u32) -> Result<Vec<u8>> {
6214        encoding_contracts::verify_reg_bits(rd);
6215        encoding_contracts::verify_imm16(imm16);
6216        // MOVW Rd, #imm16
6217        // 1111 0 i 10 0 1 0 0 imm4 | 0 imm3 Rd imm8
6218        let imm16 = imm16 & 0xFFFF;
6219        let imm4 = (imm16 >> 12) & 0xF;
6220        let i_bit = (imm16 >> 11) & 1;
6221        let imm3 = (imm16 >> 8) & 0x7;
6222        let imm8 = imm16 & 0xFF;
6223
6224        let hw1: u16 = (0xF240 | (i_bit << 10) | imm4) as u16;
6225        let hw2: u16 = ((imm3 << 12) | (rd << 8) | imm8) as u16;
6226
6227        let mut bytes = hw1.to_le_bytes().to_vec();
6228        bytes.extend_from_slice(&hw2.to_le_bytes());
6229        encoding_contracts::verify_thumb32(&bytes);
6230        Ok(bytes)
6231    }
6232
6233    /// Encode Thumb-2 32-bit MOVT (move top 16 bits) - raw version
6234    ///
6235    /// # Contract (Verus-style)
6236    /// ```text
6237    /// requires rd <= 14, imm16 <= 0xFFFF
6238    /// ensures result.len() == 4
6239    /// ```
6240    fn encode_thumb32_movt_raw(&self, rd: u32, imm16: u32) -> Result<Vec<u8>> {
6241        encoding_contracts::verify_reg_bits(rd);
6242        encoding_contracts::verify_imm16(imm16);
6243        // MOVT Rd, #imm16
6244        // 1111 0 i 10 1 1 0 0 imm4 | 0 imm3 Rd imm8
6245        let imm16 = imm16 & 0xFFFF;
6246        let imm4 = (imm16 >> 12) & 0xF;
6247        let i_bit = (imm16 >> 11) & 1;
6248        let imm3 = (imm16 >> 8) & 0x7;
6249        let imm8 = imm16 & 0xFF;
6250
6251        let hw1: u16 = (0xF2C0 | (i_bit << 10) | imm4) as u16;
6252        let hw2: u16 = ((imm3 << 12) | (rd << 8) | imm8) as u16;
6253
6254        let mut bytes = hw1.to_le_bytes().to_vec();
6255        bytes.extend_from_slice(&hw2.to_le_bytes());
6256        encoding_contracts::verify_thumb32(&bytes);
6257        Ok(bytes)
6258    }
6259
6260    /// Encode Thumb-2 32-bit LSR (logical shift right) with immediate - raw version
6261    fn encode_thumb32_lsr_raw(&self, rd: u32, rm: u32, shift: u32) -> Result<Vec<u8>> {
6262        // MOV.W Rd, Rm, LSR #imm
6263        // EA4F 0 imm3 Rd imm2 01 Rm
6264        let imm5 = shift & 0x1F;
6265        let imm2 = imm5 & 0x3;
6266        let imm3 = (imm5 >> 2) & 0x7;
6267
6268        let hw1: u16 = 0xEA4F;
6269        let hw2: u16 = ((imm3 << 12) | (rd << 8) | (imm2 << 6) | (0b01 << 4) | rm) as u16;
6270
6271        let mut bytes = hw1.to_le_bytes().to_vec();
6272        bytes.extend_from_slice(&hw2.to_le_bytes());
6273        Ok(bytes)
6274    }
6275
6276    /// Encode Thumb-2 32-bit AND (register) - raw version
6277    fn encode_thumb32_and_reg_raw(&self, rd: u32, rn: u32, rm: u32) -> Result<Vec<u8>> {
6278        // AND.W Rd, Rn, Rm
6279        // EA00 Rn | 0 Rd 00 00 Rm
6280        let hw1: u16 = (0xEA00 | rn) as u16;
6281        let hw2: u16 = ((rd << 8) | rm) as u16;
6282
6283        let mut bytes = hw1.to_le_bytes().to_vec();
6284        bytes.extend_from_slice(&hw2.to_le_bytes());
6285        Ok(bytes)
6286    }
6287
6288    /// Encode Thumb-2 32-bit AND with immediate - raw version
6289    fn encode_thumb32_and_imm_raw(&self, rd: u32, rn: u32, imm: u32) -> Result<Vec<u8>> {
6290        // AND.W Rd, Rn, #<modified_immediate>
6291        // For small immediates (0-255), the encoding is simpler
6292        // F0 00 Rn | 0 imm3 Rd imm8
6293        let i_bit = (imm >> 11) & 1;
6294        let imm3 = (imm >> 8) & 0x7;
6295        let imm8 = imm & 0xFF;
6296
6297        let hw1: u16 = (0xF000 | (i_bit << 10) | rn) as u16;
6298        let hw2: u16 = ((imm3 << 12) | (rd << 8) | imm8) as u16;
6299
6300        let mut bytes = hw1.to_le_bytes().to_vec();
6301        bytes.extend_from_slice(&hw2.to_le_bytes());
6302        Ok(bytes)
6303    }
6304
6305    /// Encode Thumb-2 32-bit SUB (register) - raw version
6306    fn encode_thumb32_sub_reg_raw(&self, rd: u32, rn: u32, rm: u32) -> Result<Vec<u8>> {
6307        // SUB.W Rd, Rn, Rm
6308        // EBA0 Rn | 0 Rd 00 00 Rm
6309        let hw1: u16 = (0xEBA0 | rn) as u16;
6310        let hw2: u16 = ((rd << 8) | rm) as u16;
6311
6312        let mut bytes = hw1.to_le_bytes().to_vec();
6313        bytes.extend_from_slice(&hw2.to_le_bytes());
6314        Ok(bytes)
6315    }
6316
6317    /// Encode Thumb-2 32-bit ADD (register) - raw version
6318    fn encode_thumb32_add_reg_raw(&self, rd: u32, rn: u32, rm: u32) -> Result<Vec<u8>> {
6319        // ADD.W Rd, Rn, Rm
6320        // EB00 Rn | 0 Rd 00 00 Rm
6321        let hw1: u16 = (0xEB00 | rn) as u16;
6322        let hw2: u16 = ((rd << 8) | rm) as u16;
6323
6324        let mut bytes = hw1.to_le_bytes().to_vec();
6325        bytes.extend_from_slice(&hw2.to_le_bytes());
6326        Ok(bytes)
6327    }
6328
6329    /// Encode a sequence of ARM instructions
6330    pub fn encode_sequence(&self, ops: &[ArmOp]) -> Result<Vec<u8>> {
6331        let mut code = Vec::new();
6332
6333        for op in ops {
6334            let encoded = self.encode(op)?;
6335            code.extend_from_slice(&encoded);
6336        }
6337
6338        Ok(code)
6339    }
6340}
6341
6342/// Convert register to bit encoding (0-15)
6343fn reg_to_bits(reg: &Reg) -> u32 {
6344    match reg {
6345        Reg::R0 => 0,
6346        Reg::R1 => 1,
6347        Reg::R2 => 2,
6348        Reg::R3 => 3,
6349        Reg::R4 => 4,
6350        Reg::R5 => 5,
6351        Reg::R6 => 6,
6352        Reg::R7 => 7,
6353        Reg::R8 => 8,
6354        Reg::R9 => 9,
6355        Reg::R10 => 10,
6356        Reg::R11 => 11,
6357        Reg::R12 => 12,
6358        Reg::SP => 13,
6359        Reg::LR => 14,
6360        Reg::PC => 15,
6361    }
6362}
6363
6364/// Try to encode a 32-bit value as an ARM rotated immediate (imm8 ROR 2*rot4).
6365/// Returns Some((encoded_bits, 1)) if representable, None otherwise.
6366fn try_encode_rotated_imm(val: u32) -> Option<(u32, u32)> {
6367    if val == 0 {
6368        return Some((0, 1));
6369    }
6370    for rot in 0..16u32 {
6371        let shift = rot * 2;
6372        // Rotate left by shift (undo the ROR) to see if result fits in 8 bits
6373        let unrotated = val.rotate_left(shift);
6374        if unrotated <= 0xFF {
6375            // Encoded as: rot4(4 bits) | imm8(8 bits) = rotate_imm << 8 | imm8
6376            return Some(((rot << 8) | unrotated, 1));
6377        }
6378    }
6379    None
6380}
6381
6382/// Encode operand2 field and return (bits, immediate_flag).
6383/// For ARM32 mode, immediates use the rotated-immediate encoding (imm8 ROR 2*rot4).
6384/// Panics if an immediate value cannot be represented. Callers that need large
6385/// immediates should use MOVW/MOVT instead of Operand2::Imm.
6386fn encode_operand2(op2: &Operand2) -> (u32, u32) {
6387    match op2 {
6388        Operand2::Imm(val) => {
6389            let uval = *val as u32;
6390            // Attempt rotated-immediate encoding (ARM32 Operand2)
6391            if let Some(encoded) = try_encode_rotated_imm(uval) {
6392                encoded
6393            } else {
6394                // Fallback: mask to 8 bits (legacy behavior for values that
6395                // cannot be represented). This should not be reached for
6396                // correctly-selected instructions; the instruction selector
6397                // must use MOVW/MOVT for large constants.
6398                let imm = uval & 0xFF;
6399                (imm, 1)
6400            }
6401        }
6402
6403        Operand2::Reg(reg) => {
6404            let reg_bits = reg_to_bits(reg);
6405            (reg_bits, 0) // I=0 for register
6406        }
6407
6408        Operand2::RegShift {
6409            rm,
6410            shift: _,
6411            amount,
6412        } => {
6413            // Simplified encoding with shift
6414            let rm_bits = reg_to_bits(rm);
6415            let shift_bits = (*amount & 0x1F) << 7;
6416            (shift_bits | rm_bits, 0)
6417        }
6418    }
6419}
6420
6421/// Encode memory address to (base_reg, offset)
6422fn encode_mem_addr(addr: &MemAddr) -> (u32, u32) {
6423    let base_bits = reg_to_bits(&addr.base);
6424    let offset_bits = (addr.offset as u32) & 0xFFF; // 12-bit offset
6425    (base_bits, offset_bits)
6426}
6427
6428/// S-register number: S0=0, S1=1, ..., S31=31
6429fn vfp_sreg_to_num(reg: &VfpReg) -> Result<u32> {
6430    match reg {
6431        VfpReg::S0 => Ok(0),
6432        VfpReg::S1 => Ok(1),
6433        VfpReg::S2 => Ok(2),
6434        VfpReg::S3 => Ok(3),
6435        VfpReg::S4 => Ok(4),
6436        VfpReg::S5 => Ok(5),
6437        VfpReg::S6 => Ok(6),
6438        VfpReg::S7 => Ok(7),
6439        VfpReg::S8 => Ok(8),
6440        VfpReg::S9 => Ok(9),
6441        VfpReg::S10 => Ok(10),
6442        VfpReg::S11 => Ok(11),
6443        VfpReg::S12 => Ok(12),
6444        VfpReg::S13 => Ok(13),
6445        VfpReg::S14 => Ok(14),
6446        VfpReg::S15 => Ok(15),
6447        VfpReg::S16 => Ok(16),
6448        VfpReg::S17 => Ok(17),
6449        VfpReg::S18 => Ok(18),
6450        VfpReg::S19 => Ok(19),
6451        VfpReg::S20 => Ok(20),
6452        VfpReg::S21 => Ok(21),
6453        VfpReg::S22 => Ok(22),
6454        VfpReg::S23 => Ok(23),
6455        VfpReg::S24 => Ok(24),
6456        VfpReg::S25 => Ok(25),
6457        VfpReg::S26 => Ok(26),
6458        VfpReg::S27 => Ok(27),
6459        VfpReg::S28 => Ok(28),
6460        VfpReg::S29 => Ok(29),
6461        VfpReg::S30 => Ok(30),
6462        VfpReg::S31 => Ok(31),
6463        // D-registers are not used in F32 single-precision encodings
6464        _ => Err(synth_core::Error::SynthesisError(
6465            "D-register not supported in single-precision VFP encoding".to_string(),
6466        )),
6467    }
6468}
6469
6470/// D-register number: D0=0, D1=1, ..., D15=15
6471fn vfp_dreg_to_num(reg: &VfpReg) -> Result<u32> {
6472    match reg {
6473        VfpReg::D0 => Ok(0),
6474        VfpReg::D1 => Ok(1),
6475        VfpReg::D2 => Ok(2),
6476        VfpReg::D3 => Ok(3),
6477        VfpReg::D4 => Ok(4),
6478        VfpReg::D5 => Ok(5),
6479        VfpReg::D6 => Ok(6),
6480        VfpReg::D7 => Ok(7),
6481        VfpReg::D8 => Ok(8),
6482        VfpReg::D9 => Ok(9),
6483        VfpReg::D10 => Ok(10),
6484        VfpReg::D11 => Ok(11),
6485        VfpReg::D12 => Ok(12),
6486        VfpReg::D13 => Ok(13),
6487        VfpReg::D14 => Ok(14),
6488        VfpReg::D15 => Ok(15),
6489        // S-registers are not used in F64 double-precision encodings
6490        _ => Err(synth_core::Error::SynthesisError(
6491            "S-register not supported in double-precision VFP encoding".to_string(),
6492        )),
6493    }
6494}
6495
6496/// Split S-register into (Vx[3:0], qualifier_bit) for VFP encoding.
6497/// For an S-register number s: Vx = s >> 1, qualifier = s & 1.
6498/// The qualifier bit goes to D (bit 22), N (bit 7), or M (bit 5) depending on role.
6499fn encode_sreg(s: u32) -> (u32, u32) {
6500    (s >> 1, s & 1)
6501}
6502
6503/// Split D-register into (Vx[3:0], qualifier_bit) for VFP double-precision encoding.
6504/// For a D-register number d: Vx = d & 0xF, qualifier = (d >> 4) & 1.
6505/// For D0-D15, qualifier is always 0.
6506fn encode_dreg(d: u32) -> (u32, u32) {
6507    (d & 0xF, (d >> 4) & 1)
6508}
6509
6510/// Encode a VFP 3-register arithmetic instruction (VADD.F32, VSUB.F32, VMUL.F32, VDIV.F32).
6511/// Returns the full 32-bit instruction word.
6512///
6513/// VFP encoding: [cond 1110] [D opc1 Vn] [Vd 101 sz] [N opc2 M 0 Vm]
6514/// For single-precision (sz=0), coprocessor = 0xA (bits[11:8]).
6515fn encode_vfp_3reg(base: u32, sd: &VfpReg, sn: &VfpReg, sm: &VfpReg) -> Result<u32> {
6516    let sd_num = vfp_sreg_to_num(sd)?;
6517    let sn_num = vfp_sreg_to_num(sn)?;
6518    let sm_num = vfp_sreg_to_num(sm)?;
6519    let (vd, d) = encode_sreg(sd_num);
6520    let (vn, n) = encode_sreg(sn_num);
6521    let (vm, m) = encode_sreg(sm_num);
6522
6523    Ok(base | (d << 22) | (vn << 16) | (vd << 12) | (n << 7) | (m << 5) | vm)
6524}
6525
6526/// Encode a VFP 2-register instruction (VNEG.F32, VABS.F32, VSQRT.F32).
6527/// Returns the full 32-bit instruction word.
6528fn encode_vfp_2reg(base: u32, sd: &VfpReg, sm: &VfpReg) -> Result<u32> {
6529    let sd_num = vfp_sreg_to_num(sd)?;
6530    let sm_num = vfp_sreg_to_num(sm)?;
6531    let (vd, d) = encode_sreg(sd_num);
6532    let (vm, m) = encode_sreg(sm_num);
6533
6534    Ok(base | (d << 22) | (vd << 12) | (m << 5) | vm)
6535}
6536
6537/// Encode a VFP load/store (VLDR.F32 / VSTR.F32).
6538/// offset is in bytes and must be word-aligned; encoded as imm8 = offset/4.
6539/// U bit (bit 23) controls add/subtract offset.
6540fn encode_vfp_ldst(base: u32, sd: &VfpReg, addr: &MemAddr) -> Result<u32> {
6541    let sd_num = vfp_sreg_to_num(sd)?;
6542    let (vd, d) = encode_sreg(sd_num);
6543    let rn = reg_to_bits(&addr.base);
6544
6545    let offset = addr.offset;
6546    let u_bit = if offset >= 0 { 1u32 } else { 0u32 };
6547    let abs_offset = offset.unsigned_abs();
6548    let imm8 = (abs_offset / 4) & 0xFF;
6549
6550    Ok(base | (u_bit << 23) | (d << 22) | (rn << 16) | (vd << 12) | imm8)
6551}
6552
6553/// Encode VMOV between core register and S-register.
6554/// VMOV Sn, Rt: 0xEE00_0A10 | (Vn << 16) | (N << 7) | (Rt << 12)
6555/// VMOV Rt, Sn: 0xEE10_0A10 | (Vn << 16) | (N << 7) | (Rt << 12)
6556fn encode_vmov_core_sreg(to_sreg: bool, sreg: &VfpReg, core: &Reg) -> Result<u32> {
6557    let s_num = vfp_sreg_to_num(sreg)?;
6558    let (vn, n) = encode_sreg(s_num);
6559    let rt = reg_to_bits(core);
6560
6561    let base = if to_sreg { 0xEE000A10 } else { 0xEE100A10 };
6562    Ok(base | (vn << 16) | (rt << 12) | (n << 7))
6563}
6564
6565/// Encode a VFP 3-register double-precision instruction (VADD.F64, VSUB.F64, etc.).
6566/// For double-precision (sz=1), coprocessor = 0xB (bits[11:8]).
6567/// The base should have bit 8 = 1 for F64 (0xB suffix instead of 0xA).
6568fn encode_vfp_3reg_f64(base: u32, dd: &VfpReg, dn: &VfpReg, dm: &VfpReg) -> Result<u32> {
6569    let dd_num = vfp_dreg_to_num(dd)?;
6570    let dn_num = vfp_dreg_to_num(dn)?;
6571    let dm_num = vfp_dreg_to_num(dm)?;
6572    let (vd, d) = encode_dreg(dd_num);
6573    let (vn, n) = encode_dreg(dn_num);
6574    let (vm, m) = encode_dreg(dm_num);
6575
6576    Ok(base | (d << 22) | (vn << 16) | (vd << 12) | (n << 7) | (m << 5) | vm)
6577}
6578
6579/// Encode a VFP 2-register double-precision instruction (VNEG.F64, VABS.F64, VSQRT.F64).
6580fn encode_vfp_2reg_f64(base: u32, dd: &VfpReg, dm: &VfpReg) -> Result<u32> {
6581    let dd_num = vfp_dreg_to_num(dd)?;
6582    let dm_num = vfp_dreg_to_num(dm)?;
6583    let (vd, d) = encode_dreg(dd_num);
6584    let (vm, m) = encode_dreg(dm_num);
6585
6586    Ok(base | (d << 22) | (vd << 12) | (m << 5) | vm)
6587}
6588
6589/// Encode a VFP load/store for double-precision (VLDR.64 / VSTR.64).
6590/// offset is in bytes and must be word-aligned; encoded as imm8 = offset/4.
6591fn encode_vfp_ldst_f64(base: u32, dd: &VfpReg, addr: &MemAddr) -> Result<u32> {
6592    let dd_num = vfp_dreg_to_num(dd)?;
6593    let (vd, d) = encode_dreg(dd_num);
6594    let rn = reg_to_bits(&addr.base);
6595
6596    let offset = addr.offset;
6597    let u_bit = if offset >= 0 { 1u32 } else { 0u32 };
6598    let abs_offset = offset.unsigned_abs();
6599    let imm8 = (abs_offset / 4) & 0xFF;
6600
6601    Ok(base | (u_bit << 23) | (d << 22) | (rn << 16) | (vd << 12) | imm8)
6602}
6603
6604/// Encode VMOV between two core registers and a D-register.
6605/// VMOV Dm, Rt, Rt2: 0xEC40_0B10 | (Rt2 << 16) | (Rt << 12) | (M << 5) | Vm
6606/// VMOV Rt, Rt2, Dm: 0xEC50_0B10 | (Rt2 << 16) | (Rt << 12) | (M << 5) | Vm
6607fn encode_vmov_core_dreg(
6608    to_dreg: bool,
6609    dreg: &VfpReg,
6610    core_lo: &Reg,
6611    core_hi: &Reg,
6612) -> Result<u32> {
6613    let d_num = vfp_dreg_to_num(dreg)?;
6614    let (vm, m) = encode_dreg(d_num);
6615    let rt = reg_to_bits(core_lo);
6616    let rt2 = reg_to_bits(core_hi);
6617
6618    let base = if to_dreg { 0xEC400B10 } else { 0xEC500B10 };
6619    Ok(base | (rt2 << 16) | (rt << 12) | (m << 5) | vm)
6620}
6621
6622/// Emit a VFP 32-bit instruction as Thumb-2 bytes (two LE halfwords).
6623fn vfp_to_thumb_bytes(instr: u32) -> Vec<u8> {
6624    let hw1 = ((instr >> 16) & 0xFFFF) as u16;
6625    let hw2 = (instr & 0xFFFF) as u16;
6626    let mut bytes = hw1.to_le_bytes().to_vec();
6627    bytes.extend_from_slice(&hw2.to_le_bytes());
6628    bytes
6629}
6630
6631// ============================================================================
6632// Helium MVE encoding helpers
6633// ============================================================================
6634
6635/// Q-register number: Q0=0, Q1=1, ..., Q7=7
6636fn qreg_to_num(reg: &QReg) -> u32 {
6637    match reg {
6638        QReg::Q0 => 0,
6639        QReg::Q1 => 1,
6640        QReg::Q2 => 2,
6641        QReg::Q3 => 3,
6642        QReg::Q4 => 4,
6643        QReg::Q5 => 5,
6644        QReg::Q6 => 6,
6645        QReg::Q7 => 7,
6646    }
6647}
6648
6649/// MVE element size to encoding bits: S8=0b00, S16=0b01, S32=0b10
6650fn mve_size_bits(size: &MveSize) -> u32 {
6651    match size {
6652        MveSize::S8 => 0b00,
6653        MveSize::S16 => 0b01,
6654        MveSize::S32 => 0b10,
6655    }
6656}
6657
6658/// Encode MVE 3-register instruction.
6659/// Q-registers are encoded as D-register pairs: Q0=D0:D1, Q1=D2:D3, etc.
6660/// In NEON/MVE encoding, the Q-register uses D-register number = Qn * 2.
6661fn encode_mve_3reg(base: u32, qd: &QReg, qn: &QReg, qm: &QReg) -> u32 {
6662    let d = qreg_to_num(qd) * 2;
6663    let n = qreg_to_num(qn) * 2;
6664    let m = qreg_to_num(qm) * 2;
6665
6666    // Standard NEON/MVE 3-register encoding:
6667    // D bit (bit 22) = Vd[4], Vd[3:0] = bits [15:12]
6668    // N bit (bit 7)  = Vn[4], Vn[3:0] = bits [19:16]
6669    // M bit (bit 5)  = Vm[4], Vm[3:0] = bits [3:0]
6670    let vd = d & 0xF;
6671    let d_bit = (d >> 4) & 1;
6672    let vn = n & 0xF;
6673    let n_bit = (n >> 4) & 1;
6674    let vm = m & 0xF;
6675    let m_bit = (m >> 4) & 1;
6676
6677    base | (d_bit << 22) | (vn << 16) | (vd << 12) | (n_bit << 7) | (m_bit << 5) | vm
6678}
6679
6680/// Encode MVE 3-register bitwise instruction (VAND, VORR, VEOR, VBIC).
6681fn encode_mve_3reg_bitwise(base: u32, qd: &QReg, qn: &QReg, qm: &QReg) -> u32 {
6682    encode_mve_3reg(base, qd, qn, qm)
6683}
6684
6685/// Encode MVE VLDRW.32 Qd, [Rn, #offset]
6686/// Format: EC9x xxxx - contiguous load, word-sized elements
6687fn encode_mve_vldrw(qd: &QReg, addr: &MemAddr) -> u32 {
6688    let qd_enc = qreg_to_num(qd) * 2;
6689    let rn = reg_to_bits(&addr.base);
6690    let offset = addr.offset;
6691    let u_bit = if offset >= 0 { 1u32 } else { 0u32 };
6692    let abs_offset = offset.unsigned_abs();
6693    let imm7 = (abs_offset / 4) & 0x7F; // 7-bit word-aligned offset
6694
6695    // VLDRW.32 Qd, [Rn, #imm]: ED10 xx80 variant
6696    0xED100E80
6697        | (u_bit << 23)
6698        | ((qd_enc >> 4) << 22)
6699        | (rn << 16)
6700        | ((qd_enc & 0xF) << 12)
6701        | (imm7 & 0x7F)
6702}
6703
6704/// Encode MVE VSTRW.32 Qd, [Rn, #offset]
6705fn encode_mve_vstrw(qd: &QReg, addr: &MemAddr) -> u32 {
6706    let qd_enc = qreg_to_num(qd) * 2;
6707    let rn = reg_to_bits(&addr.base);
6708    let offset = addr.offset;
6709    let u_bit = if offset >= 0 { 1u32 } else { 0u32 };
6710    let abs_offset = offset.unsigned_abs();
6711    let imm7 = (abs_offset / 4) & 0x7F;
6712
6713    0xED000E80
6714        | (u_bit << 23)
6715        | ((qd_enc >> 4) << 22)
6716        | (rn << 16)
6717        | ((qd_enc & 0xF) << 12)
6718        | (imm7 & 0x7F)
6719}
6720
6721impl ArmEncoder {
6722    /// Encode MVE constant load: MOVW+MOVT+VMOV for each 32-bit word, then assemble Q-register
6723    fn encode_thumb_mve_const(&self, qd: &QReg, bytes: &[u8; 16]) -> Result<Vec<u8>> {
6724        let mut result = Vec::new();
6725        let qd_num = qreg_to_num(qd);
6726
6727        // Load each 32-bit word into R12 (temp) then VMOV into S-register
6728        for i in 0..4 {
6729            let word = u32::from_le_bytes([
6730                bytes[i * 4],
6731                bytes[i * 4 + 1],
6732                bytes[i * 4 + 2],
6733                bytes[i * 4 + 3],
6734            ]);
6735            let lo16 = word & 0xFFFF;
6736            let hi16 = (word >> 16) & 0xFFFF;
6737
6738            // MOVW R12, #lo16
6739            result.extend_from_slice(&self.encode_thumb32_movw_raw(12, lo16)?);
6740            // MOVT R12, #hi16
6741            if hi16 != 0 {
6742                result.extend_from_slice(&self.encode_thumb32_movt_raw(12, hi16)?);
6743            }
6744
6745            // VMOV Sn, R12 where Sn = Qd*4 + i
6746            let s_num = qd_num * 4 + i as u32;
6747            let (vn, n) = encode_sreg(s_num);
6748            let vmov: u32 = 0xEE000A10 | (vn << 16) | (12 << 12) | (n << 7);
6749            result.extend_from_slice(&vfp_to_thumb_bytes(vmov));
6750        }
6751
6752        Ok(result)
6753    }
6754
6755    /// Encode lane-wise f32 binary operation (VDIV, etc.) via S-register extraction
6756    fn encode_thumb_mve_lane_wise_f32_binop(
6757        &self,
6758        qd: &QReg,
6759        qn: &QReg,
6760        qm: &QReg,
6761        vfp_base: u32,
6762    ) -> Result<Vec<u8>> {
6763        let mut result = Vec::new();
6764        let qd_num = qreg_to_num(qd);
6765        let qn_num = qreg_to_num(qn);
6766        let qm_num = qreg_to_num(qm);
6767
6768        // For each lane 0..3: use S-registers directly (Q aliasing)
6769        for i in 0..4u32 {
6770            let sd = qd_num * 4 + i;
6771            let sn = qn_num * 4 + i;
6772            let sm = qm_num * 4 + i;
6773
6774            let (vd, d) = encode_sreg(sd);
6775            let (vn, n) = encode_sreg(sn);
6776            let (vm, m) = encode_sreg(sm);
6777
6778            let instr = vfp_base | (d << 22) | (vn << 16) | (vd << 12) | (n << 7) | (m << 5) | vm;
6779            result.extend_from_slice(&vfp_to_thumb_bytes(instr));
6780        }
6781
6782        Ok(result)
6783    }
6784
6785    /// Encode lane-wise f32 VSQRT via S-register extraction
6786    fn encode_thumb_mve_lane_wise_f32_sqrt(&self, qd: &QReg, qm: &QReg) -> Result<Vec<u8>> {
6787        let mut result = Vec::new();
6788        let qd_num = qreg_to_num(qd);
6789        let qm_num = qreg_to_num(qm);
6790
6791        // VSQRT.F32 base: 0xEEB10AC0
6792        for i in 0..4u32 {
6793            let sd = qd_num * 4 + i;
6794            let sm = qm_num * 4 + i;
6795
6796            let (vd, d) = encode_sreg(sd);
6797            let (vm, m) = encode_sreg(sm);
6798
6799            let instr: u32 = 0xEEB10AC0 | (d << 22) | (vd << 12) | (m << 5) | vm;
6800            result.extend_from_slice(&vfp_to_thumb_bytes(instr));
6801        }
6802
6803        Ok(result)
6804    }
6805}
6806
6807#[cfg(test)]
6808mod tests {
6809    use super::*;
6810
6811    #[test]
6812    fn test_encoder_creation() {
6813        let encoder_arm = ArmEncoder::new_arm32();
6814        assert!(!encoder_arm.thumb_mode);
6815
6816        let encoder_thumb = ArmEncoder::new_thumb2();
6817        assert!(encoder_thumb.thumb_mode);
6818    }
6819
6820    #[test]
6821    fn test_encode_nop_arm32() {
6822        let encoder = ArmEncoder::new_arm32();
6823        let code = encoder.encode(&ArmOp::Nop).unwrap();
6824
6825        assert_eq!(code.len(), 4); // ARM32 instructions are 4 bytes
6826        assert_eq!(code, vec![0x00, 0x00, 0xA0, 0xE1]); // MOV R0, R0
6827    }
6828
6829    #[test]
6830    fn test_encode_nop_thumb() {
6831        let encoder = ArmEncoder::new_thumb2();
6832        let code = encoder.encode(&ArmOp::Nop).unwrap();
6833
6834        assert_eq!(code.len(), 2); // Thumb instructions are 2 bytes
6835        assert_eq!(code, vec![0x00, 0xBF]); // NOP
6836    }
6837
6838    #[test]
6839    fn test_encode_mov_immediate_arm32() {
6840        let encoder = ArmEncoder::new_arm32();
6841        let op = ArmOp::Mov {
6842            rd: Reg::R0,
6843            op2: Operand2::Imm(42),
6844        };
6845
6846        let code = encoder.encode(&op).unwrap();
6847        assert_eq!(code.len(), 4);
6848
6849        // Verify it's a MOV instruction (bits should have immediate flag set)
6850        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
6851        assert_eq!(instr & 0x0E000000, 0x02000000); // Check I bit is set
6852    }
6853
6854    #[test]
6855    fn test_encode_add_registers_arm32() {
6856        let encoder = ArmEncoder::new_arm32();
6857        let op = ArmOp::Add {
6858            rd: Reg::R0,
6859            rn: Reg::R1,
6860            op2: Operand2::Reg(Reg::R2),
6861        };
6862
6863        let code = encoder.encode(&op).unwrap();
6864        assert_eq!(code.len(), 4);
6865
6866        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
6867        // Verify it's an ADD instruction with correct opcode
6868        assert_eq!(instr & 0x0FE00000, 0x00800000);
6869    }
6870
6871    #[test]
6872    fn test_encode_ldr_arm32() {
6873        let encoder = ArmEncoder::new_arm32();
6874        let op = ArmOp::Ldr {
6875            rd: Reg::R0,
6876            addr: MemAddr::imm(Reg::R1, 4),
6877        };
6878
6879        let code = encoder.encode(&op).unwrap();
6880        assert_eq!(code.len(), 4);
6881
6882        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
6883        // Verify load bit is set
6884        assert_eq!(instr & 0x00100000, 0x00100000);
6885    }
6886
6887    #[test]
6888    fn test_encode_str_arm32() {
6889        let encoder = ArmEncoder::new_arm32();
6890        let op = ArmOp::Str {
6891            rd: Reg::R0,
6892            addr: MemAddr::imm(Reg::SP, 0),
6893        };
6894
6895        let code = encoder.encode(&op).unwrap();
6896        assert_eq!(code.len(), 4);
6897    }
6898
6899    #[test]
6900    fn test_encode_branch_arm32() {
6901        let encoder = ArmEncoder::new_arm32();
6902        let op = ArmOp::Bl {
6903            label: "main".to_string(),
6904        };
6905
6906        let code = encoder.encode(&op).unwrap();
6907        assert_eq!(code.len(), 4);
6908
6909        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
6910        // Verify BL opcode
6911        assert_eq!(instr & 0x0F000000, 0x0B000000);
6912    }
6913
6914    #[test]
6915    fn test_encode_sequence() {
6916        let encoder = ArmEncoder::new_arm32();
6917        let ops = vec![
6918            ArmOp::Mov {
6919                rd: Reg::R0,
6920                op2: Operand2::Imm(42),
6921            },
6922            ArmOp::Mov {
6923                rd: Reg::R1,
6924                op2: Operand2::Imm(10),
6925            },
6926            ArmOp::Add {
6927                rd: Reg::R2,
6928                rn: Reg::R0,
6929                op2: Operand2::Reg(Reg::R1),
6930            },
6931        ];
6932
6933        let code = encoder.encode_sequence(&ops).unwrap();
6934        assert_eq!(code.len(), 12); // 3 instructions * 4 bytes
6935    }
6936
6937    #[test]
6938    fn test_reg_to_bits() {
6939        assert_eq!(reg_to_bits(&Reg::R0), 0);
6940        assert_eq!(reg_to_bits(&Reg::R7), 7);
6941        assert_eq!(reg_to_bits(&Reg::SP), 13);
6942        assert_eq!(reg_to_bits(&Reg::LR), 14);
6943        assert_eq!(reg_to_bits(&Reg::PC), 15);
6944    }
6945
6946    #[test]
6947    fn test_encode_bitwise_operations() {
6948        let encoder = ArmEncoder::new_arm32();
6949
6950        let and_op = ArmOp::And {
6951            rd: Reg::R0,
6952            rn: Reg::R1,
6953            op2: Operand2::Reg(Reg::R2),
6954        };
6955        let and_code = encoder.encode(&and_op).unwrap();
6956        assert_eq!(and_code.len(), 4);
6957
6958        let orr_op = ArmOp::Orr {
6959            rd: Reg::R0,
6960            rn: Reg::R1,
6961            op2: Operand2::Reg(Reg::R2),
6962        };
6963        let orr_code = encoder.encode(&orr_op).unwrap();
6964        assert_eq!(orr_code.len(), 4);
6965
6966        let eor_op = ArmOp::Eor {
6967            rd: Reg::R0,
6968            rn: Reg::R1,
6969            op2: Operand2::Reg(Reg::R2),
6970        };
6971        let eor_code = encoder.encode(&eor_op).unwrap();
6972        assert_eq!(eor_code.len(), 4);
6973    }
6974
6975    // === Thumb-2 32-bit encoding tests ===
6976
6977    #[test]
6978    fn test_encode_sdiv_thumb2() {
6979        let encoder = ArmEncoder::new_thumb2();
6980        let op = ArmOp::Sdiv {
6981            rd: Reg::R0,
6982            rn: Reg::R1,
6983            rm: Reg::R2,
6984        };
6985
6986        let code = encoder.encode(&op).unwrap();
6987        assert_eq!(code.len(), 4); // 32-bit Thumb-2 instruction
6988
6989        // SDIV R0, R1, R2: 0xFB91 0xF0F2
6990        // First halfword: 0xFB90 | Rn(1) = 0xFB91
6991        // Second halfword: 0xF0F0 | Rd(0)<<8 | Rm(2) = 0xF0F2
6992        // Little-endian: [0x91, 0xFB, 0xF2, 0xF0]
6993        assert_eq!(code[0], 0x91);
6994        assert_eq!(code[1], 0xFB);
6995        assert_eq!(code[2], 0xF2);
6996        assert_eq!(code[3], 0xF0);
6997    }
6998
6999    #[test]
7000    fn test_encode_udiv_thumb2() {
7001        let encoder = ArmEncoder::new_thumb2();
7002        let op = ArmOp::Udiv {
7003            rd: Reg::R0,
7004            rn: Reg::R1,
7005            rm: Reg::R2,
7006        };
7007
7008        let code = encoder.encode(&op).unwrap();
7009        assert_eq!(code.len(), 4); // 32-bit Thumb-2 instruction
7010
7011        // UDIV R0, R1, R2: 0xFBB1 0xF0F2
7012        // Little-endian: [0xB1, 0xFB, 0xF2, 0xF0]
7013        assert_eq!(code[0], 0xB1);
7014        assert_eq!(code[1], 0xFB);
7015        assert_eq!(code[2], 0xF2);
7016        assert_eq!(code[3], 0xF0);
7017    }
7018
7019    #[test]
7020    fn test_encode_mul_thumb2() {
7021        let encoder = ArmEncoder::new_thumb2();
7022        let op = ArmOp::Mul {
7023            rd: Reg::R0,
7024            rn: Reg::R1,
7025            rm: Reg::R2,
7026        };
7027
7028        let code = encoder.encode(&op).unwrap();
7029        assert_eq!(code.len(), 4); // 32-bit Thumb-2 instruction
7030    }
7031
7032    #[test]
7033    fn test_encode_and_thumb2() {
7034        let encoder = ArmEncoder::new_thumb2();
7035        let op = ArmOp::And {
7036            rd: Reg::R0,
7037            rn: Reg::R1,
7038            op2: Operand2::Reg(Reg::R2),
7039        };
7040
7041        let code = encoder.encode(&op).unwrap();
7042        assert_eq!(code.len(), 4); // 32-bit Thumb-2 instruction
7043    }
7044
7045    #[test]
7046    fn test_encode_lsl_thumb2_low_regs() {
7047        let encoder = ArmEncoder::new_thumb2();
7048        let op = ArmOp::Lsl {
7049            rd: Reg::R0,
7050            rn: Reg::R1,
7051            shift: 5,
7052        };
7053
7054        let code = encoder.encode(&op).unwrap();
7055        assert_eq!(code.len(), 2); // 16-bit for low registers
7056    }
7057
7058    #[test]
7059    fn test_encode_clz_thumb2() {
7060        let encoder = ArmEncoder::new_thumb2();
7061        let op = ArmOp::Clz {
7062            rd: Reg::R0,
7063            rm: Reg::R1,
7064        };
7065
7066        let code = encoder.encode(&op).unwrap();
7067        assert_eq!(code.len(), 4); // 32-bit Thumb-2 instruction
7068    }
7069
7070    #[test]
7071    fn test_encode_bx_thumb2() {
7072        let encoder = ArmEncoder::new_thumb2();
7073        let op = ArmOp::Bx { rm: Reg::LR };
7074
7075        let code = encoder.encode(&op).unwrap();
7076        assert_eq!(code.len(), 2); // 16-bit instruction
7077
7078        // BX LR: 0x4770
7079        assert_eq!(code, vec![0x70, 0x47]);
7080    }
7081
7082    // ========================================================================
7083    // f32 pseudo-op encoding tests
7084    // ========================================================================
7085
7086    #[test]
7087    fn test_encode_f32_abs_arm32() {
7088        let encoder = ArmEncoder::new_arm32();
7089        let op = ArmOp::F32Abs {
7090            sd: VfpReg::S0,
7091            sm: VfpReg::S2,
7092        };
7093        let code = encoder.encode(&op).unwrap();
7094        assert_eq!(code.len(), 4); // Single VFP instruction
7095    }
7096
7097    #[test]
7098    fn test_encode_f32_neg_arm32() {
7099        let encoder = ArmEncoder::new_arm32();
7100        let op = ArmOp::F32Neg {
7101            sd: VfpReg::S0,
7102            sm: VfpReg::S2,
7103        };
7104        let code = encoder.encode(&op).unwrap();
7105        assert_eq!(code.len(), 4);
7106    }
7107
7108    #[test]
7109    fn test_encode_f32_sqrt_arm32() {
7110        let encoder = ArmEncoder::new_arm32();
7111        let op = ArmOp::F32Sqrt {
7112            sd: VfpReg::S0,
7113            sm: VfpReg::S2,
7114        };
7115        let code = encoder.encode(&op).unwrap();
7116        assert_eq!(code.len(), 4);
7117    }
7118
7119    #[test]
7120    fn test_encode_f32_ceil_arm32() {
7121        let encoder = ArmEncoder::new_arm32();
7122        let op = ArmOp::F32Ceil {
7123            sd: VfpReg::S0,
7124            sm: VfpReg::S2,
7125        };
7126        let code = encoder.encode(&op).unwrap();
7127        // VMRS + BIC + ORR + VMSR + VCVT.S32.F32 + VMRS + BIC + VMSR + VCVT.F32.S32
7128        assert_eq!(code.len(), 36);
7129    }
7130
7131    #[test]
7132    fn test_encode_f32_floor_thumb2() {
7133        let encoder = ArmEncoder::new_thumb2();
7134        let op = ArmOp::F32Floor {
7135            sd: VfpReg::S0,
7136            sm: VfpReg::S2,
7137        };
7138        let code = encoder.encode(&op).unwrap();
7139        // VMRS + BIC.W + ORR.W + VMSR + VCVT + VMRS + BIC.W + VMSR + VCVT.F32.S32
7140        assert_eq!(code.len(), 36);
7141    }
7142
7143    #[test]
7144    fn test_encode_f32_min_arm32() {
7145        let encoder = ArmEncoder::new_arm32();
7146        let op = ArmOp::F32Min {
7147            sd: VfpReg::S0,
7148            sn: VfpReg::S2,
7149            sm: VfpReg::S4,
7150        };
7151        let code = encoder.encode(&op).unwrap();
7152        assert_eq!(code.len(), 16); // VMOV + VCMP + VMRS + conditional VMOV
7153    }
7154
7155    #[test]
7156    fn test_encode_f32_max_thumb2() {
7157        let encoder = ArmEncoder::new_thumb2();
7158        let op = ArmOp::F32Max {
7159            sd: VfpReg::S0,
7160            sn: VfpReg::S2,
7161            sm: VfpReg::S4,
7162        };
7163        let code = encoder.encode(&op).unwrap();
7164        // VMOV(4) + VCMP(4) + VMRS(4) + IT(2) + VMOV(4) = 18
7165        assert_eq!(code.len(), 18);
7166    }
7167
7168    #[test]
7169    fn test_encode_f32_copysign_arm32() {
7170        let encoder = ArmEncoder::new_arm32();
7171        let op = ArmOp::F32Copysign {
7172            sd: VfpReg::S0,
7173            sn: VfpReg::S2,
7174            sm: VfpReg::S4,
7175        };
7176        let code = encoder.encode(&op).unwrap();
7177        // VMOV + VMOV + AND + BIC + ORR + VMOV = 6 * 4 = 24
7178        assert_eq!(code.len(), 24);
7179    }
7180
7181    // ========================================================================
7182    // f64 encoding tests
7183    // ========================================================================
7184
7185    #[test]
7186    fn test_encode_f64_add_arm32() {
7187        let encoder = ArmEncoder::new_arm32();
7188        let op = ArmOp::F64Add {
7189            dd: VfpReg::D0,
7190            dn: VfpReg::D1,
7191            dm: VfpReg::D2,
7192        };
7193        let code = encoder.encode(&op).unwrap();
7194        assert_eq!(code.len(), 4);
7195        // VADD.F64 D0, D1, D2: check coprocessor is cp11 (0xB)
7196        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7197        assert_eq!((instr >> 8) & 0xF, 0xB); // cp11
7198    }
7199
7200    #[test]
7201    fn test_encode_f64_sub_thumb2() {
7202        let encoder = ArmEncoder::new_thumb2();
7203        let op = ArmOp::F64Sub {
7204            dd: VfpReg::D0,
7205            dn: VfpReg::D1,
7206            dm: VfpReg::D2,
7207        };
7208        let code = encoder.encode(&op).unwrap();
7209        assert_eq!(code.len(), 4); // 32-bit VFP as two Thumb halfwords
7210    }
7211
7212    #[test]
7213    fn test_encode_f64_mul_arm32() {
7214        let encoder = ArmEncoder::new_arm32();
7215        let op = ArmOp::F64Mul {
7216            dd: VfpReg::D0,
7217            dn: VfpReg::D1,
7218            dm: VfpReg::D2,
7219        };
7220        let code = encoder.encode(&op).unwrap();
7221        assert_eq!(code.len(), 4);
7222    }
7223
7224    #[test]
7225    fn test_encode_f64_div_arm32() {
7226        let encoder = ArmEncoder::new_arm32();
7227        let op = ArmOp::F64Div {
7228            dd: VfpReg::D0,
7229            dn: VfpReg::D1,
7230            dm: VfpReg::D2,
7231        };
7232        let code = encoder.encode(&op).unwrap();
7233        assert_eq!(code.len(), 4);
7234    }
7235
7236    #[test]
7237    fn test_encode_f64_abs_arm32() {
7238        let encoder = ArmEncoder::new_arm32();
7239        let op = ArmOp::F64Abs {
7240            dd: VfpReg::D0,
7241            dm: VfpReg::D2,
7242        };
7243        let code = encoder.encode(&op).unwrap();
7244        assert_eq!(code.len(), 4);
7245    }
7246
7247    #[test]
7248    fn test_encode_f64_neg_arm32() {
7249        let encoder = ArmEncoder::new_arm32();
7250        let op = ArmOp::F64Neg {
7251            dd: VfpReg::D0,
7252            dm: VfpReg::D2,
7253        };
7254        let code = encoder.encode(&op).unwrap();
7255        assert_eq!(code.len(), 4);
7256    }
7257
7258    #[test]
7259    fn test_encode_f64_sqrt_arm32() {
7260        let encoder = ArmEncoder::new_arm32();
7261        let op = ArmOp::F64Sqrt {
7262            dd: VfpReg::D0,
7263            dm: VfpReg::D2,
7264        };
7265        let code = encoder.encode(&op).unwrap();
7266        assert_eq!(code.len(), 4);
7267    }
7268
7269    #[test]
7270    fn test_encode_f64_load_arm32() {
7271        let encoder = ArmEncoder::new_arm32();
7272        let op = ArmOp::F64Load {
7273            dd: VfpReg::D0,
7274            addr: MemAddr::imm(Reg::R0, 8),
7275        };
7276        let code = encoder.encode(&op).unwrap();
7277        assert_eq!(code.len(), 4);
7278        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7279        assert_eq!((instr >> 8) & 0xF, 0xB); // cp11 for F64
7280        assert_eq!(instr & 0xFF, 2); // offset 8 / 4 = 2
7281    }
7282
7283    #[test]
7284    fn test_encode_f64_store_thumb2() {
7285        let encoder = ArmEncoder::new_thumb2();
7286        let op = ArmOp::F64Store {
7287            dd: VfpReg::D0,
7288            addr: MemAddr::imm(Reg::SP, 0),
7289        };
7290        let code = encoder.encode(&op).unwrap();
7291        assert_eq!(code.len(), 4);
7292    }
7293
7294    #[test]
7295    fn test_encode_f64_compare_arm32() {
7296        let encoder = ArmEncoder::new_arm32();
7297        let op = ArmOp::F64Eq {
7298            rd: Reg::R0,
7299            dn: VfpReg::D0,
7300            dm: VfpReg::D1,
7301        };
7302        let code = encoder.encode(&op).unwrap();
7303        assert_eq!(code.len(), 16); // VCMP + VMRS + MOV #0 + MOVcond #1
7304    }
7305
7306    #[test]
7307    fn test_encode_f64_compare_thumb2() {
7308        let encoder = ArmEncoder::new_thumb2();
7309        let op = ArmOp::F64Lt {
7310            rd: Reg::R0,
7311            dn: VfpReg::D0,
7312            dm: VfpReg::D1,
7313        };
7314        let code = encoder.encode(&op).unwrap();
7315        // VCMP(4) + VMRS(4) + MOVS(2) + IT(2) + MOV(2) = 14
7316        assert_eq!(code.len(), 14);
7317    }
7318
7319    #[test]
7320    fn test_encode_f64_const_arm32() {
7321        let encoder = ArmEncoder::new_arm32();
7322        let op = ArmOp::F64Const {
7323            dd: VfpReg::D0,
7324            value: 3.125,
7325        };
7326        let code = encoder.encode(&op).unwrap();
7327        // MOVW(4) + MOVT(4) + MOVW(4) + MOVT(4) + VMOV(4) = 20
7328        assert_eq!(code.len(), 20);
7329    }
7330
7331    #[test]
7332    fn test_encode_f64_const_thumb2() {
7333        let encoder = ArmEncoder::new_thumb2();
7334        let op = ArmOp::F64Const {
7335            dd: VfpReg::D0,
7336            value: 2.5,
7337        };
7338        let code = encoder.encode(&op).unwrap();
7339        // MOVW(4) + MOVT(4) + MOVW(4) + MOVT(4) + VMOV(4) = 20
7340        assert_eq!(code.len(), 20);
7341    }
7342
7343    #[test]
7344    fn test_encode_f64_convert_i32s_arm32() {
7345        let encoder = ArmEncoder::new_arm32();
7346        let op = ArmOp::F64ConvertI32S {
7347            dd: VfpReg::D0,
7348            rm: Reg::R0,
7349        };
7350        let code = encoder.encode(&op).unwrap();
7351        // VMOV(4) + VCVT(4) = 8
7352        assert_eq!(code.len(), 8);
7353    }
7354
7355    #[test]
7356    fn test_encode_f64_promote_f32_arm32() {
7357        let encoder = ArmEncoder::new_arm32();
7358        let op = ArmOp::F64PromoteF32 {
7359            dd: VfpReg::D0,
7360            sm: VfpReg::S0,
7361        };
7362        let code = encoder.encode(&op).unwrap();
7363        assert_eq!(code.len(), 4); // Single VCVT.F64.F32 instruction
7364    }
7365
7366    #[test]
7367    fn test_encode_f64_promote_f32_thumb2() {
7368        let encoder = ArmEncoder::new_thumb2();
7369        let op = ArmOp::F64PromoteF32 {
7370            dd: VfpReg::D0,
7371            sm: VfpReg::S0,
7372        };
7373        let code = encoder.encode(&op).unwrap();
7374        assert_eq!(code.len(), 4);
7375    }
7376
7377    #[test]
7378    fn test_encode_i32_trunc_f64s_arm32() {
7379        let encoder = ArmEncoder::new_arm32();
7380        let op = ArmOp::I32TruncF64S {
7381            rd: Reg::R0,
7382            dm: VfpReg::D0,
7383        };
7384        let code = encoder.encode(&op).unwrap();
7385        // VCVT(4) + VMOV(4) = 8
7386        assert_eq!(code.len(), 8);
7387    }
7388
7389    #[test]
7390    fn test_encode_f64_reinterpret_i64_arm32() {
7391        let encoder = ArmEncoder::new_arm32();
7392        let op = ArmOp::F64ReinterpretI64 {
7393            dd: VfpReg::D0,
7394            rmlo: Reg::R0,
7395            rmhi: Reg::R1,
7396        };
7397        let code = encoder.encode(&op).unwrap();
7398        assert_eq!(code.len(), 4); // Single VMOV instruction
7399    }
7400
7401    #[test]
7402    fn test_encode_i64_reinterpret_f64_thumb2() {
7403        let encoder = ArmEncoder::new_thumb2();
7404        let op = ArmOp::I64ReinterpretF64 {
7405            rdlo: Reg::R0,
7406            rdhi: Reg::R1,
7407            dm: VfpReg::D0,
7408        };
7409        let code = encoder.encode(&op).unwrap();
7410        assert_eq!(code.len(), 4);
7411    }
7412
7413    #[test]
7414    fn test_encode_f64_trunc_thumb2() {
7415        let encoder = ArmEncoder::new_thumb2();
7416        let op = ArmOp::F64Trunc {
7417            dd: VfpReg::D0,
7418            dm: VfpReg::D1,
7419        };
7420        let code = encoder.encode(&op).unwrap();
7421        // Two VFP instructions via Thumb encoding
7422        assert_eq!(code.len(), 8);
7423    }
7424
7425    #[test]
7426    fn test_encode_f64_min_arm32() {
7427        let encoder = ArmEncoder::new_arm32();
7428        let op = ArmOp::F64Min {
7429            dd: VfpReg::D0,
7430            dn: VfpReg::D1,
7431            dm: VfpReg::D2,
7432        };
7433        let code = encoder.encode(&op).unwrap();
7434        // VMOV + VCMP + VMRS + conditional VMOV = 16
7435        assert_eq!(code.len(), 16);
7436    }
7437
7438    #[test]
7439    fn test_f64_cp11_encoding() {
7440        // Verify that F64 instructions use coprocessor 11 (0xB), not 10 (0xA)
7441        let encoder = ArmEncoder::new_arm32();
7442
7443        // F64Add
7444        let code = encoder
7445            .encode(&ArmOp::F64Add {
7446                dd: VfpReg::D0,
7447                dn: VfpReg::D0,
7448                dm: VfpReg::D0,
7449            })
7450            .unwrap();
7451        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7452        assert_eq!((instr >> 8) & 0xF, 0xB, "F64 should use cp11");
7453
7454        // F32Add for comparison
7455        let code = encoder
7456            .encode(&ArmOp::F32Add {
7457                sd: VfpReg::S0,
7458                sn: VfpReg::S0,
7459                sm: VfpReg::S0,
7460            })
7461            .unwrap();
7462        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7463        assert_eq!((instr >> 8) & 0xF, 0xA, "F32 should use cp10");
7464    }
7465
7466    #[test]
7467    fn test_dreg_encoding_higher_registers() {
7468        let encoder = ArmEncoder::new_arm32();
7469
7470        // Test with D15 (highest register)
7471        let op = ArmOp::F64Add {
7472            dd: VfpReg::D15,
7473            dn: VfpReg::D14,
7474            dm: VfpReg::D13,
7475        };
7476        let code = encoder.encode(&op).unwrap();
7477        assert_eq!(code.len(), 4);
7478
7479        // Verify the register encoding worked (instruction is valid)
7480        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7481        assert_eq!((instr >> 8) & 0xF, 0xB); // cp11
7482    }
7483
7484    // ========================================================================
7485    // Control flow encoding tests
7486    // ========================================================================
7487
7488    #[test]
7489    fn test_encode_label_emits_no_bytes() {
7490        let encoder = ArmEncoder::new_thumb2();
7491        let op = ArmOp::Label {
7492            name: ".Lblock_end_0".to_string(),
7493        };
7494        let code = encoder.encode(&op).unwrap();
7495        assert!(code.is_empty(), "Label should emit zero bytes");
7496
7497        let encoder32 = ArmEncoder::new_arm32();
7498        let code32 = encoder32.encode(&op).unwrap();
7499        assert!(
7500            code32.is_empty(),
7501            "Label should emit zero bytes in ARM32 too"
7502        );
7503    }
7504
7505    #[test]
7506    fn test_encode_bcc_eq_thumb2() {
7507        use synth_synthesis::Condition;
7508        let encoder = ArmEncoder::new_thumb2();
7509        let op = ArmOp::Bcc {
7510            cond: Condition::EQ,
7511            label: "target".to_string(),
7512        };
7513        let code = encoder.encode(&op).unwrap();
7514        assert_eq!(code.len(), 2); // 16-bit conditional branch
7515
7516        // BEQ with offset 0: 0xD000 in little-endian
7517        assert_eq!(code, vec![0x00, 0xD0]);
7518    }
7519
7520    #[test]
7521    fn test_encode_bcc_ne_thumb2() {
7522        use synth_synthesis::Condition;
7523        let encoder = ArmEncoder::new_thumb2();
7524        let op = ArmOp::Bcc {
7525            cond: Condition::NE,
7526            label: "target".to_string(),
7527        };
7528        let code = encoder.encode(&op).unwrap();
7529        assert_eq!(code.len(), 2);
7530
7531        // BNE with offset 0: 0xD100 in little-endian
7532        assert_eq!(code, vec![0x00, 0xD1]);
7533    }
7534
7535    #[test]
7536    fn test_encode_bcc_arm32() {
7537        use synth_synthesis::Condition;
7538        let encoder = ArmEncoder::new_arm32();
7539        let op = ArmOp::Bcc {
7540            cond: Condition::EQ,
7541            label: "target".to_string(),
7542        };
7543        let code = encoder.encode(&op).unwrap();
7544        assert_eq!(code.len(), 4); // 32-bit ARM instruction
7545
7546        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7547        // BEQ: cond=0x0, opcode=0xA, offset=0
7548        assert_eq!(instr & 0xF0000000, 0x00000000); // EQ condition
7549        assert_eq!(instr & 0x0F000000, 0x0A000000); // Branch opcode
7550    }
7551
7552    #[test]
7553    fn test_encode_udf_thumb2() {
7554        let encoder = ArmEncoder::new_thumb2();
7555        let op = ArmOp::Udf { imm: 0 };
7556        let code = encoder.encode(&op).unwrap();
7557        assert_eq!(code.len(), 2); // 16-bit
7558
7559        // UDF #0: 0xDE00 in little-endian
7560        assert_eq!(code, vec![0x00, 0xDE]);
7561    }
7562
7563    #[test]
7564    fn test_encode_nop_thumb2() {
7565        let encoder = ArmEncoder::new_thumb2();
7566        let op = ArmOp::Nop;
7567        let code = encoder.encode(&op).unwrap();
7568        assert_eq!(code.len(), 2); // 16-bit
7569
7570        // NOP: 0xBF00 in little-endian
7571        assert_eq!(code, vec![0x00, 0xBF]);
7572    }
7573
7574    // =========================================================================
7575    // i64 Thumb-2 encoding tests
7576    // =========================================================================
7577
7578    #[test]
7579    fn test_encode_i64_add_thumb2() {
7580        let encoder = ArmEncoder::new_thumb2();
7581        let op = ArmOp::I64Add {
7582            rdlo: Reg::R0,
7583            rdhi: Reg::R1,
7584            rnlo: Reg::R0,
7585            rnhi: Reg::R1,
7586            rmlo: Reg::R2,
7587            rmhi: Reg::R3,
7588        };
7589        let code = encoder.encode(&op).unwrap();
7590        // Should emit ADDS (2 bytes) + ADC.W (4 bytes) = 6 bytes
7591        assert_eq!(code.len(), 6, "I64Add should be 6 bytes (ADDS + ADC.W)");
7592    }
7593
7594    #[test]
7595    fn test_encode_i64_sub_thumb2() {
7596        let encoder = ArmEncoder::new_thumb2();
7597        let op = ArmOp::I64Sub {
7598            rdlo: Reg::R0,
7599            rdhi: Reg::R1,
7600            rnlo: Reg::R0,
7601            rnhi: Reg::R1,
7602            rmlo: Reg::R2,
7603            rmhi: Reg::R3,
7604        };
7605        let code = encoder.encode(&op).unwrap();
7606        // Should emit SUBS (2 bytes) + SBC.W (4 bytes) = 6 bytes
7607        assert_eq!(code.len(), 6, "I64Sub should be 6 bytes (SUBS + SBC.W)");
7608    }
7609
7610    #[test]
7611    fn test_encode_i64_and_thumb2() {
7612        let encoder = ArmEncoder::new_thumb2();
7613        let op = ArmOp::I64And {
7614            rdlo: Reg::R0,
7615            rdhi: Reg::R1,
7616            rnlo: Reg::R0,
7617            rnhi: Reg::R1,
7618            rmlo: Reg::R2,
7619            rmhi: Reg::R3,
7620        };
7621        let code = encoder.encode(&op).unwrap();
7622        // AND.W (4 bytes) + AND.W (4 bytes) = 8 bytes
7623        assert!(code.len() >= 4, "I64And should emit at least 4 bytes");
7624    }
7625
7626    #[test]
7627    fn test_encode_i64_or_thumb2() {
7628        let encoder = ArmEncoder::new_thumb2();
7629        let op = ArmOp::I64Or {
7630            rdlo: Reg::R0,
7631            rdhi: Reg::R1,
7632            rnlo: Reg::R0,
7633            rnhi: Reg::R1,
7634            rmlo: Reg::R2,
7635            rmhi: Reg::R3,
7636        };
7637        let code = encoder.encode(&op).unwrap();
7638        assert!(code.len() >= 4, "I64Or should emit at least 4 bytes");
7639    }
7640
7641    #[test]
7642    fn test_encode_i64_xor_thumb2() {
7643        let encoder = ArmEncoder::new_thumb2();
7644        let op = ArmOp::I64Xor {
7645            rdlo: Reg::R0,
7646            rdhi: Reg::R1,
7647            rnlo: Reg::R0,
7648            rnhi: Reg::R1,
7649            rmlo: Reg::R2,
7650            rmhi: Reg::R3,
7651        };
7652        let code = encoder.encode(&op).unwrap();
7653        assert!(code.len() >= 4, "I64Xor should emit at least 4 bytes");
7654    }
7655
7656    #[test]
7657    fn test_encode_i64_const_small_thumb2() {
7658        let encoder = ArmEncoder::new_thumb2();
7659        // Small constant: only needs MOVW for each half
7660        let op = ArmOp::I64Const {
7661            rdlo: Reg::R0,
7662            rdhi: Reg::R1,
7663            value: 42,
7664        };
7665        let code = encoder.encode(&op).unwrap();
7666        // MOVW R0, #42 (4 bytes) + MOVW R1, #0 (4 bytes) = 8 bytes minimum
7667        assert!(code.len() >= 8, "I64Const should emit at least 8 bytes");
7668    }
7669
7670    #[test]
7671    fn test_encode_i64_const_large_thumb2() {
7672        let encoder = ArmEncoder::new_thumb2();
7673        // Large constant: needs MOVW+MOVT for each half
7674        let op = ArmOp::I64Const {
7675            rdlo: Reg::R0,
7676            rdhi: Reg::R1,
7677            value: 0x1234_5678_9ABC_DEF0_u64 as i64,
7678        };
7679        let code = encoder.encode(&op).unwrap();
7680        // MOVW + MOVT for lo (8 bytes) + MOVW + MOVT for hi (8 bytes) = 16 bytes
7681        assert_eq!(
7682            code.len(),
7683            16,
7684            "I64Const with large value should be 16 bytes"
7685        );
7686    }
7687
7688    #[test]
7689    fn test_encode_i64_extend_i32_s_thumb2() {
7690        let encoder = ArmEncoder::new_thumb2();
7691        let op = ArmOp::I64ExtendI32S {
7692            rdlo: Reg::R0,
7693            rdhi: Reg::R1,
7694            rn: Reg::R0,
7695        };
7696        let code = encoder.encode(&op).unwrap();
7697        // When rdlo == rn, only ASR (4 bytes) is emitted
7698        assert_eq!(
7699            code.len(),
7700            4,
7701            "I64ExtendI32S (same reg) should be 4 bytes (ASR only)"
7702        );
7703    }
7704
7705    #[test]
7706    fn test_encode_i64_extend_i32_s_diff_reg_thumb2() {
7707        let encoder = ArmEncoder::new_thumb2();
7708        let op = ArmOp::I64ExtendI32S {
7709            rdlo: Reg::R0,
7710            rdhi: Reg::R1,
7711            rn: Reg::R2,
7712        };
7713        let code = encoder.encode(&op).unwrap();
7714        // MOV rdlo, rn (2 bytes for low regs) + ASR rdhi, rdlo, #31 (4 bytes) = 6 bytes
7715        assert!(
7716            code.len() >= 6,
7717            "I64ExtendI32S (diff reg) should be at least 6 bytes"
7718        );
7719    }
7720
7721    #[test]
7722    fn test_encode_i64_extend_i32_u_thumb2() {
7723        let encoder = ArmEncoder::new_thumb2();
7724        let op = ArmOp::I64ExtendI32U {
7725            rdlo: Reg::R0,
7726            rdhi: Reg::R1,
7727            rn: Reg::R0,
7728        };
7729        let code = encoder.encode(&op).unwrap();
7730        // When rdlo == rn, only MOV rdhi, #0 (2 bytes) is emitted
7731        assert_eq!(
7732            code.len(),
7733            2,
7734            "I64ExtendI32U (same reg) should be 2 bytes (MOV #0 only)"
7735        );
7736    }
7737
7738    #[test]
7739    fn test_encode_i32_wrap_i64_nop_thumb2() {
7740        let encoder = ArmEncoder::new_thumb2();
7741        // When rd == rnlo, should be a NOP
7742        let op = ArmOp::I32WrapI64 {
7743            rd: Reg::R0,
7744            rnlo: Reg::R0,
7745        };
7746        let code = encoder.encode(&op).unwrap();
7747        assert_eq!(code.len(), 2, "I32WrapI64 same reg should be NOP (2 bytes)");
7748        assert_eq!(code, vec![0x00, 0xBF]); // NOP
7749    }
7750
7751    #[test]
7752    fn test_encode_i32_wrap_i64_diff_reg_thumb2() {
7753        let encoder = ArmEncoder::new_thumb2();
7754        let op = ArmOp::I32WrapI64 {
7755            rd: Reg::R2,
7756            rnlo: Reg::R0,
7757        };
7758        let code = encoder.encode(&op).unwrap();
7759        // MOV R2, R0 (2 or 4 bytes)
7760        assert!(
7761            code.len() >= 2,
7762            "I32WrapI64 diff reg should emit at least 2 bytes"
7763        );
7764    }
7765
7766    #[test]
7767    fn test_encode_i64_eqz_thumb2() {
7768        let encoder = ArmEncoder::new_thumb2();
7769        let op = ArmOp::I64Eqz {
7770            rd: Reg::R0,
7771            rnlo: Reg::R0,
7772            rnhi: Reg::R1,
7773        };
7774        let code = encoder.encode(&op).unwrap();
7775        // Delegates to I64SetCondZ which is already encoded
7776        assert!(
7777            code.len() >= 6,
7778            "I64Eqz should emit at least 6 bytes for ORR+ITE+MOV+MOV"
7779        );
7780    }
7781
7782    #[test]
7783    fn test_encode_i64_eq_thumb2() {
7784        let encoder = ArmEncoder::new_thumb2();
7785        let op = ArmOp::I64Eq {
7786            rd: Reg::R0,
7787            rnlo: Reg::R0,
7788            rnhi: Reg::R1,
7789            rmlo: Reg::R2,
7790            rmhi: Reg::R3,
7791        };
7792        let code = encoder.encode(&op).unwrap();
7793        // Delegates to I64SetCond EQ: CMP lo + IT EQ + CMPEQ hi + ITE EQ + MOV 1 + MOV 0
7794        assert!(code.len() >= 10, "I64Eq should emit at least 10 bytes");
7795    }
7796
7797    #[test]
7798    fn test_encode_i64_ldr_thumb2() {
7799        let encoder = ArmEncoder::new_thumb2();
7800        let op = ArmOp::I64Ldr {
7801            rdlo: Reg::R0,
7802            rdhi: Reg::R1,
7803            addr: MemAddr::imm(Reg::SP, 0),
7804        };
7805        let code = encoder.encode(&op).unwrap();
7806        // Two LDR instructions (lo at offset, hi at offset+4)
7807        assert!(code.len() >= 4, "I64Ldr should emit at least 4 bytes");
7808    }
7809
7810    #[test]
7811    fn test_encode_i64_str_thumb2() {
7812        let encoder = ArmEncoder::new_thumb2();
7813        let op = ArmOp::I64Str {
7814            rdlo: Reg::R0,
7815            rdhi: Reg::R1,
7816            addr: MemAddr::imm(Reg::SP, 0),
7817        };
7818        let code = encoder.encode(&op).unwrap();
7819        // Two STR instructions (lo at offset, hi at offset+4)
7820        assert!(code.len() >= 4, "I64Str should emit at least 4 bytes");
7821    }
7822
7823    #[test]
7824    fn test_encode_i64_all_comparisons_thumb2() {
7825        let encoder = ArmEncoder::new_thumb2();
7826
7827        let ops = vec![
7828            ArmOp::I64Ne {
7829                rd: Reg::R0,
7830                rnlo: Reg::R0,
7831                rnhi: Reg::R1,
7832                rmlo: Reg::R2,
7833                rmhi: Reg::R3,
7834            },
7835            ArmOp::I64LtS {
7836                rd: Reg::R0,
7837                rnlo: Reg::R0,
7838                rnhi: Reg::R1,
7839                rmlo: Reg::R2,
7840                rmhi: Reg::R3,
7841            },
7842            ArmOp::I64LtU {
7843                rd: Reg::R0,
7844                rnlo: Reg::R0,
7845                rnhi: Reg::R1,
7846                rmlo: Reg::R2,
7847                rmhi: Reg::R3,
7848            },
7849            ArmOp::I64LeS {
7850                rd: Reg::R0,
7851                rnlo: Reg::R0,
7852                rnhi: Reg::R1,
7853                rmlo: Reg::R2,
7854                rmhi: Reg::R3,
7855            },
7856            ArmOp::I64LeU {
7857                rd: Reg::R0,
7858                rnlo: Reg::R0,
7859                rnhi: Reg::R1,
7860                rmlo: Reg::R2,
7861                rmhi: Reg::R3,
7862            },
7863            ArmOp::I64GtS {
7864                rd: Reg::R0,
7865                rnlo: Reg::R0,
7866                rnhi: Reg::R1,
7867                rmlo: Reg::R2,
7868                rmhi: Reg::R3,
7869            },
7870            ArmOp::I64GtU {
7871                rd: Reg::R0,
7872                rnlo: Reg::R0,
7873                rnhi: Reg::R1,
7874                rmlo: Reg::R2,
7875                rmhi: Reg::R3,
7876            },
7877            ArmOp::I64GeS {
7878                rd: Reg::R0,
7879                rnlo: Reg::R0,
7880                rnhi: Reg::R1,
7881                rmlo: Reg::R2,
7882                rmhi: Reg::R3,
7883            },
7884            ArmOp::I64GeU {
7885                rd: Reg::R0,
7886                rnlo: Reg::R0,
7887                rnhi: Reg::R1,
7888                rmlo: Reg::R2,
7889                rmhi: Reg::R3,
7890            },
7891        ];
7892
7893        for op in &ops {
7894            let code = encoder.encode(op).unwrap();
7895            assert!(
7896                code.len() >= 8,
7897                "i64 comparison {:?} should emit at least 8 bytes, got {}",
7898                op,
7899                code.len()
7900            );
7901        }
7902    }
7903
7904    #[test]
7905    fn test_encode_i64_const_zero_thumb2() {
7906        let encoder = ArmEncoder::new_thumb2();
7907        let op = ArmOp::I64Const {
7908            rdlo: Reg::R0,
7909            rdhi: Reg::R1,
7910            value: 0,
7911        };
7912        let code = encoder.encode(&op).unwrap();
7913        // MOVW R0, #0 (4 bytes) + MOVW R1, #0 (4 bytes) = 8 bytes
7914        assert_eq!(code.len(), 8, "I64Const(0) should be 8 bytes");
7915    }
7916
7917    #[test]
7918    fn test_encode_i64_const_negative_one_thumb2() {
7919        let encoder = ArmEncoder::new_thumb2();
7920        let op = ArmOp::I64Const {
7921            rdlo: Reg::R0,
7922            rdhi: Reg::R1,
7923            value: -1, // 0xFFFF_FFFF_FFFF_FFFF
7924        };
7925        let code = encoder.encode(&op).unwrap();
7926        // MOVW + MOVT for lo (8 bytes) + MOVW + MOVT for hi (8 bytes) = 16 bytes
7927        assert_eq!(code.len(), 16, "I64Const(-1) should be 16 bytes");
7928    }
7929
7930    // =========================================================================
7931    // Sub-word load/store encoding tests
7932    // =========================================================================
7933
7934    #[test]
7935    fn test_encode_ldrb_arm32() {
7936        let encoder = ArmEncoder::new_arm32();
7937        let op = ArmOp::Ldrb {
7938            rd: Reg::R0,
7939            addr: MemAddr::imm(Reg::R1, 4),
7940        };
7941        let code = encoder.encode(&op).unwrap();
7942        assert_eq!(code.len(), 4, "ARM32 LDRB should be 4 bytes");
7943        // LDRB R0, [R1, #4] = 0xE5D10004
7944        let encoded = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7945        assert_eq!(encoded, 0xE5D10004, "Should encode LDRB R0, [R1, #4]");
7946    }
7947
7948    #[test]
7949    fn test_encode_strb_arm32() {
7950        let encoder = ArmEncoder::new_arm32();
7951        let op = ArmOp::Strb {
7952            rd: Reg::R0,
7953            addr: MemAddr::imm(Reg::R1, 0),
7954        };
7955        let code = encoder.encode(&op).unwrap();
7956        assert_eq!(code.len(), 4, "ARM32 STRB should be 4 bytes");
7957        // STRB R0, [R1, #0] = 0xE5C10000
7958        let encoded = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
7959        assert_eq!(encoded, 0xE5C10000, "Should encode STRB R0, [R1, #0]");
7960    }
7961
7962    #[test]
7963    fn test_encode_ldrh_arm32() {
7964        let encoder = ArmEncoder::new_arm32();
7965        let op = ArmOp::Ldrh {
7966            rd: Reg::R0,
7967            addr: MemAddr::imm(Reg::R1, 2),
7968        };
7969        let code = encoder.encode(&op).unwrap();
7970        assert_eq!(code.len(), 4, "ARM32 LDRH should be 4 bytes");
7971    }
7972
7973    #[test]
7974    fn test_encode_strh_arm32() {
7975        let encoder = ArmEncoder::new_arm32();
7976        let op = ArmOp::Strh {
7977            rd: Reg::R0,
7978            addr: MemAddr::imm(Reg::R1, 0),
7979        };
7980        let code = encoder.encode(&op).unwrap();
7981        assert_eq!(code.len(), 4, "ARM32 STRH should be 4 bytes");
7982    }
7983
7984    #[test]
7985    fn test_encode_ldrsb_arm32() {
7986        let encoder = ArmEncoder::new_arm32();
7987        let op = ArmOp::Ldrsb {
7988            rd: Reg::R0,
7989            addr: MemAddr::imm(Reg::R1, 0),
7990        };
7991        let code = encoder.encode(&op).unwrap();
7992        assert_eq!(code.len(), 4, "ARM32 LDRSB should be 4 bytes");
7993    }
7994
7995    #[test]
7996    fn test_encode_ldrsh_arm32() {
7997        let encoder = ArmEncoder::new_arm32();
7998        let op = ArmOp::Ldrsh {
7999            rd: Reg::R0,
8000            addr: MemAddr::imm(Reg::R1, 0),
8001        };
8002        let code = encoder.encode(&op).unwrap();
8003        assert_eq!(code.len(), 4, "ARM32 LDRSH should be 4 bytes");
8004    }
8005
8006    #[test]
8007    fn test_encode_ldrb_thumb2_16bit() {
8008        let encoder = ArmEncoder::new_thumb2();
8009        let op = ArmOp::Ldrb {
8010            rd: Reg::R0,
8011            addr: MemAddr::imm(Reg::R1, 4),
8012        };
8013        let code = encoder.encode(&op).unwrap();
8014        // Low registers + small offset -> 16-bit encoding
8015        assert_eq!(
8016            code.len(),
8017            2,
8018            "Thumb-2 LDRB with small offset should be 16-bit"
8019        );
8020    }
8021
8022    #[test]
8023    fn test_encode_ldrb_thumb2_32bit() {
8024        let encoder = ArmEncoder::new_thumb2();
8025        let op = ArmOp::Ldrb {
8026            rd: Reg::R0,
8027            addr: MemAddr::imm(Reg::R1, 100), // offset > 31 needs 32-bit
8028        };
8029        let code = encoder.encode(&op).unwrap();
8030        assert_eq!(
8031            code.len(),
8032            4,
8033            "Thumb-2 LDRB with large offset should be 32-bit"
8034        );
8035    }
8036
8037    #[test]
8038    fn test_encode_strb_thumb2_16bit() {
8039        let encoder = ArmEncoder::new_thumb2();
8040        let op = ArmOp::Strb {
8041            rd: Reg::R0,
8042            addr: MemAddr::imm(Reg::R1, 10),
8043        };
8044        let code = encoder.encode(&op).unwrap();
8045        assert_eq!(
8046            code.len(),
8047            2,
8048            "Thumb-2 STRB with small offset should be 16-bit"
8049        );
8050    }
8051
8052    #[test]
8053    fn test_encode_ldrh_thumb2_16bit() {
8054        let encoder = ArmEncoder::new_thumb2();
8055        let op = ArmOp::Ldrh {
8056            rd: Reg::R0,
8057            addr: MemAddr::imm(Reg::R1, 4), // offset aligned to 2, <= 62
8058        };
8059        let code = encoder.encode(&op).unwrap();
8060        assert_eq!(
8061            code.len(),
8062            2,
8063            "Thumb-2 LDRH with small aligned offset should be 16-bit"
8064        );
8065    }
8066
8067    #[test]
8068    fn test_encode_strh_thumb2_16bit() {
8069        let encoder = ArmEncoder::new_thumb2();
8070        let op = ArmOp::Strh {
8071            rd: Reg::R0,
8072            addr: MemAddr::imm(Reg::R1, 4),
8073        };
8074        let code = encoder.encode(&op).unwrap();
8075        assert_eq!(
8076            code.len(),
8077            2,
8078            "Thumb-2 STRH with small aligned offset should be 16-bit"
8079        );
8080    }
8081
8082    #[test]
8083    fn test_encode_ldrsb_thumb2() {
8084        let encoder = ArmEncoder::new_thumb2();
8085        let op = ArmOp::Ldrsb {
8086            rd: Reg::R0,
8087            addr: MemAddr::imm(Reg::R1, 0),
8088        };
8089        let code = encoder.encode(&op).unwrap();
8090        // LDRSB has no 16-bit immediate form, always 32-bit
8091        assert_eq!(code.len(), 4, "Thumb-2 LDRSB should be 32-bit");
8092    }
8093
8094    #[test]
8095    fn test_encode_ldrsh_thumb2() {
8096        let encoder = ArmEncoder::new_thumb2();
8097        let op = ArmOp::Ldrsh {
8098            rd: Reg::R0,
8099            addr: MemAddr::imm(Reg::R1, 0),
8100        };
8101        let code = encoder.encode(&op).unwrap();
8102        assert_eq!(code.len(), 4, "Thumb-2 LDRSH should be 32-bit");
8103    }
8104
8105    #[test]
8106    fn test_encode_memory_size_thumb2() {
8107        let encoder = ArmEncoder::new_thumb2();
8108        let op = ArmOp::MemorySize { rd: Reg::R0 };
8109        let code = encoder.encode(&op).unwrap();
8110        // R0 and R10 are not both low registers, so this needs careful handling
8111        assert!(!code.is_empty(), "MemorySize should produce code");
8112    }
8113
8114    #[test]
8115    fn test_encode_memory_grow_thumb2() {
8116        let encoder = ArmEncoder::new_thumb2();
8117        let op = ArmOp::MemoryGrow {
8118            rd: Reg::R0,
8119            rn: Reg::R0,
8120        };
8121        let code = encoder.encode(&op).unwrap();
8122        assert_eq!(code.len(), 4, "MemoryGrow (MVN) should be 32-bit Thumb-2");
8123    }
8124
8125    #[test]
8126    fn test_encode_subword_reg_offset_thumb2() {
8127        let encoder = ArmEncoder::new_thumb2();
8128
8129        // LDRB with register offset
8130        let op = ArmOp::Ldrb {
8131            rd: Reg::R0,
8132            addr: MemAddr::reg(Reg::R1, Reg::R2),
8133        };
8134        let code = encoder.encode(&op).unwrap();
8135        assert_eq!(
8136            code.len(),
8137            4,
8138            "Thumb-2 LDRB with reg offset should be 32-bit"
8139        );
8140
8141        // STRB with register offset
8142        let op = ArmOp::Strb {
8143            rd: Reg::R0,
8144            addr: MemAddr::reg(Reg::R1, Reg::R2),
8145        };
8146        let code = encoder.encode(&op).unwrap();
8147        assert_eq!(
8148            code.len(),
8149            4,
8150            "Thumb-2 STRB with reg offset should be 32-bit"
8151        );
8152
8153        // LDRH with register offset
8154        let op = ArmOp::Ldrh {
8155            rd: Reg::R0,
8156            addr: MemAddr::reg(Reg::R1, Reg::R2),
8157        };
8158        let code = encoder.encode(&op).unwrap();
8159        assert_eq!(
8160            code.len(),
8161            4,
8162            "Thumb-2 LDRH with reg offset should be 32-bit"
8163        );
8164
8165        // STRH with register offset
8166        let op = ArmOp::Strh {
8167            rd: Reg::R0,
8168            addr: MemAddr::reg(Reg::R1, Reg::R2),
8169        };
8170        let code = encoder.encode(&op).unwrap();
8171        assert_eq!(
8172            code.len(),
8173            4,
8174            "Thumb-2 STRH with reg offset should be 32-bit"
8175        );
8176    }
8177
8178    #[test]
8179    fn test_encode_subword_reg_imm_offset_thumb2() {
8180        let encoder = ArmEncoder::new_thumb2();
8181
8182        // LDRB with both register and immediate offset
8183        let op = ArmOp::Ldrb {
8184            rd: Reg::R0,
8185            addr: MemAddr::reg_imm(Reg::R1, Reg::R2, 4),
8186        };
8187        let code = encoder.encode(&op).unwrap();
8188        // ADD R12, R2, #4 (4 bytes) + LDRB R0, [R1, R12] (4 bytes) = 8 bytes
8189        assert_eq!(
8190            code.len(),
8191            8,
8192            "Thumb-2 LDRB with reg+imm offset should be 8 bytes"
8193        );
8194    }
8195
8196    // ========================================================================
8197    // Helium MVE encoding tests
8198    // ========================================================================
8199
8200    #[test]
8201    fn test_encode_mve_addi32_thumb2() {
8202        let encoder = ArmEncoder::new_thumb2();
8203        let op = ArmOp::MveAddI {
8204            qd: QReg::Q0,
8205            qn: QReg::Q1,
8206            qm: QReg::Q2,
8207            size: MveSize::S32,
8208        };
8209        let code = encoder.encode(&op).unwrap();
8210        assert_eq!(
8211            code.len(),
8212            4,
8213            "MVE VADD.I32 should be 4 bytes (Thumb-2 32-bit)"
8214        );
8215    }
8216
8217    #[test]
8218    fn test_encode_mve_subi16_thumb2() {
8219        let encoder = ArmEncoder::new_thumb2();
8220        let op = ArmOp::MveSubI {
8221            qd: QReg::Q0,
8222            qn: QReg::Q1,
8223            qm: QReg::Q2,
8224            size: MveSize::S16,
8225        };
8226        let code = encoder.encode(&op).unwrap();
8227        assert_eq!(code.len(), 4, "MVE VSUB.I16 should be 4 bytes");
8228    }
8229
8230    #[test]
8231    fn test_encode_mve_muli8_thumb2() {
8232        let encoder = ArmEncoder::new_thumb2();
8233        let op = ArmOp::MveMulI {
8234            qd: QReg::Q0,
8235            qn: QReg::Q1,
8236            qm: QReg::Q2,
8237            size: MveSize::S8,
8238        };
8239        let code = encoder.encode(&op).unwrap();
8240        assert_eq!(code.len(), 4, "MVE VMUL.I8 should be 4 bytes");
8241    }
8242
8243    #[test]
8244    fn test_encode_mve_bitwise_thumb2() {
8245        let encoder = ArmEncoder::new_thumb2();
8246
8247        let ops = vec![
8248            ArmOp::MveAnd {
8249                qd: QReg::Q0,
8250                qn: QReg::Q1,
8251                qm: QReg::Q2,
8252            },
8253            ArmOp::MveOrr {
8254                qd: QReg::Q0,
8255                qn: QReg::Q1,
8256                qm: QReg::Q2,
8257            },
8258            ArmOp::MveEor {
8259                qd: QReg::Q0,
8260                qn: QReg::Q1,
8261                qm: QReg::Q2,
8262            },
8263            ArmOp::MveBic {
8264                qd: QReg::Q0,
8265                qn: QReg::Q1,
8266                qm: QReg::Q2,
8267            },
8268        ];
8269        for op in ops {
8270            let code = encoder.encode(&op).unwrap();
8271            assert_eq!(code.len(), 4, "MVE bitwise op should be 4 bytes");
8272        }
8273    }
8274
8275    #[test]
8276    fn test_encode_mve_mvn_thumb2() {
8277        let encoder = ArmEncoder::new_thumb2();
8278        let op = ArmOp::MveMvn {
8279            qd: QReg::Q0,
8280            qm: QReg::Q1,
8281        };
8282        let code = encoder.encode(&op).unwrap();
8283        assert_eq!(code.len(), 4, "MVE VMVN should be 4 bytes");
8284    }
8285
8286    #[test]
8287    fn test_encode_mve_load_store_thumb2() {
8288        let encoder = ArmEncoder::new_thumb2();
8289
8290        let load = ArmOp::MveLoad {
8291            qd: QReg::Q0,
8292            addr: MemAddr::imm(Reg::R0, 16),
8293        };
8294        let code = encoder.encode(&load).unwrap();
8295        assert_eq!(code.len(), 4, "MVE VLDRW.32 should be 4 bytes");
8296
8297        let store = ArmOp::MveStore {
8298            qd: QReg::Q1,
8299            addr: MemAddr::imm(Reg::R1, 0),
8300        };
8301        let code = encoder.encode(&store).unwrap();
8302        assert_eq!(code.len(), 4, "MVE VSTRW.32 should be 4 bytes");
8303    }
8304
8305    #[test]
8306    fn test_encode_mve_const_thumb2() {
8307        let encoder = ArmEncoder::new_thumb2();
8308        let op = ArmOp::MveConst {
8309            qd: QReg::Q0,
8310            bytes: [1, 0, 0, 0, 2, 0, 0, 0, 3, 0, 0, 0, 4, 0, 0, 0],
8311        };
8312        let code = encoder.encode(&op).unwrap();
8313        // Should be 4 words of (MOVW R12 + VMOV Sn) = 4 * (4+4) = 32 bytes min
8314        // Some words with hi16=0 skip MOVT, so length varies
8315        assert!(
8316            code.len() >= 24,
8317            "MVE const should produce multiple instructions"
8318        );
8319    }
8320
8321    #[test]
8322    fn test_encode_mve_dup_thumb2() {
8323        let encoder = ArmEncoder::new_thumb2();
8324        let op = ArmOp::MveDup {
8325            qd: QReg::Q0,
8326            rn: Reg::R0,
8327            size: MveSize::S32,
8328        };
8329        let code = encoder.encode(&op).unwrap();
8330        assert_eq!(code.len(), 4, "MVE VDUP.32 should be 4 bytes");
8331    }
8332
8333    #[test]
8334    fn test_encode_mve_extract_lane_thumb2() {
8335        let encoder = ArmEncoder::new_thumb2();
8336        let op = ArmOp::MveExtractLane {
8337            rd: Reg::R0,
8338            qn: QReg::Q1,
8339            lane: 2,
8340            size: MveSize::S32,
8341        };
8342        let code = encoder.encode(&op).unwrap();
8343        assert_eq!(code.len(), 4, "MVE extract lane should be 4 bytes");
8344    }
8345
8346    #[test]
8347    fn test_encode_mve_insert_lane_thumb2() {
8348        let encoder = ArmEncoder::new_thumb2();
8349        let op = ArmOp::MveInsertLane {
8350            qd: QReg::Q0,
8351            rn: Reg::R1,
8352            lane: 3,
8353            size: MveSize::S32,
8354        };
8355        let code = encoder.encode(&op).unwrap();
8356        assert_eq!(code.len(), 4, "MVE insert lane should be 4 bytes");
8357    }
8358
8359    #[test]
8360    fn test_encode_mve_addf32_thumb2() {
8361        let encoder = ArmEncoder::new_thumb2();
8362        let op = ArmOp::MveAddF32 {
8363            qd: QReg::Q0,
8364            qn: QReg::Q1,
8365            qm: QReg::Q2,
8366        };
8367        let code = encoder.encode(&op).unwrap();
8368        assert_eq!(code.len(), 4, "MVE VADD.F32 should be 4 bytes");
8369    }
8370
8371    #[test]
8372    fn test_encode_mve_divf32_thumb2() {
8373        let encoder = ArmEncoder::new_thumb2();
8374        let op = ArmOp::MveDivF32 {
8375            qd: QReg::Q0,
8376            qn: QReg::Q1,
8377            qm: QReg::Q2,
8378        };
8379        let code = encoder.encode(&op).unwrap();
8380        // Lane-wise: 4 x VDIV.F32 = 4 x 4 = 16 bytes
8381        assert_eq!(
8382            code.len(),
8383            16,
8384            "MVE VDIV.F32 (lane-wise) should be 16 bytes"
8385        );
8386    }
8387
8388    #[test]
8389    fn test_encode_mve_sqrtf32_thumb2() {
8390        let encoder = ArmEncoder::new_thumb2();
8391        let op = ArmOp::MveSqrtF32 {
8392            qd: QReg::Q0,
8393            qm: QReg::Q1,
8394        };
8395        let code = encoder.encode(&op).unwrap();
8396        // Lane-wise: 4 x VSQRT.F32 = 4 x 4 = 16 bytes
8397        assert_eq!(
8398            code.len(),
8399            16,
8400            "MVE VSQRT.F32 (lane-wise) should be 16 bytes"
8401        );
8402    }
8403
8404    #[test]
8405    fn test_encode_mve_negf32_thumb2() {
8406        let encoder = ArmEncoder::new_thumb2();
8407        let op = ArmOp::MveNegF32 {
8408            qd: QReg::Q0,
8409            qm: QReg::Q1,
8410        };
8411        let code = encoder.encode(&op).unwrap();
8412        assert_eq!(code.len(), 4, "MVE VNEG.F32 should be 4 bytes");
8413    }
8414
8415    #[test]
8416    fn test_encode_mve_absf32_thumb2() {
8417        let encoder = ArmEncoder::new_thumb2();
8418        let op = ArmOp::MveAbsF32 {
8419            qd: QReg::Q0,
8420            qm: QReg::Q1,
8421        };
8422        let code = encoder.encode(&op).unwrap();
8423        assert_eq!(code.len(), 4, "MVE VABS.F32 should be 4 bytes");
8424    }
8425
8426    #[test]
8427    fn test_encode_mve_different_qregs() {
8428        let encoder = ArmEncoder::new_thumb2();
8429
8430        // Test that different Q-register numbers produce different encodings
8431        let op1 = ArmOp::MveAddI {
8432            qd: QReg::Q0,
8433            qn: QReg::Q0,
8434            qm: QReg::Q0,
8435            size: MveSize::S32,
8436        };
8437        let op2 = ArmOp::MveAddI {
8438            qd: QReg::Q3,
8439            qn: QReg::Q5,
8440            qm: QReg::Q7,
8441            size: MveSize::S32,
8442        };
8443        let code1 = encoder.encode(&op1).unwrap();
8444        let code2 = encoder.encode(&op2).unwrap();
8445        assert_ne!(
8446            code1, code2,
8447            "Different Q-registers should produce different encodings"
8448        );
8449    }
8450
8451    #[test]
8452    fn test_encode_mve_arm32_nop() {
8453        // MVE instructions on ARM32 encoder should produce NOP (only Thumb-2 supported)
8454        let encoder = ArmEncoder::new_arm32();
8455        let op = ArmOp::MveAddI {
8456            qd: QReg::Q0,
8457            qn: QReg::Q1,
8458            qm: QReg::Q2,
8459            size: MveSize::S32,
8460        };
8461        let code = encoder.encode(&op).unwrap();
8462        assert_eq!(code.len(), 4, "ARM32 MVE should be 4 bytes (NOP)");
8463        // NOP in ARM32 is 0xE1A00000 (MOV R0, R0)
8464        let instr = u32::from_le_bytes([code[0], code[1], code[2], code[3]]);
8465        assert_eq!(instr, 0xE1A00000, "ARM32 MVE should encode as NOP");
8466    }
8467}