Subversion Repositories 1000base-x

//////////////////////////////////////////////////////////////////////
////                                                              ////
////  File name "ge_1000baseX_utils.v"                            ////
////                                                              ////
////  This file is part of the :                                  ////
////                                                              ////
//// "1000BASE-X IEEE 802.3-2008 Clause 36 - PCS project"         ////
////                                                              ////
////  http://opencores.org/project,1000base-x                     ////
////                                                              ////
////  Author(s):                                                  ////
////      - D.W.Pegler Cambridge Broadband Networks Ltd           ////
////                                                              ////
////      { peglerd@gmail.com, dwp@cambridgebroadand.com }        ////
////                                                              ////
//////////////////////////////////////////////////////////////////////
////                                                              ////
//// Copyright (C) 2009 AUTHORS. All rights reserved.             ////
////                                                              ////
//// This source file may be used and distributed without         ////
//// restriction provided that this copyright statement is not    ////
//// removed from the file and that any derivative work contains  ////
//// the original copyright notice and the associated disclaimer. ////
////                                                              ////
//// This source file is free software; you can redistribute it   ////
//// and/or modify it under the terms of the GNU Lesser General   ////
//// Public License as published by the Free Software Foundation; ////
//// either version 2.1 of the License, or (at your option) any   ////
//// later version.                                               ////
////                                                              ////
//// This source is distributed in the hope that it will be       ////
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
//// PURPOSE.  See the GNU Lesser General Public License for more ////
//// details.                                                     ////
////                                                              ////
//// You should have received a copy of the GNU Lesser General    ////
//// Public License along with this source; if not, download it   ////
//// from http://www.opencores.org/lgpl.shtml                     ////
////                                                              ////
//////////////////////////////////////////////////////////////////////
////                                                              ////
////                                                              ////
//////////////////////////////////////////////////////////////////////
 
`include "timescale_tb.v"
 
`include "ge_1000baseX_regs.v"
 
package ge_1000baseX_utils;
 
   import tb_utils::VirIntfHandle;
 
   task automatic reg_write(VirIntfHandle vih, int addr, reg [15:0] data);
 
      vih.serial_model.write(addr, data);
 
   endtask 
 
   task automatic reg_read(VirIntfHandle vih, int addr, output reg [15:0] val);
 
      vih.serial_model.read(addr, val);
 
   endtask
 
   task automatic signal_detect_ctrl(VirIntfHandle vih, int s);
 
      reg [15:0] b;
 
      reg_read(vih,`GMII_BASIC_CTRL, b);
 
      if (s==0) begin b &= ~(16'h0800); end else begin b |= 16'h0800; end
 
      reg_write(vih, `GMII_BASIC_CTRL, (b & 16'hffff));
 
   endtask
 
   task automatic unplug_fo(VirIntfHandle vih);
 
      $display("%m: FO interface unplugged", );
 
      signal_detect_ctrl(vih, 0);
 
   endtask // automatic
 
    task automatic insert_fo(VirIntfHandle vih);
 
       $display("%m: FO interface inserted");
 
       signal_detect_ctrl(vih, 1);
 
    endtask // automatic
 
   task automatic read_phy_ident(VirIntfHandle vih);
 
      reg [15:0] id1,  id2;
 
      reg_read(vih,`GMII_PHY_ID1, id1); reg_read(vih,`GMII_PHY_ID2, id2);
 
      $display("%m: 1000baseX PCS OUI: %02h%02h%02h - ver %02d.%02d", 
	       id1[7:0], id1[15:8], id2[7:0], id2[15:12], id2[11:8]);
 
   endtask
 
   task automatic reset_aneg(VirIntfHandle vih);
 
      reg [15:0] basic_ctrl;
 
      $display("%m");
 
      reg_read(vih,`GMII_BASIC_CTRL, basic_ctrl);
 
      basic_ctrl = (basic_ctrl & 16'hffff) | 16'h8000;
 
      reg_write(vih, `GMII_BASIC_CTRL, basic_ctrl);
 
   endtask // automatic
 
   task automatic restart_aneg(VirIntfHandle vih);
 
      reg [15:0] basic_ctrl;
 
      $display("%m");
 
      reg_read(vih,`GMII_BASIC_CTRL, basic_ctrl);
 
      basic_ctrl = (basic_ctrl & 16'hffff) | 16'h0200;
 
      reg_write(vih, `GMII_BASIC_CTRL, basic_ctrl);
 
   endtask // automatic
 
 
   task automatic signal_detect_poll(VirIntfHandle vih);
 
      reg [15:0] status =  0; reg [31:0] counter = 0;
 
      $display("%m");
 
      while(!status[2])
	begin
	   reg_read(vih, `GMII_BASIC_STATUS, status);
 
	   $display("%m: %u: Waiting for signal_detect - status is %16b", counter, status);
	   counter +=1;
	end
 
   endtask
 
   task automatic aneg_complete_poll(VirIntfHandle vih);
 
      reg [31:0] cnt = 0; reg [15:0] basic_status =  0;
 
      $display("%m");
 
      while(!basic_status[5])
	begin
	   reg_read(vih, `GMII_BASIC_STATUS, basic_status);  cnt +=1;
 
	   $display("%m: Polling ANEG complete : %16b : attempt %d", basic_status, cnt);
 
	end
   endtask
 
     task automatic read_aneg_link_partner_capablities(VirIntfHandle vih);
 
      reg [15:0] lp_adv;
 
      reg_read(vih,`GMII_AN_LP_ADV, lp_adv);
 
      $display("%m: ANEG Link Partner capability: %04h", lp_adv);
 
   endtask 
 
 
endpackage