1 files changed, 53 insertions, 0 deletions
diff --git a/rtl/smp/smp_pe.sv b/rtl/smp/smp_pe.sv
new file mode 100644
index 0000000..5c675ee
--- /dev/null
+++ b/rtl/smp/smp_pe.sv
@@ -0,0 +1,53 @@
+module smp_pe
+#(parameter IS_BSP=0)
+(
+	input  logic	  clk,
+	                  rst_n,
+	
+	input  logic      write,
+	input  logic[7:0] writedata,
+	output logic[7:0] readdata,
+
+	input  logic      cpu_alive,
+	                  cpu_halted,
+	                  breakpoint,
+
+	output logic      halt,
+	                  step
+);
+
+	struct packed
+	{
+		logic step, halt, run;
+	} req;
+
+	struct packed
+	{
+		logic alive, breakpoint, cpu_halted;
+	} status, status_out;
+
+	assign req = writedata[$bits(req) - 1:0];
+	assign readdata = {{(8 - $bits(status_out)){1'b0}}, status_out};
+
+	always_comb begin
+		status_out = status;
+		status_out.alive = cpu_alive;
+	end
+
+	always @(posedge clk or negedge rst_n)
+		if (!rst_n) begin
+			halt <= IS_BSP ? 0 : 1; // Boot es single-core
+			step <= 0;
+			status <= {($bits(status)){1'b0}};
+		end else begin
+			status.breakpoint <= breakpoint;
+			status.cpu_halted <= cpu_halted;
+
+			//Se hace halt hasta el siguiente ciclo después de que se 
+			//solicita el breakpoint
+			step <= (step && !breakpoint) || (req.step && write);
+			halt <= (halt || breakpoint || (req.halt && write))
+			     && !((req.run || req.step) && write);
+		end
+
+endmodule