just test gamma correction algorithm

Color/ColorBlender.v

@@ -0,0 +1,110 @@
+`timescale 1ns / 1ps
+
+// 三通道图像合成一个RGB图像
+module ColorBlender #(
+    parameter reg [ 4:0] IN_DEPTH   = 12,   // 输入图像的色深
+    parameter reg [ 4:0] OUT_DEPTH  = 8,    // 输出图像的色深
+    parameter reg [ 8:0] BUFF_SIZE  = 32
+) (
+    input wire clk,
+    input wire reset,
+
+    input wire in_en,
+    input wire [15:0] in_data[3],  // 0:R 1:G 2:B
+    output wire out_ready,
+    output wire out_receive,
+
+    // 输出相关
+    input wire in_ready,
+    input wire in_receive,
+    output reg out_en,
+    output reg [3 * OUT_DEPTH - 1:0] out_data,
+
+    // 颜色校正
+    input wire [15:0] gain_red,
+    input wire [15:0] gain_green,
+    input wire [15:0] gain_blue,
+    input wire color_correction
+);
+  localparam reg [2:0] READ_DATA = 0;
+  localparam reg [2:0] CALC_DATA = 1;
+  localparam reg [2:0] SATI_DATA = 2;
+  localparam reg [2:0] SEND_DATA = 3;
+
+  reg [2:0] state, nextState;
+  reg [BUFF_SIZE - 1:0] data_cal[3];  // 用于保存运算结果，防止溢出
+
+  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) ? CALC_DATA : READ_DATA;
+      CALC_DATA: nextState = SATI_DATA;
+      SATI_DATA: nextState = SEND_DATA;
+      SEND_DATA: nextState = (in_receive) ? READ_DATA : SEND_DATA;
+      default:   nextState = READ_DATA;
+    endcase
+  end
+
+  assign out_ready   = (!in_en && state == READ_DATA) ? 1 : 0;
+  assign out_receive = (in_en && state == READ_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;
+
+      out_data <= 0;
+      out_en <= 0;
+    end else begin
+      case (state)
+        READ_DATA: begin
+          if (in_en) begin
+            data_cal[0] <= ({{(BUFF_SIZE - 16){1'b0}}, in_data[0]}) << (8 - (IN_DEPTH - OUT_DEPTH));
+            data_cal[1] <= ({{(BUFF_SIZE - 16){1'b0}}, in_data[1]}) << (8 - (IN_DEPTH - OUT_DEPTH));
+            data_cal[2] <= ({{(BUFF_SIZE - 16){1'b0}}, in_data[2]}) << (8 - (IN_DEPTH - OUT_DEPTH));
+          end
+        end
+
+        CALC_DATA: begin
+          if (color_correction) begin
+            data_cal[0] <= (data_cal[0] * {{(BUFF_SIZE - 16){1'b0}}, gain_red}) >> 16;
+            data_cal[1] <= (data_cal[1] * {{(BUFF_SIZE - 16){1'b0}}, gain_green}) >> 16;
+            data_cal[2] <= (data_cal[2] * {{(BUFF_SIZE - 16){1'b0}}, gain_blue}) >> 16;
+          end
+          else begin
+            data_cal[0] <= data_cal[0] >> 8;
+            data_cal[1] <= data_cal[1] >> 8;
+            data_cal[2] <= data_cal[2] >> 8;
+          end
+        end
+
+        SATI_DATA: begin
+          data_cal[0] <= |data_cal[0][BUFF_SIZE -1 :OUT_DEPTH] ? {BUFF_SIZE{1'b1}} : data_cal[0];
+          data_cal[1] <= |data_cal[0][BUFF_SIZE -1 :OUT_DEPTH] ? {BUFF_SIZE{1'b1}} : data_cal[1];
+          data_cal[2] <= |data_cal[0][BUFF_SIZE -1 :OUT_DEPTH] ? {BUFF_SIZE{1'b1}} : data_cal[2];
+        end
+
+        SEND_DATA: begin
+          if (in_ready && !in_receive) begin
+            out_en <= 1;
+            out_data <= {
+              data_cal[0][OUT_DEPTH-1:0], data_cal[1][OUT_DEPTH-1:0], data_cal[2][OUT_DEPTH-1:0]
+            };
+          end else out_en <= 0;
+        end
+
+        default: ;
+      endcase
+    end
+  end
+
+endmodule

Color/GammaCorrection.v

@@ -0,0 +1,53 @@
+`timescale 1ns / 1ps
+
+module GammaCorrection #(
+    parameter reg [4:0] COLOR_DEPTH = 8
+) (
+    input wire clk,
+    input wire reset,
+
+    input wire in_en,
+    input wire [COLOR_DEPTH - 1 : 0] in_data [3],
+    output wire out_ready,
+    output wire out_receive,
+
+    output reg out_en,
+    output reg [COLOR_DEPTH - 1 : 0] out_data [3],
+    input wire in_ready,
+    input wire in_receive,
+
+    input wire [8:0] gamma
+);
+  reg [2:0] state, nextState;
+  localparam reg [2:0] READ_DATA = 0;
+  localparam reg [2:0] CALC_DATA = 1;
+  localparam reg [2:0] SEND_DATA = 2;
+
+  reg [15:0] data_cal[3];
+
+  always @(posedge clk or posedge reset) begin
+    if (reset) state <= READ_DATA;
+    else state <= nextState;
+  end
+
+  always @(*) begin
+    case (state)
+      READ_DATA: nextState = in_en ? CALC_DATA : READ_DATA;
+      CALC_DATA: nextState = SEND_DATA;
+      SEND_DATA: nextState = in_receive ? READ_DATA : SEND_DATA;
+      default:   nextState = READ_DATA;
+    endcase
+  end
+
+  always @(posedge clk or posedge reset) begin
+    if (reset) begin
+      out_en <= 0;
+      out_data <= 0;
+    end
+    else begin
+      
+    end
+  end
+
+
+endmodule