reconstruct some modules

ColorBlender/ColorBlender.v

@@ -0,0 +1,86 @@
+`timescale 1ns / 1ps
+
+// 三通道图像合成一个RGB图像
+module ColorBlender #(
+    parameter reg [ 4:0] IN_DEPTH    = 12,   // 输入图像的色深
+    parameter reg [ 4:0] OUT_DEPTH   = 8,    // 输出图像的色深
+    parameter reg [12:0] GAIN_RED    = 120,  // 红色增益系数(除以10^小数位数)
+    parameter reg [12:0] GAIN_GREEN  = 50,   // 绿色增益系数
+    parameter reg [12:0] GAIN_BLUE   = 95,   // 蓝色增益系数
+    parameter reg [ 4:0] GAIN_OFFSET = 7
+) (
+    input clk,
+    input reset,
+
+    input in_en,
+    input [15:0] data_in[2],  // 0:R 1:G 2:B
+    output out_ready,
+    output out_receive,
+
+    // 输出相关
+    input in_ready,
+    input in_receive,
+    output out_en,
+    output [3 * OUT_DEPTH - 1:0] data_out,
+
+    // 颜色校正
+    input wire color_correction
+);
+  localparam READ_DATA = 0;
+  localparam CALC_DATA = 1;
+  localparam SEND_DATA = 2;
+
+  reg [2:0] state, nextState;
+  reg [31:0] data_cal[2];  // 用于保存运算结果，防止溢出
+
+  always @(posedge clk or posedge reset) begin
+    if (reset) begin
+      state <= READ_DATA;
+    end else begin
+      state <= nextState;
+    end
+  end
+
+  always @(*) begin
+    case (state)
+      READ_DATA: nextState = (in_en) ? (color_correction ? CALC_DATA : SEND_DATA) : READ_DATA;
+      CALC_DATA: nextState = SEND_DATA;
+      SEND_DATA: nextState = READ_DATA;
+      default: nextState = READ_DATA;
+    endcase
+  end
+
+  assign out_ready = (state == READ_DATA) ? 1 : 0;
+  assign out_receive = in_en ? 1 : 0;
+  assign out_en = (in_ready && state == SEND_DATA) ? 1 : 0;
+
+  always @(posedge clk or posedge reset) begin
+    if (reset) begin
+      // 初始化
+      data_cal[0] <= 0;
+      data_cal[1] <= 0;
+      data_cal[2] <= 0;
+    end else begin
+      case (state)
+        READ_DATA: begin
+
+          if (in_en) begin
+            data_cal[0] <= ({{(32 - IN_DEPTH){1'b0}}, data_in[0]} >> (IN_DEPTH - OUT_DEPTH));
+            data_cal[1] <= ({{(32 - IN_DEPTH){1'b0}}, data_in[1]} >> (IN_DEPTH - OUT_DEPTH));
+            data_cal[2] <= ({{(32 - IN_DEPTH){1'b0}}, data_in[2]} >> (IN_DEPTH - OUT_DEPTH));
+          end
+        end
+
+        CALC_DATA: begin
+        end
+
+        SEND_DATA: begin
+
+        end
+
+        default: ;
+      endcase
+    end
+  end
+
+endmodule