added AXI-4 Stream IO interface for TRM

git-svn-id: https://svn.inf.ethz.ch/svn/lecturers/a2/trunk@8403 8c9fc860-2736-0410-a75d-ab315db34111

source/TRM.Channels.Mod

@@ -0,0 +1,118 @@
+(**
+	AUTHOR "Felix Friedrich and Alexey Morozov";
+	PURPOSE "ActiveCells AXI-4 Stream input/output for Tiny Register Machine (TRM) implemented on an FPGA";
+*)
+MODULE Channels;
+
+IMPORT
+	SYSTEM;
+
+CONST
+	ValidFlag* = (*100H;*) 010H;
+	ReadyFlag* = (*200H;*) 020H;
+
+	(** Send data to an output port (blocking version) *)
+	PROCEDURE Send*(portAddr: ADDRESS; x: LONGINT);
+	BEGIN
+		REPEAT UNTIL SYSTEM.BIT(portAddr+ReadyFlag,0); (* wait until the sink is ready *)
+		SYSTEM.PUT(portAddr,x);
+	END Send;
+
+	(** Send data to an output port (non-blocking version) *)
+	PROCEDURE SendNonBlocking*(portAddr: ADDRESS; x: LONGINT): BOOLEAN;
+	BEGIN
+		IF SYSTEM.BIT(portAddr+ReadyFlag,0) THEN
+			SYSTEM.PUT(portAddr,x);
+			RETURN TRUE;
+		ELSE
+			RETURN FALSE;
+		END;
+	END SendNonBlocking;
+
+	(** Receive data from an input port (blocking version) *)
+	PROCEDURE Receive*(portAddr: ADDRESS; VAR x: LONGINT);
+	BEGIN
+		REPEAT UNTIL SYSTEM.BIT(portAddr+ValidFlag,0); (* wait until the source data is valid *)
+		SYSTEM.GET(portAddr,x);
+	END Receive;
+
+	(** Receive data from an input port (non-blocking version) *)
+	PROCEDURE ReceiveNonBlocking*(portAddr: ADDRESS; VAR x: LONGINT): BOOLEAN;
+	BEGIN
+		IF SYSTEM.BIT(portAddr+ValidFlag,0) THEN
+			SYSTEM.GET(portAddr,x);
+			RETURN TRUE;
+		ELSE
+			RETURN FALSE;
+		END;
+	END ReceiveNonBlocking;
+
+	(** Send a block of bytes to a port *)
+	PROCEDURE SendBytes*(portAddr: ADDRESS; CONST x: ARRAY OF CHAR; offs, len: LONGINT);
+	BEGIN
+		WHILE len > 0 DO
+			Send(portAddr,ORD(x[offs]));
+			INC(offs); DEC(len);
+		END;
+	END SendBytes;
+	
+	(** Receive a block of bytes from a port *)
+	PROCEDURE ReceiveBytes*(portAddr: ADDRESS; VAR x: ARRAY OF CHAR; offs, len: LONGINT);
+	VAR v: LONGINT;
+	BEGIN
+		WHILE len > 0 DO
+			Receive(portAddr,v); x[offs] := CHR(v);
+			INC(offs); DEC(len);
+		END;
+	END ReceiveBytes;
+
+	(** Send a character to a port *)
+	PROCEDURE SendChar*(portAddr: ADDRESS; ch: CHAR);
+	BEGIN
+		Send(portAddr,ORD(ch));
+	END SendChar;
+
+	(** Send a null terminated strings; the terminating null is not sent *)
+	PROCEDURE SendString*(portAddr: ADDRESS; CONST str: ARRAY OF CHAR);
+	VAR i: LONGINT;
+	BEGIN
+		i := 0;
+		WHILE (i < LEN(str)) & (str[i] # 0X) DO
+			Send(portAddr,ORD(str[i]));
+			INC(i);
+		END;
+	END SendString;
+
+	(** Send an integer in decimal right-justified in a field of at least w characters  *)
+	PROCEDURE SendInt*(portAddr: ADDRESS; x, w: LONGINT);
+	VAR
+		i, x0, y: LONGINT;
+		str: ARRAY 12 OF CHAR;
+	BEGIN
+		IF x < 0 THEN
+			IF x = MIN(LONGINT) THEN
+				DEC(w,11);
+				WHILE w > 0 DO SendChar(portAddr,' ');  DEC(w); END;
+				SendString(portAddr,"-2147483648");  RETURN;
+			ELSE DEC(w);  x0 := -x;
+			END
+		ELSIF x = 0 THEN
+			WHILE w > 1 DO SendChar(portAddr,' ');  DEC(w); END;
+			SendChar(portAddr,'0'); RETURN;
+		ELSE x0 := x;
+		END;
+
+		i := 0;
+		WHILE x0 > 0 DO
+			y := x0 DIV 10;
+			str[i] := CHR(x0 - (y*10)+48); (*k := y*10; k := x0-k; k := k + 48; str[i] := CHR(k);*)
+			x0 := y;
+			INC(i);
+		END;
+
+		WHILE w > i DO SendChar(portAddr,' ');  DEC(w); END;
+		IF x < 0 THEN SendChar(portAddr,'-') END;
+		REPEAT DEC(i);  SendChar(portAddr,str[i]); UNTIL i = 0;
+	END SendInt;
+
+END Channels.