sja1000: fixes

[fpga/zynq/canbench-sw.git] / system / ip / sja1000_1.0 / hdl / can_bsp_txstream.v

diff --git a/system/ip/sja1000_1.0/hdl/can_bsp_txstream.v b/system/ip/sja1000_1.0/hdl/can_bsp_txstream.v
index a7447844bf2d92871a505c33016461ad427710c5..ceb06c0a72f8871df13043e72ce48512e8fc225b 100644 (file)
--- a/system/ip/sja1000_1.0/hdl/can_bsp_txstream.v
+++ b/system/ip/sja1000_1.0/hdl/can_bsp_txstream.v
@@ -73,41 +73,44 @@ assign basic_chain_data_byte        = {4'd9,  4'd8,  4'd7,  4'd6, 4'd5, 4'd4, 4'
 assign extended_chain_data_std_byte = {4'd10, 4'd9,  4'd8,  4'd7, 4'd6, 4'd5, 4'd4, 4'd3};
 assign extended_chain_data_ext_byte = {4'd12, 4'd11, 4'd10, 4'd9, 4'd8, 4'd7, 4'd6, 4'd5};
 
+reg [10*4-1 : 0] chain_data_byte;
+
 `ifdef _
 end
 `endif
 
 always @(*)
 begin
-       if (extended_mode)
-       begin
-               if (tx_is_extended_frame)    // Extended frame
-               begin
-                       chain_byte = extended_chain_ext_byte;
-                       chain_duration = extended_chain_ext_duration;
-               end else begin
-                       chain_byte = {{4{4'h0}}, extended_chain_std_byte};
-                       chain_duration = {{4{4'h0}}, extended_chain_std_duration};
-               end
-       end else begin
-               chain_byte = {{5{4'h0}}, basic_chain_byte};
-               chain_duration = {{5{4'h0}}, basic_chain_duration};
-       end
+       casex ({extended_mode, tx_is_extended_frame})
+               2'b11: chain_byte = extended_chain_ext_byte; // Extended mode, Extended frame
+               2'b10: chain_byte = {{4{4'h0}}, extended_chain_std_byte}; // Extended mode, Standard frame
+               2'b0x: chain_byte = {{5{4'h0}}, basic_chain_byte}; // Basic mode
+       endcase
+       casex ({extended_mode, tx_is_extended_frame})
+               2'b11: chain_duration = extended_chain_ext_duration; // Extended mode, Extended frame
+               2'b10: chain_duration = {{4{4'h0}}, extended_chain_std_duration}; // Extended mode, Standard frame
+               2'b0x: chain_duration = {{5{4'h0}}, basic_chain_duration}; // Basic mode
+       endcase
+       casex ({extended_mode, tx_is_extended_frame})
+               2'b11: chain_data_byte <= extended_chain_data_ext_byte; // Extended mode, Extended Frame
+               2'b10: chain_data_byte <= extended_chain_data_std_byte; // Extended mode, Standard Frame
+               2'b0x: chain_data_byte <= basic_chain_data_byte; // Basic mode
+       endcase
 end
 
 always @(posedge rst or posedge clk)
 begin
        if (rst || rst_tx_pointer)
        begin
-               item_idx <= 0;
-               item_cnt <= 0;
+               item_idx <= 4'h0;
+               item_cnt <= 4'h0;
        end 
        else if (~rx_data & ~rx_crc & ~finish_msg)
        begin
                if (item_cnt >= chain_duration[item_idx])
                begin
                        item_idx <= item_idx + 1'b1;
-                       item_cnt <= 0;
+                       item_cnt <= 4'h0;
                end
                else
                        item_cnt <= item_cnt + 1'b1;
@@ -125,20 +128,6 @@ begin
                tx_data_addr_o <= tx_data_addr_wire;
 end
 
-reg [10*4-1 : 0] chain_data_byte;
-
-always @(*)
-begin
-       if (extended_mode) // Extended mode
-       begin
-               if (tx_is_extended_frame)    // Extended frame
-                       chain_data_byte <= extended_chain_data_ext_byte;
-               else
-                       chain_data_byte <= extended_chain_data_std_byte;
-       end
-       else   // Basic mode
-               chain_data_byte <= basic_chain_data_byte;
-end
 
 
 integer i;
@@ -149,22 +138,15 @@ begin
        if (rx_data)  // data stage
        begin
                case (data_byte_idx)
-                       3'h0: tx_data_addr_wire = chain_data_byte[0*4+3 : 0*4];
-                       3'h1: tx_data_addr_wire = chain_data_byte[1*4+3 : 1*4];
-                       3'h2: tx_data_addr_wire = chain_data_byte[2*4+3 : 2*4];
-                       3'h3: tx_data_addr_wire = chain_data_byte[3*4+3 : 3*4];
-                       3'h4: tx_data_addr_wire = chain_data_byte[4*4+3 : 4*4];
-                       3'h5: tx_data_addr_wire = chain_data_byte[5*4+3 : 5*4];
-                       3'h6: tx_data_addr_wire = chain_data_byte[6*4+3 : 6*4];
-                       3'h7: tx_data_addr_wire = chain_data_byte[7*4+3 : 7*4];
-                       3'h8: tx_data_addr_wire = chain_data_byte[8*4+3 : 8*4];
-                       3'h9: tx_data_addr_wire = chain_data_byte[9*4+3 : 9*4];
-                       3'ha: tx_data_addr_wire = chain_data_byte[10*4+3 : 10*4];
-                       3'hb: tx_data_addr_wire = chain_data_byte[11*4+3 : 11*4];
-                       3'hc: tx_data_addr_wire = chain_data_byte[12*4+3 : 12*4];
-                       3'hd: tx_data_addr_wire = chain_data_byte[13*4+3 : 13*4];
-                       3'he: tx_data_addr_wire = chain_data_byte[14*4+3 : 14*4];
-                       3'hf: tx_data_addr_wire = chain_data_byte[15*4+3 : 15*4];
+                       3'h0: tx_data_addr_wire <= chain_data_byte[0*4+3 : 0*4];
+                       3'h1: tx_data_addr_wire <= chain_data_byte[1*4+3 : 1*4];
+                       3'h2: tx_data_addr_wire <= chain_data_byte[2*4+3 : 2*4];
+                       3'h3: tx_data_addr_wire <= chain_data_byte[3*4+3 : 3*4];
+                       3'h4: tx_data_addr_wire <= chain_data_byte[4*4+3 : 4*4];
+                       3'h5: tx_data_addr_wire <= chain_data_byte[5*4+3 : 5*4];
+                       3'h6: tx_data_addr_wire <= chain_data_byte[6*4+3 : 6*4];
+                       3'h7: tx_data_addr_wire <= chain_data_byte[7*4+3 : 7*4];
+                       default: $error("impossible");
                endcase
                //tx_data_addr_wire = chain_data_byte[data_byte_idx*4+3 +: 4]; 
        end
@@ -174,22 +156,25 @@ begin
                tx_data_addr_wire <= 4'hx;
        else
                case (item_idx)
-                       3'h0: tx_data_addr_wire = chain_byte[0*4+3 : 0*4];
-                       3'h1: tx_data_addr_wire = chain_byte[1*4+3 : 1*4];
-                       3'h2: tx_data_addr_wire = chain_byte[2*4+3 : 2*4];
-                       3'h3: tx_data_addr_wire = chain_byte[3*4+3 : 3*4];
-                       3'h4: tx_data_addr_wire = chain_byte[4*4+3 : 4*4];
-                       3'h5: tx_data_addr_wire = chain_byte[5*4+3 : 5*4];
-                       3'h6: tx_data_addr_wire = chain_byte[6*4+3 : 6*4];
-                       3'h7: tx_data_addr_wire = chain_byte[7*4+3 : 7*4];
-                       3'h8: tx_data_addr_wire = chain_byte[8*4+3 : 8*4];
-                       3'h9: tx_data_addr_wire = chain_byte[9*4+3 : 9*4];
-                       3'ha: tx_data_addr_wire = chain_byte[10*4+3 : 10*4];
-                       3'hb: tx_data_addr_wire = chain_byte[11*4+3 : 11*4];
-                       3'hc: tx_data_addr_wire = chain_byte[12*4+3 : 12*4];
-                       3'hd: tx_data_addr_wire = chain_byte[13*4+3 : 13*4];
-                       3'he: tx_data_addr_wire = chain_byte[14*4+3 : 14*4];
-                       3'hf: tx_data_addr_wire = chain_byte[15*4+3 : 15*4];
+                       4'h0: tx_data_addr_wire <= chain_byte[0*4+3 : 0*4];
+                       4'h1: tx_data_addr_wire <= chain_byte[1*4+3 : 1*4];
+                       4'h2: tx_data_addr_wire <= chain_byte[2*4+3 : 2*4];
+                       4'h3: tx_data_addr_wire <= chain_byte[3*4+3 : 3*4];
+                       4'h4: tx_data_addr_wire <= chain_byte[4*4+3 : 4*4];
+                       4'h5: tx_data_addr_wire <= chain_byte[5*4+3 : 5*4];
+                       4'h6: tx_data_addr_wire <= chain_byte[6*4+3 : 6*4];
+                       4'h7: tx_data_addr_wire <= chain_byte[7*4+3 : 7*4];
+                       4'h8: tx_data_addr_wire <= chain_byte[8*4+3 : 8*4];
+                       4'h9: tx_data_addr_wire <= chain_byte[9*4+3 : 9*4];
+                       default: tx_data_addr_wire <= 4'hx;
+                       /*
+                       4'ha: tx_data_addr_wire <= chain_byte[10*4+3 : 10*4];
+                       4'hb: tx_data_addr_wire <= chain_byte[11*4+3 : 11*4];
+                       4'hc: tx_data_addr_wire <= chain_byte[12*4+3 : 12*4];
+                       4'hd: tx_data_addr_wire <= chain_byte[13*4+3 : 13*4];
+                       4'he: tx_data_addr_wire <= chain_byte[14*4+3 : 14*4];
+                       4'hf: tx_data_addr_wire <= chain_byte[15*4+3 : 15*4];
+                       */
                endcase
                //tx_data_addr_wire <= 4'hx;//chain_byte[item_idx]; // TODO
 end