X-Git-Url: http://shamusworld.gotdns.org/cgi-bin/gitweb.cgi?p=rmac;a=blobdiff_plain;f=direct.c;h=b3f51f3c3b73356c638a0dc9b087cc20f67ab58d;hp=d535c4842b40870f794dfeb424e28093b96c6dea;hb=c38505ee4b2a0de59926107e52fb8bb84041a0e4;hpb=f3c7d186a15b89c39e360b9cc89545a0d24bd6a4

diff --git a/direct.c b/direct.c
index d535c48..b3f51f3 100644
--- a/direct.c
+++ b/direct.c
@@ -1,7 +1,7 @@
 //
 // RMAC - Reboot's Macro Assembler for all Atari computers
 // DIRECT.C - Directive Handling
-// Copyright (C) 199x Landon Dyer, 2011-2017 Reboot and Friends
+// Copyright (C) 199x Landon Dyer, 2011-2020 Reboot and Friends
 // RMAC derived from MADMAC v1.07 Written by Landon Dyer, 1986
 // Source utilised with the kind permission of Landon Dyer
 //
@@ -9,8 +9,10 @@
 #include "direct.h"
 #include "6502.h"
 #include "amode.h"
+#include "dsp56k.h"
 #include "error.h"
 #include "expr.h"
+#include "fltpoint.h"
 #include "listing.h"
 #include "mach.h"
 #include "macro.h"
@@ -20,16 +22,12 @@
 #include "sect.h"
 #include "symbol.h"
 #include "token.h"
-#include "math.h"
-#include "sect.h"
 
 #define DEF_KW
 #include "kwtab.h"
 
-// N.B.: It's perfectly fine to keep exprbuf as an array of TOKENS and to cast
-//       to a TOKENPTR where needed. But this works too. :-P
-TOKEN _exprbuf[128];		// Expression buffer
-TOKENPTR exprbuf = (TOKENPTR)_exprbuf;	// Expression buffer point
+
+TOKEN exprbuf[128];			// Expression buffer
 SYM * symbolPtr[1000000];	// Symbol pointers table
 static long unused;			// For supressing 'write' warnings
 char buffer[256];			// Scratch buffer for messages
@@ -38,7 +36,6 @@ int largestAlign[3] = { 2, 2, 2 };	// Largest alignment value seen per section
 // Function prototypes
 int d_unimpl(void);
 int d_68000(void);
-int d_68000(void);
 int d_68020(void);
 int d_68030(void);
 int d_68040(void);
@@ -54,6 +51,7 @@ int d_abs(void);
 int d_comm(void);
 int d_dc(WORD);
 int d_ds(WORD);
+int d_dsm(WORD);
 int d_dcb(WORD);
 int d_globl(void);
 int d_gpu(void);
@@ -83,6 +81,7 @@ int d_cstruct(void);
 int d_prgflags(void);
 int d_opt(void);
 int d_dsp(void);
+int d_objproc(void);
 void SetLargestAlignment(int);
 
 // Directive handler table
@@ -153,7 +152,9 @@ int (*dirtab[])() = {
 	d_68882,			// 63 .68882
 	d_56001,			// 64 .56001
 	d_nofpu,			// 65 nofpu
-	d_opt,				// 58 .opt
+	d_opt,				// 66 .opt
+	d_objproc,			// 67 .objproc
+	d_dsm,				// 68 .dsm
 };
 
 
