QuatCore: ещё два прерывания (продолжение)

UTF8object TQuatCoreTranslator
  RelJumpLatency = 2
  ActiveHazards = [crAcc, crC, crX, crY, crZ, crSP, cri, crj, crk, crInv, crMemBus]
  AllowRelJumps = false
  NMIwidth = 2
  object TQuatCoreNMI
    Key = 'GPU_WDT'
    Description = 'WatchDog Timer - срабатывает, если при работающем АЦП пропадают кадровые синхроимпульсы, т.е нет видеосигнала'
    Code = 0
  end
  object TQuatCoreNMI
    Key = 'GPU_OFLO'
    Description = 'Overflow - не успеваем забрать результаты обработки изображения из выходного буфера видеопроцессора, из-за чего новые результаты "уходят в пустоту"'
    Code = 1
  end
  object TQuatCoreNMI
    Key = 'GPU_UFLO'
    Description = 'Underflow - мы не успеваем загрузить видеопроцессор работой, поэтому часть кадра оказывается необработанной и потерянной'
    Code = 2
  end
  object TQuatCoreCommand
    Key = 'OUT'
    Code = 0
    Mask = 240
    DataMask = 1023
    Description = 'Sends value to chosen output'
    Place = [cpDest]
    Resources = []
    DataType = dtNumeric
  end
  object TQuatCoreCommand
    Key = 'SIO'
    Code = 16
    Mask = 240
    DataMask = 15
    Description = 'Selects I/O device'
    Place = [cpDest]
    Resources = []
    DataType = dtNumeric
  end

UTF8object TQuatCoreTranslator
  RelJumpLatency = 2
  ActiveHazards = [crAcc, crC, crX, crY, crZ, crSP, cri, crj, crk, crInv, crMemBus]
  AllowRelJumps = False
  NMIwidth = 2
  object TQuatCoreNMI
    Key = 'GPU_WDT'
    Description = 
      'WatchDog Timer - срабатывает, если при работающем АЦП пропадают ' +
      'кадровые синхроимпульсы, т.е нет видеосигнала'
    Code = 0
  end
  object TQuatCoreNMI
    Key = 'GPU_OFLO'
    Description = 
      'Overflow - не успеваем забрать результаты обработки изображения ' +
      'из выходного буфера видеопроцессора, из-за чего новые результаты' +
      ' "уходят в пустоту"'
    Code = 1
  end
  object TQuatCoreNMI
    Key = 'GPU_UFLO'
    Description = 
      'Underflow - мы не успеваем загрузить видеопроцессор работой, поэ' +
      'тому часть кадра оказывается необработанной и потерянной'
    Code = 2
  end
  object TQuatCoreCommand
    Key = 'OUT'
    Code = 0
    Mask = 240
    DataMask = 1023
    Description = 'Sends value to chosen output'
    Place = [cpDest]
    Resources = []
    DataType = dtNumeric
  end
  object TQuatCoreCommand
    Key = 'SIO'
    Code = 16
    Mask = 240
    DataMask = 15
    Description = 'Selects I/O device'
    Place = [cpDest]
    Resources = []
    DataType = dtNumeric
  end

//адреса для вызова процедур, "вшитые" в модуль QuatCorePC
module QuatCoreCallTable (input [7:0] SrcAddr, input NMI, input [nmiWidth-1:0] nmiN, output [RomWidth-1:0] addr);
parameter RomWidth = 7;
parameter nmiWidth = 2;
wire [6:0] Caddr;
wire [6:0] Iaddr;
	assign Caddr[6]=1'b0;
	assign Caddr[5]=1'b1;
	assign Caddr[4]=1'b1;
	assign Caddr[3]=1'b1;
	assign Caddr[2]=1'b1;
	assign Caddr[1]=1'b1;
	assign Caddr[0]=1'b1;
//Адреса процедур:
// print = 003F(поле Src = B0) 
	assign Iaddr=
		(nmiN == 2'h0)? 7'h34:
		(nmiN == 2'h1)? 7'h38:
		(nmiN == 2'h2)? 7'h36:
				7'h0;
assign addr = NMI? Iaddr : Caddr;
endmodule

module QuatCoreCVinterruptEncoder (input clk, input OFLO, input UFLO, input WDT, output StallEn, output NMI, output [1:0] intN);

wire wNMI = OFLO | UFLO | WDT;
reg rNMI = 1'b0;

always @(posedge clk)
	rNMI <= wNMI;
	
assign NMI = wNMI & (~rNMI);

assign StallEn = ~NMI;

assign intN = 	WDT? 	2'b00:
		OFLO?	2'b01:
			2'b10;

endmodule

module QuatCoreCVinterruptEncoder (input clk, input OFLO, input UFLO, input WDT, output StallEn, output reg NMI=1'b0, output reg [1:0] intN = 2'b00);

wire wNMI = OFLO | UFLO | WDT;
reg rNMI = 1'b0;

always @(posedge clk) begin
	rNMI <= wNMI;
	NMI <= wNMI & (~rNMI);
	intN <= WDT? 	2'b00:
		OFLO?	2'b01:
			2'b10;
end

assign StallEn = ~NMI;

endmodule

;Обработка немаскируемых прерываний (а других пока и нет :))
	.data
		CommonError	dw	0x101,'Ошибка: ',0
		NoVideoSignal	db	'нет сигнала',0
		UnderflowInt	db	'исчерпание  ','заданий GPU',0
		OverflowInt	db	'переполнение','результатов GPU',0
	.code
	GPU_WDT:	C	NoVideoSignal
			JMP	IntHandler
	GPU_UFLO:	C	UnderflowInt
			JMP	IntHandler
	GPU_OFLO:	C	OverflowInt
	IntHandler:	SIO	LCD
			X	CommonError
			CALL	print
			X	C
			CALL	print
	@@endless:	JMP	@@endless		

module VideoSignalWatchDog (input clk, input ce, input VSync, input Disable, output NMI);

parameter CounterWidth = 16;

lpm_counter WDT (	.clock (clk),
			.clk_en (ce),
			.sclr (VSync | Disable),
			.cout (NMI));
defparam
	WDT.lpm_type = "LPM_COUNTER",
	WDT.lpm_direction = "UP",
	WDT.lpm_port_updown = "PORT_UNUSED",
	WDT.lpm_width = CounterWidth;

endmodule