From c70195a81e76ea4dae100e1d9554e8425140f13b Mon Sep 17 00:00:00 2001
From: ceriel <none@none>
Date: Tue, 22 Jan 1991 12:01:25 +0000
Subject: [PATCH] assembling of (xxx,a6) addressing mode was wrong for large
 values of xxx

---
 mach/m68020/ce/as.c   | 34 +++++++++++++++++++++++++++++-----
 mach/m68020/ce/mach.c | 41 +++++++++++++++++++++++++++++++++++++++++
 2 files changed, 70 insertions(+), 5 deletions(-)

diff --git a/mach/m68020/ce/as.c b/mach/m68020/ce/as.c
index 8a048abef..177c75840 100644
--- a/mach/m68020/ce/as.c
+++ b/mach/m68020/ce/as.c
@@ -317,8 +317,15 @@ code_instr( opcode, field1, field2, eaddr)
 int opcode, field1, field2;
 struct t_operand *eaddr;
 {
-	code_opcode( opcode, field1, field2, eaddr);
-	code_extension( eaddr);
+	if (eaddr->type == IS_IND_REG_DISPL) {
+		@__instr_code(%d(((opcode & 0xf) << 12) | ((field1 & 0x7) << 9) |
+			        ((field2 & 0x7) << 6)),
+			      %d(eaddr->reg), %$(eaddr->expr));
+	}
+	else {
+		code_opcode( opcode, field1, field2, eaddr);
+		code_extension( eaddr);
+	}
 }
 
 
@@ -326,10 +333,27 @@ code_move( size, src, dst)
 int size;
 struct t_operand *src, *dst;
 {
-	@text2( %d( ((size & 0x3) << 12) | ((reg_mode( dst) & 0x3f) << 6) |
+	if (src->type == IS_IND_REG_DISPL) {
+		if (dst->type == IS_IND_REG_DISPL) {
+			@__moveXX(%d( ((size & 0x3) << 12)),
+				 %d(dst->reg), %$(dst->expr),
+				 %d(src->reg), %$(src->expr));
+		}
+		else {
+			@__instr_code(%d( ((size & 0x3) << 12)|((reg_mode( dst) & 0x3f) << 6)),
+				 %d(src->reg), %$(src->expr));
+		}
+	}
+	else if (dst->type == IS_IND_REG_DISPL) {
+		@__move_X(%d( ((size & 0x3) << 12) | (mode_reg( src) & 0x3f)),
+			 %d(dst->reg), %$(dst->expr));
+	}
+	else {
+		@text2( %d( ((size & 0x3) << 12) | ((reg_mode( dst) & 0x3f) << 6) |
 		    	     		   (mode_reg( src) & 0x3f)));
-	code_extension( src);
-	code_extension( dst);
+		code_extension( src);
+		code_extension( dst);
+	}
 }
 
 
diff --git a/mach/m68020/ce/mach.c b/mach/m68020/ce/mach.c
index 7ec7656f4..290a1a2aa 100644
--- a/mach/m68020/ce/mach.c
+++ b/mach/m68020/ce/mach.c
@@ -31,3 +31,44 @@ char *filename;
 #define FL_MSW_AT_LOW_ADDRESS	1
 #define FL_MSB_AT_LOW_ADDRESS	1
 #include <con_float>
+
+__instr_code(code, reg, off)
+{
+  if (off <= 32767 & off >= -32768) {
+	text2(code|0x28|reg);
+	text2(off);
+	return;
+  }
+  text2(code|0x30|reg);
+  text2(0x0170);
+  text4(off);
+}
+
+__move_X(code, reg, off)
+{
+  if (off <= 32767 & off >= -32768) {
+	text2(code|(reg<<9)|0x140);
+	text2(off);
+	return;
+  }
+  text2(code|(reg<<9)|0x180);
+  text2(0x0170);
+  text4(off);
+}
+
+__moveXX(code, srcreg, srcoff, dstreg, dstoff)
+{
+  if (srcoff <= 32767 && srcoff >= -32768) {
+	__move_X(code|0x28|srcreg, dstreg, dstoff);
+	return;
+  }
+  if (dstoff <= 32767 && dstoff >= -32768) {
+	__instr_code(code|0x140|(dstreg<<9), srcreg, srcoff);
+	return;
+  }
+  text2(code|(dstreg<<9)|srcreg|0x180|0x30);
+  text2(0x0170);
+  text4(srcoff);
+  text2(0x0170);
+  text4(dstoff);
+}