QuatCore: селектор ввода-вывода

module QuatCoreIOselector (input clk, input [7:0] DestAddr, input [7:0] SrcAddr, input [15:0] DataBus, output UARTtxEN, output LCD_EN, output SDtxEN, output UARTrxEN, output SDrxEN);

wire isSelection = (~DestAddr[7])&DestAddr[6];
wire isIO_out = (~DestAddr[7])&(~DestAddr[6]);
wire isIO_in = (SrcAddr[7:4] == 4'b1001);

reg [1:0] sel = 2'b0;

always @(posedge clk) if (isSelection)
	sel <= DataBus[1:0];
	
assign UARTtxEN = (sel==2'b00) & isIO_out;
assign LCD_EN = (sel==2'b01) & isIO_out;
assign SDtxEN = sel[1] & isIO_out;

assign UARTrxEN = (sel==2'b00) & isIO_in;
assign SDrxEN = sel[1] & isIO_in;

endmodule

;то же самое, но дополнительно выдаём Good News, everyone на компьютер
%include "QuatCoreConsts.inc"
%include "LCD_code_page_1.inc"
.rodata
;адр 0
	InitLCD	dw	0x330		;установить разрядность интерфейса (одиночная посылка, команда, 0011)
	Init1		dw	0x330		;установить разрядность
	Init2		dw	0x330		;установить разрядность
	Init3		dw	0x320		;установить разрядность 4 бита
	Init4		dw	0x12A		;установка параметров (двойная посылка, команда, 0010 1010 = 4 бита, страница 1)
	Init5		dw	0x10C		;включение дисплея (двойная посылка, команда, 0000 1100 = включить, курсора нет, ничего не мигает)
	Init6		dw	0x101 	;очистка дисплея (двойная посылка, команда, 0000 0001)
	Init7		dw	0x106		;установка режима ввода данных (двойная посылка, команда, 0000 0110 = курсор вправо, дисплей не двигается)
	Init8		dw	0x140		;выбор области CGRAM, установка на нулевом адресе
	Init9		dw	0x00E		;нулевой символ, 0-я строка
	InitA		dw	0x00A		;1-я строка
	InitB		dw	0x00A		;2-я строка
	InitC		dw	0x00B		;3-я строка
	InitD		dw	0x00B		;4-я строка
	InitE		dw	0x00A		;5-я строка 
	InitF		dw	0x00A		;6-я строка
	Init10	dw	0x00E		;7-я строка (для курсора вообще, но мы его не исп)
	Init11	dw	0x00E		;1-й символ, 0-я строка
	Init12	dw	0x00A		;1-я строка
	Init13	dw	0x00A		;2-я строка
	Init14	dw	0x01A		;3-я строка
	Init15	dw	0x01A		;4-я
	Init16	dw	0x00A		;5-я
	Init17	dw	0x00A		;6-я
	Init18	dw	0x00E		;7-я
	Init19	dw	0x8180	;выбор области DDRAM,нулевая позиция  (адр. в памяти 0x19 = 25)
	Row0		dw	0,1,'-','з','н','а','к',' ','ч','е','т','ы','р','ё','х'	;(адр. 40)
	Row1		dw	0x1C0,'Г','а','м','и','л','ь','т','о','н',' ',' ','Р','о','д','р','и','г','е','с'	;(адр. 60 в конце)
	Row2		dw	0x194,'Б','р','а','н','е','ц',' ',' ','Ш','м','ы','г','л','е','в','с','к','и',f'й'	;(адр. 80 в конце)
ORG -64	
	UartStr	dw	'G','o','o','d',' ','n','e','w','s',',',' ','e','v','e','r','y','o','n','e','!',13,10
	UartStr1	dw	'м','ы',' ','р','а','б','о','т','а','е','м',' ','и',' ','с',' ','U','A','R','T',',',' ','и',' ','с',' ','Ж','К',f'!'
;для интересу, сейчас без стека. Адрес возврата сохраним в регистр C	
.code
	main proc
				SIO		LCD
				SP		InitLCD
				C		CALL(print)
				SP		Row0
				C 		CALL(print)
				SIO		UART
				SP		UartStr
				C		CALL(print)
		@@endless: 	JMP 		@@endless
	main endp
	
	;изменяет только SP (после вызова он указывает сразу ПОСЛЕ последнего символа строки)
	;адрес возврата ищет в рег. C
	print	proc
		@@start:	OUT		[SP]	
				Acc		[SP++]		
				SUB		0
				JGE		@@start
				JMP		C	
	print	endp

;константы для аргументов QuatCore
;можно было бы их в сам компилятор "зашить", но пущай так
.data ;костыль нашего компилятора - он ищет EQU только в сегменте данных

;устройства ввода-вывода. Выбор производится командой SIO
UART	EQU	0
LCD	EQU	1
SD	EQU	2

;константы, которыми можно инициализировать аккумулятор, командой ZAcc
MinusThreeHalf	EQU	0
MinusOne	EQU	1
ThreeHalf	EQU	2
RoundZero	EQU	3

ORG -64