Быстродействующий байтовый Hello,World :)

;Проверяем работу с байтами в QuatCore
;Подумав ещё немножко, решаем расширить на 2 бита не X, а SP (а может ещё подумаем - и всех расширим)
%include "QuatCoreConsts.inc"
%include "Win1251.inc"
.rodata
	;в кои-то веки строка должна оканчиваться нулём! (халява закончилась)
	hello		db	'Hello, World! Live fast at 25 MHz',13,10,0
	EthDisable	db	2,3,0x22,0x54,0x00,0x01,3,0x22,0x66,0x00,0x18,2,0x22,0x6F,0x02		
.code
	main proc
		SetClock proc
		;конфигурирует Ethernet-контроллер на частоту 25 МГц и отключает собственно Ethernet
		;SP=0 при включении питания, на ПЛИС с этим строго
					;SP		EthDisable	;байтовая адресация нужна (хотя если EthDisable занимает младшие байты, можно и без неё обойтись)
					SIO		ETH
					j		[SP++]	;количество посылок (счёт с нуля)
			@@EthWord:	k		[SP++]	;количество байт в посылке (счёт с нуля)
			@@EthByte:	OUT		[SP++]
					kLOOP		@@EthByte
					;нужно, чтобы nCS сбросилось в единицу
					NOP		IN
					jLOOP		@@EthWord
		SetClock endp
				SIO		UART
				SP		hello
				C		CALL(print)
		@@endless:	JMP		@@endless
	main endp
	
	
	;посылает строку куда-нибудь. Пока модуль ввода-вывода всего один, SIO не нужен (нужный модуль по умолчанию будет активен)
	;X указывает на начало строки текста
	;конец обозначается отрицательным числом или НУЛЁМ (необходимо для работы с байтами)
	;меняет значение регистра Acc и SP
	;адрес возврата надо заносить в регистр C. 
	print proc
		@@start:	ZAcc		RoundZero
				SUB		[SP]
				JGE		C
				OUT		[SP++]
				JMP		@@start
	print endp

//DestAddr==000x_xxxx : 'OUT'
//DestAddr==001x_xxxx : select output device

//xxxx_xxxx_xxxx_xx00 - UART
//xxxx_xxxx_xxxx_xx01 - LCD
//xxxx_xxxx_xxxx_xx1x - SPI

//also selecting SPI device
//xxxx_xxxx_xxxx_0xxx - Ethernet
//xxxx_xxxx_xxxx_10xx - SD
//xxxx_xxxx_xxxx_11xx - ADC


//IN command is 
//SrcAddr == 1001_0xxx
//(ALU Src was 100x_xxxx, now it is 1000_xxxx)

module QuatCoreIOselector (	input clk, input [7:0] SrcAddr, input [7:0] DestAddr, input [15:0] DataBus, input DestStall, input SrcStall, input SrcDiscard, input SPI_busy,
				output UARTtxEN, output LCD_EN, output SPItxEN, output UARTrxEN, output SPIrxEN,
				output reg [1:0] SPIdevice = 2'b0);

parameter enableLCD = 1'b0;
parameter enableUART = 1'b1;
parameter enableSPI = 1'b0;

localparam HasChoice = enableSPI | ((enableLCD + enableUART + enableSPI) > 1);

wire isSelection = (~DestAddr[7]) & (~DestAddr[6]) & DestAddr[5] & (~DestStall) & HasChoice;
wire isIO_out = (~DestAddr[7])&(~DestAddr[6])&((~DestAddr[5]) | (~HasChoice)) & (~DestStall);
wire isIO_in = (SrcAddr[7:3] == 5'b1001_0)&(~SrcStall)&(~SrcDiscard);

reg [1:0] sel = enableUART? 2'b00:
				enableLCD?	2'b01:
							2'b10;

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

always @(posedge clk) if (isSelection) begin
	sel <= DataBus[1:0];
	shadowSPI <= DataBus[3:2];
end

always @(posedge clk) if (~SPI_busy)
	SPIdevice <= shadowSPI;
	
assign UARTtxEN = (sel==2'b00) & isIO_out & enableUART;
assign LCD_EN = (sel==2'b01) & isIO_out & enableLCD;
assign SPItxEN = sel[1] & isIO_out & enableSPI;

assign UARTrxEN = (sel==2'b00) & isIO_in & enableUART;
assign SPIrxEN = sel[1] & isIO_in & enableSPI;

endmodule

//DestAddr==0000_xxxx : 'OUT'
//DestAddr==0001_xxxx : 'SIO' (select input/output device)

//xxxx_xxxx_xxxx_xx00 - UART
//xxxx_xxxx_xxxx_xx01 - LCD
//xxxx_xxxx_xxxx_xx1x - SPI

//also selecting SPI device
//xxxx_xxxx_xxxx_0xxx - Ethernet
//xxxx_xxxx_xxxx_10xx - SD
//xxxx_xxxx_xxxx_11xx - ADC


//IN command is 
//SrcAddr == 1001_0xxx
//(ALU Src was 100x_xxxx, now it is 1000_xxxx)

module QuatCoreIOselector (	input clk, input [7:0] SrcAddr, input [7:0] DestAddr, input [15:0] DataBus, input DestStall, input SrcStall, input SrcDiscard, input SPI_busy,
				output UARTtxEN, output LCD_EN, output SPItxEN, output UARTrxEN, output SPIrxEN,
				output reg [1:0] SPIdevice = 2'b0);

parameter enableLCD = 1'b0;
parameter enableUART = 1'b1;
parameter enableSPI = 1'b0;

localparam HasChoice = enableSPI | ((enableLCD + enableUART + enableSPI) > 1);

wire isSelection = (DestAddr[7:4] == 4'b0001) & (~DestStall) & HasChoice;
wire isIO_out = (DestAddr[7:5] == 3'b000) & ((~DestAddr[4]) | (~HasChoice)) & (~DestStall);
wire isIO_in = (SrcAddr[7:3] == 5'b1001_0)&(~SrcStall)&(~SrcDiscard);

reg [1:0] sel = enableUART? 	2'b00:
		enableLCD?	2'b01:
				2'b10;

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

always @(posedge clk) if (isSelection) begin
	sel <= DataBus[1:0];
	shadowSPI <= DataBus[3:2];
end

always @(posedge clk) if (~SPI_busy)
	SPIdevice <= shadowSPI;
	
assign UARTtxEN = (sel==2'b00) & isIO_out & enableUART;
assign LCD_EN = (sel==2'b01) & isIO_out & enableLCD;
assign SPItxEN = sel[1] & isIO_out & enableSPI;

assign UARTrxEN = (sel==2'b00) & isIO_in & enableUART;
assign SPIrxEN = sel[1] & isIO_in & enableSPI;

endmodule