@@ -176,14 +177,14 @@ void SetLargestAlignment(int size)
 //
 int d_error(char *str)
 {
-	if (*tok.u32 == EOL)
+	if (*tok == EOL)
 		return error("error directive encountered - aborting assembling");
 	else
 	{
-		switch(*tok.u32)
+		switch(*tok)
 		{
 		case STRING:
-			return error(string[tok.u32[1]]);
+			return error(string[tok[1]]);
 			break;
 		default:
 			return error("error directive encountered--aborting assembly");
@@ -197,14 +198,14 @@ int d_error(char *str)
 //
 int d_warn(char *str)
 {
-	if (*tok.u32 == EOL)
+	if (*tok == EOL)
 		return warn("WARNING WARNING WARNING");
 	else
 	{
-		switch(*tok.u32)
+		switch(*tok)
 		{
 		case STRING:
-			return warn(string[tok.u32[1]]);
+			return warn(string[tok[1]]);
 			break;
 		default:
 			return warn("WARNING WARNING WARNING");
@@ -220,23 +221,26 @@ int d_org(void)
 {
 	uint64_t address;
 
-	if (!rgpu && !rdsp && !m6502)
-		return error(".org permitted only in gpu/dsp and 6502 sections");
+	if (!rgpu && !rdsp && !robjproc && !m6502 && !dsp56001)
+		return error(".org permitted only in GPU/DSP/OP, 56001 and 6502 sections");
 
-	if (abs_expr(&address) == ERROR)
+	// M56K can leave the expression off the org for some reason :-/
+	// (It's because the expression is non-standard, and so we have to look at
+	// it in isolation)
+	if (!dsp56001 && (abs_expr(&address) == ERROR))
 	{
 		error("cannot determine org'd address");
 		return ERROR;
 	}
 
-	if (rgpu | rdsp)
+	if (rgpu | rdsp | robjproc)
 	{
 		orgaddr = address;
 		orgactive = 1;
 	}
-	else
+	else if (m6502)
 	{
-		// 6502.  We also kludge `lsloc' so the listing generator doesn't try
+		// 6502.  We also kludge 'lsloc' so the listing generator doesn't try
 		// to spew out megabytes.
 		if (address > 0xFFFF)
 			return error(range_error);
@@ -253,9 +257,97 @@ int d_org(void)
 		chptr = scode->chptr + address;
 		orgaddr = address;
 		orgactive = 1;
-		at_eol();
 	}
+	else if (dsp56001)
+	{
+		// Only mark segments we actually wrote something
+		if (chptr != dsp_currentorg->start && dsp_written_data_in_current_org)
+		{
+			dsp_currentorg->end = chptr;
+			dsp_currentorg++;
+		}
+
+		// Maybe we switched from a non-DSP section (TEXT, DATA, etc) and
+		// scode isn't initialised yet. Not that it's going to be a valid
+		// scenario, but if we try it anyhow it's going to lead to a crash. So
+		// let's fudge a value of 0 and get on with it.
+		orgaddr = (scode != NULL ? sloc : 0);
+		SaveSection();
 
+		if (tok[1] != ':')
+			return error(syntax_error);
+
+		int sectionToSwitch = 0;
+
+		switch (tok[0])
+		{
+		case KW_X:
+			dsp_currentorg->memtype = ORG_X;
+			sectionToSwitch = M56001X;
+			break;
+
+		case KW_Y:
+			dsp_currentorg->memtype = ORG_Y;
+			sectionToSwitch = M56001Y;
+			break;
+
+		case KW_P:
+			dsp_currentorg->memtype = ORG_P;
+			sectionToSwitch = M56001P;
+			break;
+
+		case KW_L:
+			dsp_currentorg->memtype = ORG_L;
+			sectionToSwitch = M56001L;
+			break;
+
+		default:
+			return error("unknown type in ORG");
+		}
+
+		if ((obj_format == LOD) || (obj_format == P56))
+			SwitchSection(sectionToSwitch);
+
+		tok += 2;
+		chcheck(3); // Ensure we got a valid address to write
+		dsp_currentorg->chunk = scode;  // Mark down which chunk this org starts from (will be needed when outputting)
+
+		if (*tok == EOL)
+		{
+			// Well, the user didn't specify an address at all so we'll have to
+			// use the last used address of that section (or 0 if there wasn't one)
+			address = orgaddr;
+			dsp_currentorg->start = chptr;
+			dsp_currentorg->orgadr = orgaddr;
+		}
+		else
+		{
+			if (abs_expr(&address) == ERROR)
+			{
+				error("cannot determine org'd address");
+				return ERROR;
+			}
+
+			dsp_currentorg->start = chptr;
+			dsp_currentorg->orgadr = (uint32_t)address;
+			sect[cursect].orgaddr = (uint32_t)address;
+		}
+
+		if (address > DSP_MAX_RAM)
+		{
+			return error(range_error);
+		}
+
+		dsp_written_data_in_current_org = 0;
+
+		// Copied from 6502 above: kludge `lsloc' so the listing generator
+		// doesn't try to spew out megabytes.
+		lsloc = sloc = (int32_t)address;
+// N.B.: It seems that by enabling this, even though it works elsewhere, will cause symbols to royally fuck up.  Will have to do some digging to figure out why.
+//		orgactive = 1;
+	}
+
+	ErrorIfNotAtEOL();
 	return 0;
 }
 
@@ -276,47 +368,61 @@ int d_print(void)
 	SYM * esym;					// External symbol involved in expr.
 	TOKEN r_expr[EXPRSIZE];
 
-	while (*tok.u32 != EOL)
+	while (*tok != EOL)
 	{
-		switch(*tok.u32)
+		switch (*tok)
 		{
 		case STRING:
-			sprintf(prntstr, "%s", string[tok.u32[1]]);
+			sprintf(prntstr, "%s", string[tok[1]]);
 			printf("%s", prntstr);
 
 			if (list_fd)
 				unused = write(list_fd, prntstr, (LONG)strlen(prntstr));
 
-			tok.u32 += 2;
+			tok += 2;
 			break;
 		case '/':
 			formatting = 1;
 
-			if (tok.u32[1] != SYMBOL)
+			// "X" & "L" get tokenized now... :-/ Probably should look into preventing this kind of thing from happening (was added with DSP56K code)
+			if ((tok[1] != SYMBOL) && (tok[1] != KW_L) && (tok[1] != KW_X))
 				goto token_err;
 
-//			strcpy(prntstr, (char *)tok.u32[2]);
-			strcpy(prntstr, string[tok.u32[2]]);
-
-			switch(prntstr[0])
+			if (tok[1] == KW_L)
 			{
-			case 'l': case 'L': wordlong = 1; break;
-			case 'w': case 'W': wordlong = 0; break;
-			case 'x': case 'X': outtype  = 0; break;
-			case 'd': case 'D': outtype  = 1; break;
-			case 'u': case 'U': outtype  = 2; break;
-			default:
-				error("unknown print format flag");
-				return ERROR;
+				wordlong = 1;
+				tok += 2;
+			}
+			else if (tok[1] == KW_X)
+			{
+				outtype = 0;
+				tok += 2;
+			}
+			else
+			{
+				strcpy(prntstr, string[tok[2]]);
+
+				switch (prntstr[0])
+				{
+				case 'l': case 'L': wordlong = 1; break;
+				case 'w': case 'W': wordlong = 0; break;
+				case 'x': case 'X': outtype  = 0; break;
+				case 'd': case 'D': outtype  = 1; break;
+				case 'u': case 'U': outtype  = 2; break;
+				default:
+					error("unknown print format flag");
+					return ERROR;
+				}
+
+				tok += 3;
 			}
 
-			tok.u32 += 3;
 			break;
 		case ',':
-			tok.u32++;
+			tok++;
 			break;
 		default:
-			if (expr((TOKENPTR)r_expr, &eval, &eattr, &esym) != OK)
+			if (expr(r_expr, &eval, &eattr, &esym) != OK)
 				goto token_err;
 			else
 			{
@@ -351,7 +457,7 @@ int d_print(void)
 	return 0;
 
 token_err:
-	error("illegal print token");
+	error("illegal print token [@ '%s']", prntstr);
 	return ERROR;
 }
 
@@ -370,13 +476,13 @@ int d_ccundef(void)
 		return ERROR;
 	}
 
-	if (*tok.u32 != SYMBOL)
+	if (*tok != SYMBOL)
 	{
 		error("syntax error; expected symbol");
 		return ERROR;
 	}
 
-	ccname = lookup(string[tok.u32[1]], LABEL, 0);
+	ccname = lookup(string[tok[1]], LABEL, 0);
 
 	// Make sure symbol is a valid ccdef
 	if (!ccname || !(ccname->sattre & EQUATEDCC))
@@ -402,18 +508,18 @@ int d_equrundef(void)
 	if (!rgpu && !rdsp)
 		return error(".equrundef/.regundef must be defined in .gpu/.dsp section");
 
-	while (*tok.u32 != EOL)
+	while (*tok != EOL)
 	{
 		// Skip preceeding or seperating commas (if any)
-		if (*tok.u32 == ',')
-			tok.u32++;
+		if (*tok == ',')
+			tok++;
 
 		// Check we are dealing with a symbol
-		if (*tok.u32 != SYMBOL)
+		if (*tok != SYMBOL)
 			return error("syntax error; expected symbol");
 
 		// Lookup and undef if equated register
-		regname = lookup(string[tok.u32[1]], LABEL, 0);
+		regname = lookup(string[tok[1]], LABEL, 0);
 
 		if (regname && (regname->sattre & EQUATEDREG))
 		{
@@ -424,7 +530,7 @@ int d_equrundef(void)
 		}
 
 		// Skip over symbol token and address
-		tok.u32 += 2;
+		tok += 2;
 	}
 
 	return 0;
@@ -455,20 +561,20 @@ int d_incbin(void)
 	// Check to see if we're in BSS, and, if so, throw an error
 	if (scattr & SBSS)
 	{
-		error("cannot include binary file \"%s\" in BSS section", string[tok.u32[1]]);
+		error("cannot include binary file \"%s\" in BSS section", string[tok[1]]);
 		return ERROR;
 	}
 
-	if (*tok.u32 != STRING)
+	if (*tok != STRING)
 	{
-		error("syntax error; string missing");
+		error("syntax error; file to include missing");
 		return ERROR;
 	}
 
 	// Attempt to open the include file in the current directory, then (if that
 	// failed) try list of include files passed in the enviroment string or by
 	// the "-d" option.
-	if ((fd = open(string[tok.u32[1]], _OPEN_INC)) < 0)
+	if ((fd = open(string[tok[1]], _OPEN_INC)) < 0)
 	{
 		for(i=0; nthpath("RMACPATH", i, buf1)!=0; i++)
 		{
@@ -478,13 +584,13 @@ int d_incbin(void)
 			if (fd > 0 && buf1[fd - 1] != SLASHCHAR)
 				strcat(buf1, SLASHSTRING);
 
-			strcat(buf1, string[tok.u32[1]]);
+			strcat(buf1, string[tok[1]]);
 
 			if ((fd = open(buf1, _OPEN_INC)) >= 0)
 				goto allright;
 		}
 
-		return error("cannot open: \"%s\"", string[tok.u32[1]]);
+		return error("cannot open: \"%s\"", string[tok[1]]);
 	}
 
 allright:
@@ -493,14 +599,14 @@ allright:
 	pos = lseek(fd, 0L, SEEK_SET);
 	chcheck(size);
 
-	DEBUG { printf("INCBIN: File '%s' is %li bytes.\n", string[tok.u32[1]], size); }
+	DEBUG { printf("INCBIN: File '%s' is %li bytes.\n", string[tok[1]], size); }
 
 	char * fileBuffer = (char *)malloc(size);
 	bytesRead = read(fd, fileBuffer, size);
 
 	if (bytesRead != size)
 	{
-		error("was only able to read %li bytes from binary file (%s, %li bytes)", bytesRead, string[tok.u32[1]], size);
+		error("was only able to read %li bytes from binary file (%s, %li bytes)", bytesRead, string[tok[1]], size);
 		return ERROR;
 	}
 
@@ -718,21 +824,21 @@ int symlist(int(* func)())
 
 	for(;;)
 	{
-		if (*tok.u32 != SYMBOL)
+		if (*tok != SYMBOL)
 			return error(em);
 
-		if ((*func)(string[tok.u32[1]]) != OK)
+		if ((*func)(string[tok[1]]) != OK)
 			break;
 
-		tok.u32 += 2;
+		tok += 2;
 
-		if (*tok.u32 == EOL)
+		if (*tok == EOL)
 			break;
 
-		if (*tok.u32 != ',')
+		if (*tok != ',')
 			return error(em);
 
-		tok.u32++;
+		tok++;
 	}
 
 	return 0;
@@ -750,11 +856,11 @@ int d_include(void)
 	char buf[128];
 	char buf1[128];
 
-	if (*tok.u32 == STRING)			// Leave strings ALONE
-		fn = string[*++tok.u32];
-	else if (*tok.u32 == SYMBOL)	// Try to append ".s" to symbols
+	if (*tok == STRING)			// Leave strings ALONE
+		fn = string[*++tok];
+	else if (*tok == SYMBOL)	// Try to append ".s" to symbols
 	{
-		strcpy(buf, string[*++tok.u32]);
+		strcpy(buf, string[*++tok]);
 		fext(buf, ".s", 0);
 		fn = &buf[0];
 	}
@@ -763,7 +869,7 @@ int d_include(void)
 
 	// Make sure the user didn't try anything like:
 	// .include equates.s
-	if (*++tok.u32 != EOL)
+	if (*++tok != EOL)
 		return error("extra stuff after filename--enclose it in quotes");
 
 	// Attempt to open the include file in the current directory, then (if that
@@ -802,7 +908,7 @@ int d_assert(void)
 	WORD eattr;
 	uint64_t eval;
 
-	for(; expr(exprbuf, &eval, &eattr, NULL)==OK; ++tok.u32)
+	for(; expr(exprbuf, &eval, &eattr, NULL)==OK; ++tok)
 	{
 		if (!(eattr & DEFINED))
 			return error("forward or undefined .assert");
@@ -810,11 +916,11 @@ int d_assert(void)
 		if (!eval)
 			return error("assert failure");
 
-		if (*tok.u32 != ',')
+		if (*tok != ',')
 			break;
 	}
 
-	at_eol();
+	ErrorIfNotAtEOL();
 	return 0;
 }
 
@@ -860,7 +966,7 @@ int d_prgflags(void)
 {
 	uint64_t eval;
 
-	if (*tok.u32 == EOL)
+	if (*tok == EOL)
 		return error("PRGFLAGS requires value");
 	else if (abs_expr(&eval) == OK)
 	{
@@ -886,7 +992,7 @@ int d_abs(void)
 
 	SaveSection();
 
-	if (*tok.u32 == EOL)
+	if (*tok == EOL)
 		eval = 0;
 	else if (abs_expr(&eval) != OK)
 		return 0;
@@ -960,7 +1066,7 @@ int d_ds(WORD siz)
 
 	uint64_t eval;
 
-	if (cursect != M6502)
+	if ((cursect & (M6502 | M56KPXYL)) == 0)
 	{
 		if ((siz != SIZB) && (sloc & 1))	// Automatic .even
 			auto_even();
@@ -970,11 +1076,11 @@ int d_ds(WORD siz)
 		return 0;
 
 	// Check to see if the value being passed in is negative (who the hell does
-	// that?--nobody does; it's the code gremlins, or rum, that does it)
-	// N.B.: Since 'eval' is of type uint32_t, if it goes negative, it will have
-	//       its high bit set.
-	if (eval & 0x80000000)
-		return error("negative sizes not allowed");
+	// that?--nobody does; it's the code gremlins, or rum, what does it)
+	// N.B.: Since 'eval' is of type uint64_t, if it goes negative, it will
+	//       have its high bit set.
+	if (eval & 0x8000000000000000)
+		return error("negative sizes not allowed in DS");
 
 	// In non-TDB section (BSS, ABS and M6502) just advance the location
 	// counter appropriately. In TDB sections, deposit (possibly large) chunks
@@ -990,18 +1096,86 @@ int d_ds(WORD siz)
 
 		just_bss = 1;					// No data deposited (8-bit CPU mode)
 	}
+	else if (cursect & M56KPXYL)
+	{
+		// Change segment instead of marking blanks.
+		// Only mark segments we actually wrote something
+		if (chptr != dsp_currentorg->start && dsp_written_data_in_current_org)
+		{
+			dsp_currentorg->end = chptr;
+			dsp_currentorg++;
+			dsp_currentorg->memtype = dsp_currentorg[-1].memtype;
+		}
+
+		listvalue((uint32_t)eval);
+		sloc += (uint32_t)eval;
+
+		// And now let's create a new segment
+		dsp_currentorg->start = chptr;
+		dsp_currentorg->chunk = scode;  // Mark down which chunk this org starts from (will be needed when outputting)
+		sect[cursect].orgaddr = sloc;
+		dsp_currentorg->orgadr = sloc;
+		dsp_written_data_in_current_org = 0;
+
+		just_bss = 1;					// No data deposited
+	}
 	else
 	{
-		dep_block(eval, siz, 0, (WORD)(DEFINED | ABS), (TOKENPTR){NULL});
+		dep_block(eval, siz, 0, (DEFINED | ABS), NULL);
 	}
 
-	at_eol();
-	return 0;
+	ErrorIfNotAtEOL();
+	return OK;
+}
+
+
+//
+// dsm[.siz] expression
+// Define modulo storage
+// Quoting the Motorola assembler manual:
+// "The DSM directive reserves a block of memory the length of which in words is equal to
+// the value of <expression>.If the runtime location counter is not zero, this directive first
+// advances the runtime location counter to a base address that is a multiple of 2k, where
+// 2k >= <expression>."
+// The kicker of course is written a few sentences after:
+// "<label>, if present, will be assigned the value of the runtime location counter after a valid
+// base address has been established."
+//
+int d_dsm(WORD siz)
+{
+	TOKEN * tok_current = tok;  // Keep track of where tok was when we entered this procedure
+	uint64_t eval;
+
+	if (abs_expr(&eval) != OK)
+ 		return 0;
+
+	// Round up to the next highest power of 2
+	// Nicked from https://graphics.stanford.edu/~seander/bithacks.html#RoundUpPowerOf2
+	eval--;
+	eval |= eval >> 1;
+	eval |= eval >> 2;
+	eval |= eval >> 4;
+	eval |= eval >> 8;
+	eval |= eval >> 16;
+
+	int units_to_skip;
+	units_to_skip = eval + 1 - sloc;
+	sloc += units_to_skip;		// Bump up sloc - TODO: check if this goes over the RAM limits?
+
+	// If a label has been defined in the same line as dsm, its value also needs to be adjusted
+	if (label_defined)
+	{
+		SYM * label = lookup(label_defined, LABEL, 0);
+		label->svalue += units_to_skip;
+	}
+
+	tok = tok_current;		// Rewind tok back to where it was
+	return d_ds(siz);		// And let d_ds take over from here
 }
 
 
 //
-// dc.b, dc.w / dc, dc.l, dc.i, dc.q, dc.d
+// dc.b, dc.w / dc, dc.l, dc.i, dc.q, dc.d, dc.s, dc.x
 //
 int d_dc(WORD siz)
 {
@@ -1013,7 +1187,9 @@ int d_dc(WORD siz)
 		return error("illegal initialization of section");
 
 	// Do an auto_even if it's not BYTE sized (hmm, should we be doing this???)
-	if (cursect != M6502 && (siz != SIZB) && (sloc & 1))
+	if ((cursect != M6502) && (cursect != M56001P) && (cursect != M56001X)
+		&& (cursect != M56001Y) && (cursect != M56001L)
+		&& (siz != SIZB) && (sloc & 1))
 		auto_even();
 
 	// Check to see if we're trying to set LONGS on a non 32-bit aligned
@@ -1023,24 +1199,24 @@ int d_dc(WORD siz)
 		|| (rdsp && (orgaddr >= 0xF1B000) && (orgaddr <= 0xF1CFFFF))))
 		warn("depositing LONGs on a non-long address in local RAM");
 
-	for(;; tok.u32++)
+	for(;; tok++)
 	{
 		// dc.b 'string' [,] ...
-		if (siz == SIZB && (*tok.u32 == STRING || *tok.u32 == STRINGA8) && (tok.u32[2] == ',' || tok.u32[2] == EOL))
+		if (siz == SIZB && (*tok == STRING || *tok == STRINGA8) && (tok[2] == ',' || tok[2] == EOL))
 		{
-			uint32_t i = strlen(string[tok.u32[1]]);
+			uint32_t i = strlen(string[tok[1]]);
 
 			if ((challoc - ch_size) < i)
 				chcheck(i);
 
-			if (*tok.u32 == STRING)
+			if (*tok == STRING)
 			{
-				for(p=string[tok.u32[1]]; *p!=EOS; p++)
+				for(p=string[tok[1]]; *p!=EOS; p++)
 					D_byte(*p);
 			}
-			else if(*tok.u32 == STRINGA8)
+			else if (*tok == STRINGA8)
 			{
-				for(p=string[tok.u32[1]]; *p!=EOS; p++)
+				for(p=string[tok[1]]; *p!=EOS; p++)
 					D_byte(strtoa8[*p]);
 			}
 			else
@@ -1048,16 +1224,16 @@ int d_dc(WORD siz)
 				error("String format not supported... yet");
 			}
 
-			tok.u32 += 2;
+			tok += 2;
 			goto comma;
 		}
 
 		int movei = 0; // MOVEI flag for dc.i
 
-		if (*tok.u32 == DOTI)
+		if (*tok == DOTI)
 		{
 			movei = 1;
-			tok.u32++;
+			tok++;
 			siz = SIZL;
 		}
 
@@ -1070,8 +1246,98 @@ int d_dc(WORD siz)
 		uint16_t tdb = eattr & TDB;
 		uint16_t defined = eattr & DEFINED;
 
-		if ((challoc - ch_size) < 4)
-			chcheck(4);
+// N.B.: This is awful.  This needs better handling, rather than just bodging something in that, while works, is basically an ugly wart on the assembler.  !!! FIX !!!
+		if (dsp56001)
+		{
+			if (cursect != M56001L)
+			{
+				if (!defined)
+				{
+					AddFixup(FU_DSPIMM24 | FU_SEXT, sloc, exprbuf);
+					D_dsp(0);
+				}
+				else
+				{
+					if (eattr & FLOAT)
+					{
+						double fval = *(double *)&eval;
+						eval = DoubleToDSPFloat(fval);
+					}
+					else
+					{
+						if ((uint32_t)eval + 0x1000000 >= 0x2000000)
+							return error(range_error);
+					}
+
+					// Deposit DSP word (24-bit)
+					D_dsp(eval);
+				}
+			}
+			else
+			{
+				// In L: we deposit stuff to both X: and Y: instead
+				// We will be a bit lazy and require that there is a 2nd value
+				// in the same source line. (Motorola's assembler can parse
+				// 12-digit hex values, which we can't do at the moment) This
+				// of course requires to parse 2 values in one pass. If there
+				// isn't another value in this line, assume X: value is 0.
+				int secondword = 0;
+				uint32_t evaly;
+l_parse_loop:
+
+				if (!defined)
+				{
+					AddFixup(FU_DSPIMM24 | FU_SEXT, sloc, exprbuf);
+					D_dsp(0);
+				}
+				else
+				{
+					if (eattr & FLOAT)
+					{
+						float fval = *(float *)&eval;
+						eval = DoubleToDSPFloat(fval);
+					}
+					else
+					{
+						if (eval + 0x1000000 >= 0x2000000)
+							return error(range_error);
+					}
+
+					// Parse 2nd value if we didn't do this yet
+					if (secondword == 0)
+					{
+						evaly = (uint32_t)eval;
+						secondword = 1;
+
+						if (*tok != ':')
+						{
+							// If we don't have a : then we're probably at EOL,
+							// which means the X: value will be 0
+							eval = 0;
+							ErrorIfNotAtEOL();
+						}
+						else
+						{
+							tok++; // Eat the comma;
+
+							if (expr(exprbuf, &eval, &eattr, NULL) != OK)
+								return 0;
+
+							defined = (WORD)(eattr & DEFINED);
+							goto l_parse_loop;
+						}
+					}
+
+					// Deposit DSP words (24-bit)
+					D_dsp(eval);
+					D_dsp(evaly);
+					sloc--; // We do write 2 DSP words but as far as L: space is concerned we actually advance our counter by one
+				}
+
+			}
+
+			goto comma;
+		}
 
 		switch (siz)
 		{
@@ -1093,6 +1359,7 @@ int d_dc(WORD siz)
 			}
 
 			break;
+
 		case SIZW:
 		case SIZN:
 			if (!defined)
@@ -1116,6 +1383,7 @@ int d_dc(WORD siz)
 			}
 
 			break;
+
 		case SIZL:
 			// Shamus: Why can't we do longs in 6502 mode?
 			if (m6502)
@@ -1123,11 +1391,7 @@ int d_dc(WORD siz)
 
 			if (!defined)
 			{
-				if (movei)
-					AddFixup(FU_LONG | FU_MOVEI, sloc, exprbuf);
-				else
-					AddFixup(FU_LONG, sloc, exprbuf);
-
+				AddFixup(FU_LONG | (movei ? FU_MOVEI : 0), sloc, exprbuf);
 				D_long(0);
 			}
 			else
@@ -1140,86 +1404,109 @@ int d_dc(WORD siz)
 
 				D_long(eval);
 			}
+
 			break;
+
 		case SIZQ:
 			// 64-bit size
 			if (m6502)
 				return error(in_6502mode);
 
-			// Shamus: We only handle DC.Q type stuff, will have to add fixups
-			//         and stuff later (maybe... might not be needed...)
+			// DEFINITELY NEED FIXUPS HERE!
+			if (!defined)
+			{
+				AddFixup(FU_QUAD, sloc, exprbuf);
+				eval = 0;
+			}
+
 			D_quad(eval);
 			break;
+
 		case SIZS:
+			// 32-bit float size
 			if (m6502)
 				return error(in_6502mode);
 
+/* Seems to me that if something is undefined here, then that should be an error.  Likewise for the D & X variants. */
 			if (!defined)
 			{
-				float vv = 0;
-				AddFixup(FU_FLOATSING, sloc, exprbuf);
-
-				D_single(vv);
+//				AddFixup(FU_FLOATSING, sloc, exprbuf);
+//				D_long(0);
+				return error("labels not allowed in floating point expressions");
 			}
 			else
 			{
-				if (tdb)
-					MarkRelocatable(cursect, sloc, tdb, MSINGLE, NULL);
-
-				D_single(eval);
+//Would this *ever* happen?
+//				if (tdb)
+//					MarkRelocatable(cursect, sloc, tdb, MSINGLE, NULL);
+
+				PTR ptr;
+				ptr.u64 = &eval;
+				uint32_t ieee754 = FloatToIEEE754((float)*ptr.dp);
+				D_long(ieee754);
 			}
 
 			break;
+
 		case SIZD:
+			// 64-bit double size
 			if (m6502)
 				return error(in_6502mode);
 
 			if (!defined)
 			{
-				double vv = 0;
-				AddFixup(FU_FLOATDOUB, sloc, exprbuf);
-
-				D_double(vv);
+//				AddFixup(FU_FLOATDOUB, sloc, exprbuf);
+//				D_quad(0LL);
+				return error("labels not allowed in floating point expressions");
 			}
 			else
 			{
-				if (tdb)
-					MarkRelocatable(cursect, sloc, tdb, MDOUBLE, NULL);
-
-				double vv = *(double *)&eval;
-				D_double(vv);
+//Would this *ever* happen?
+//				if (tdb)
+//					MarkRelocatable(cursect, sloc, tdb, MDOUBLE, NULL);
+
+				PTR ptr;
+				ptr.u64 = &eval;
+				uint64_t ieee754 = DoubleToIEEE754(*ptr.dp);
+				D_quad(ieee754);
 			}
 
 			break;
+
 		case SIZX:
 			if (m6502)
 				return error(in_6502mode);
 
+			uint8_t extDbl[12];
+			memset(extDbl, 0, 12);
+
 			if (!defined)
 			{
-				double vv = 0;
-				AddFixup(FU_FLOATEXT, sloc, exprbuf);
-
-				D_extend(vv);
+//				AddFixup(FU_FLOATEXT, sloc, exprbuf);
+//				D_extend(extDbl);
+				return error("labels not allowed in floating point expressions");
 			}
 			else
 			{
-				if (tdb)
-					MarkRelocatable(cursect, sloc, tdb, MEXTEND, NULL);
-
-				float vv = *(double *)&eval;
-				D_extend(vv);
+//Would this *ever* happen?
+//				if (tdb)
+//					MarkRelocatable(cursect, sloc, tdb, MEXTEND, NULL);
+
+				PTR ptr;
+				ptr.u64 = &eval;
+				DoubleToExtended(*ptr.dp, extDbl);
+				D_extend(extDbl);
 			}
 
 			break;
 		}
 
 comma:
-		if (*tok.u32 != ',')
+		if (*tok != ',')
 			break;
 	}
 
-	at_eol();
+	ErrorIfNotAtEOL();
 	return 0;
 }
 
@@ -1240,7 +1527,7 @@ int d_dcb(WORD siz)
 	if (abs_expr(&evalc) != OK)
 		return 0;
 
-	if (*tok.u32++ != ',')
+	if (*tok++ != ',')
 		return error("missing comma");
 
 	if (expr(exprbuf, &eval, &eattr, NULL) < 0)
@@ -1280,14 +1567,14 @@ int d_init(WORD def_siz)
 	for(;;)
 	{
 		// Get repeat count (defaults to 1)
-		if (*tok.u32 == '#')
+		if (*tok == '#')
 		{
-			tok.u32++;
+			tok++;
 
 			if (abs_expr(&count) != OK)
 				return 0;
 
-			if (*tok.u32++ != ',')
+			if (*tok++ != ',')
 				return error(comma_error);
 		}
 		else
@@ -1297,25 +1584,25 @@ int d_init(WORD def_siz)
 		if (expr(exprbuf, &eval, &eattr, NULL) < 0)
 			return 0;
 
-		switch (*tok.u32++)
+		switch (*tok++)
 		{                                 // Determine size of object to deposit
 		case DOTB: siz = SIZB; break;
 		case DOTW: siz = SIZB; break;
 		case DOTL: siz = SIZL; break;
 		default:
 			siz = def_siz;
-			tok.u32--;
+			tok--;
 			break;
 		}
 
 		dep_block((uint32_t)count, siz, (uint32_t)eval, eattr, exprbuf);
 
-		switch (*tok.u32)
+		switch (*tok)
 		{
 		case EOL:
 			return 0;
 		case ',':
-			tok.u32++;
+			tok++;
 			continue;
 		default:
 			return error(comma_error);
@@ -1327,13 +1614,10 @@ int d_init(WORD def_siz)
 //
 // Deposit 'count' values of size 'siz' in the current (non-BSS) segment
 //
-int dep_block(uint32_t count, WORD siz, uint32_t eval, WORD eattr, TOKENPTR exprbuf)
+int dep_block(uint32_t count, WORD siz, uint32_t eval, WORD eattr, TOKEN * exprbuf)
 {
-	WORD tdb;
-	WORD defined;
-
-	tdb = (WORD)(eattr & TDB);
-	defined = (WORD)(eattr & DEFINED);
+	WORD tdb = eattr & TDB;
+	WORD defined = eattr & DEFINED;
 
 	while (count--)
 	{
@@ -1421,13 +1705,13 @@ int d_comm(void)
 	if (m6502)
 		return error(in_6502mode);
 
-	if (*tok.u32 != SYMBOL)
+	if (*tok != SYMBOL)
 		return error("missing symbol");
 
-	p = string[tok.u32[1]];
-	tok.u32 += 2;
+	p = string[tok[1]];
+	tok += 2;
 
-	if (*p == '.')							// Cannot .comm a local symbol
+	if (*p == '.')						// Cannot .comm a local symbol
 		return error(locgl_error);
 
 	if ((sym = lookup(p, LABEL, 0)) == NULL)
@@ -1440,14 +1724,14 @@ int d_comm(void)
 
 	sym->sattr = GLOBAL | COMMON | BSS;
 
-	if (*tok.u32++ != ',')
+	if (*tok++ != ',')
 		return error(comma_error);
 
-	if (abs_expr(&eval) != OK)				// Parse size of common region
+	if (abs_expr(&eval) != OK)			// Parse size of common region
 		return 0;
 
-	sym->svalue = (uint32_t)eval;			// Install common symbol's size
-	at_eol();
+	sym->svalue = eval;					// Install common symbol's size
+	ErrorIfNotAtEOL();
 	return 0;
 }
 
@@ -1481,7 +1765,7 @@ int d_nlist(void)
 //
 int d_68000(void)
 {
-	rgpu = rdsp = 0;
+	rgpu = rdsp = robjproc = dsp56001 = 0;
 	// Switching from gpu/dsp sections should reset any ORG'd Address
 	orgactive = 0;
 	orgwarning = 0;
@@ -1533,29 +1817,29 @@ int d_68060(void)
 {
 	d_68000();
 	activecpu = CPU_68060;
-	activefpu = FPU_68040;
+	activefpu = FPU_68060;
 	return 0;
 }
 
 
 //
-// .68881 - Back to 68000 TEXT segment and select 68881 FPU
+// .68881 - Back to 680x0 TEXT segment and select 68881 FPU
 //
 int d_68881(void)
 {
-	d_68000();
+	//d_68000();
 	activefpu = FPU_68881;
 	return 0;
 }
 
 
 //
-// .68882 - Back to 68000 TEXT segment and select 68882 FPU
+// .68882 - Back to 680x0 TEXT segment and select 68882 FPU
 //
 int d_68882(void)
 {
-	d_68000();
-	activefpu = FPU_68881;
+	//d_68000();
+	activefpu = FPU_68882;
 	return 0;
 }
 
@@ -1571,11 +1855,18 @@ int d_nofpu(void)
 
 
 //
-// DSP56001
+// .56001 - Switch to DSP56001 assembler
 //
 int d_56001(void)
 {
-	return error("Not yet, child. Be patient.");
+	dsp56001 = 1;
+	rgpu = rdsp = robjproc = 0;
+	SaveSection();
+
+	if ((obj_format == LOD) || (obj_format == P56))
+		SwitchSection(M56001P);
+
+	return 0;
 }
 
 
@@ -1599,6 +1890,8 @@ int d_gpu(void)
 
 	rgpu = 1;			// Set GPU assembly
 	rdsp = 0;			// Unset DSP assembly
+	robjproc = 0;		// Unset OP assembly
+	dsp56001 = 0;		// Unset 56001 assembly
 	regbank = BANK_N;	// Set no default register bank
 	return 0;
 }
@@ -1624,6 +1917,8 @@ int d_dsp(void)
 
 	rdsp = 1;			// Set DSP assembly
 	rgpu = 0;			// Unset GPU assembly
+	robjproc = 0;		// Unset OP assembly
+	dsp56001 = 0;		// Unset 56001 assembly
 	regbank = BANK_N;	// Set no default register bank
 	return 0;
 }
@@ -1652,23 +1947,23 @@ int d_cargs(void)
 	if (rgpu || rdsp)
 		return error("directive forbidden in gpu/dsp mode");
 
-	if (*tok.u32 == '#')
+	if (*tok == '#')
 	{
-		tok.u32++;
+		tok++;
 
 		if (abs_expr(&eval) != OK)
 			return 0;
 
 		// Eat the comma, if it's there
-		if (*tok.u32 == ',')
-			tok.u32++;
+		if (*tok == ',')
+			tok++;
 	}
 
 	for(;;)
 	{
-		if (*tok.u32 == SYMBOL)
+		if (*tok == SYMBOL)
 		{
-			p = string[tok.u32[1]];
+			p = string[tok[1]];
 
 			// Set env to either local (dot prefixed) or global scope
 			env = (*p == '.' ? curenv : 0);
@@ -1686,24 +1981,24 @@ int d_cargs(void)
 			AddToSymbolDeclarationList(symbol);
 
 			symbol->sattr |= (ABS | DEFINED | EQUATED);
-			symbol->svalue = (uint32_t)eval;
-			tok.u32 += 2;
+			symbol->svalue = eval;
+			tok += 2;
 
 			// What this does is eat any dot suffixes attached to a symbol. If
 			// it's a .L, it adds 4 to eval; if it's .W or .B, it adds 2. If
 			// there is no dot suffix, it assumes a size of 2.
-			switch ((int)*tok.u32)
+			switch ((int)*tok)
 			{
 			case DOTL:
 				eval += 2;
 			case DOTB:
 			case DOTW:
-				tok.u32++;
+				tok++;
 			}
 
 			eval += 2;
 		}
-		else if (*tok.u32 >= KW_D0 && *tok.u32 <= KW_A7)
+		else if (*tok >= KW_D0 && *tok <= KW_A7)
 		{
 			if (reglist(&rlist) < 0)
 				return 0;
@@ -1716,7 +2011,7 @@ int d_cargs(void)
 		}
 		else
 		{
-			switch ((int)*tok.u32)
+			switch ((int)*tok)
 			{
 			case KW_USP:
 			case KW_SSP:
@@ -1726,7 +2021,7 @@ int d_cargs(void)
 			case KW_SR:
 			case KW_CCR:
 				eval += 2;
-				tok.u32++;
+				tok++;
 				break;
 			case EOL:
 				return 0;
@@ -1736,8 +2031,8 @@ int d_cargs(void)
 		}
 
 		// Eat commas in between each argument, if they exist
-		if (*tok.u32 == ',')
-			tok.u32++;
+		if (*tok == ',')
+			tok++;
 	}
 }
 
@@ -1766,23 +2061,23 @@ int d_cstruct(void)
 	if (rgpu || rdsp)
 		return error("directive forbidden in gpu/dsp mode");
 
-	if (*tok.u32 == '#')
+	if (*tok == '#')
 	{
-		tok.u32++;
+		tok++;
 
 		if (abs_expr(&eval) != OK)
 			return 0;
 
 		// Eat the comma, if it's there
-		if (*tok.u32 == ',')
-			tok.u32++;
+		if (*tok == ',')
+			tok++;
 	}
 
 	for(;;)
 	{
-		if (*tok.u32 == SYMBOL)
+		if (*tok == SYMBOL)
 		{
-			symbolName = string[tok.u32[1]];
+			symbolName = string[tok[1]];
 
 			// Set env to either local (dot prefixed) or global scope
 			env = (symbolName[0] == '.' ? curenv : 0);
@@ -1801,11 +2096,11 @@ int d_cstruct(void)
 			// Put symbol in "order of definition" list
 			AddToSymbolDeclarationList(symbol);
 
-			tok.u32 += 2;
+			tok += 2;
 
 			// Adjust label start address if it's a word or a long, as a byte
 			// label might have left us on an odd address.
-			switch ((int)*tok.u32)
+			switch ((int)*tok)
 			{
 			case DOTW:
 			case DOTL:
@@ -1813,12 +2108,12 @@ int d_cstruct(void)
 			}
 
 			symbol->sattr |= (ABS | DEFINED | EQUATED);
-			symbol->svalue = (uint32_t)eval;
+			symbol->svalue = eval;
 
 			// Check for dot suffixes and adjust space accordingly (longs and
 			// words on an odd boundary get bumped to the next word aligned
 			// address). If no suffix, then throw an error.
-			switch ((int)*tok.u32)
+			switch ((int)*tok)
 			{
 			case DOTL:
 				eval += 4;
@@ -1833,9 +2128,9 @@ int d_cstruct(void)
 				return error("Symbol missing dot suffix in .cstruct construct");
 			}
 
-			tok.u32++;
+			tok++;
 		}
-		else if (*tok.u32 >= KW_D0 && *tok.u32 <= KW_A7)
+		else if (*tok >= KW_D0 && *tok <= KW_A7)
 		{
 			if (reglist(&rlist) < 0)
 				return 0;
@@ -1848,7 +2143,7 @@ int d_cstruct(void)
 		}
 		else
 		{
-			switch ((int)*tok.u32)
+			switch ((int)*tok)
 			{
 			case KW_USP:
 			case KW_SSP:
@@ -1858,7 +2153,7 @@ int d_cstruct(void)
 			case KW_SR:
 			case KW_CCR:
 				eval += 2;
-				tok.u32++;
+				tok++;
 				break;
 			case EOL:
 				return 0;
@@ -1868,12 +2163,39 @@ int d_cstruct(void)
 		}
 
 		// Eat commas in between each argument, if they exist
-		if (*tok.u32 == ',')
-			tok.u32++;
+		if (*tok == ',')
+			tok++;
 	}
 }
 
 
+//
+// Define start of OP object list (allows the use of ORG)
+//
+int d_objproc(void)
+{
+	if ((cursect != TEXT) && (cursect != DATA))
+	{
+		error(".objproc can only be used in the TEXT or DATA segments");
+		return ERROR;
+	}
+
+	// If previous section was DSP or 68000 then we need to reset ORG'd
+	// Addresses
+	if (!robjproc)
+	{
+		orgactive = 0;
+		orgwarning = 0;
+	}
+
+	robjproc = 1;		// Set OP assembly
+	rgpu = 0;			// Unset GPU assembly
+	rdsp = 0;			// Unset DSP assembly
+	dsp56001 = 0;		// Unset 56001 assembly
+	return OK;
+}
+
+
 //
 // Undefine a macro - .undefmac macname [, macname...]
 //
@@ -1921,12 +2243,12 @@ int d_gpumain(void)
 //
 int d_opt(void)
 {
-	while (*tok.u32 != EOL)
+	while (*tok != EOL)
 	{
-		if (*tok.u32 == STRING)
+		if (*tok == STRING)
 		{
-			tok.u32++;
-			char * tmpstr = string[*tok.u32++];
+			tok++;
+			char * tmpstr = string[*tok++];
 
 			if (ParseOptimization(tmpstr) != OK)
 				return error("unknown optimization flag '%s'", tmpstr);