Initial commit of OpenSPARC T2 design and verification files.

[OpenSPARC-T2-DV] / verif / model / pcie / dll / tl_consumer.cpp

// ========== Copyright Header Begin ==========================================
// 
// OpenSPARC T2 Processor File: tl_consumer.cpp
// Copyright (C) 1995-2007 Sun Microsystems, Inc. All Rights Reserved
// 4150 Network Circle, Santa Clara, California 95054, U.S.A.
//
// * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER. 
//
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation; version 2 of the License.
//
// This program 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 General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
// 
// For the avoidance of doubt, and except that if any non-GPL license 
// choice is available it will apply instead, Sun elects to use only 
// the General Public License version 2 (GPLv2) at this time for any 
// software where a choice of GPL license versions is made 
// available with the language indicating that GPLv2 or any later version 
// may be used, or where a choice of which version of the GPL is applied is 
// otherwise unspecified. 
//
// Please contact Sun Microsystems, Inc., 4150 Network Circle, Santa Clara, 
// CA 95054 USA or visit www.sun.com if you need additional information or 
// have any questions. 
// 
// ========== Copyright Header End ============================================
#ifndef DLL_tl_consumer_h
#define DLL_tl_consumer_h

#include "dll_top.hpp"

namespace pcie {

   /** This function processes packets from TL **/
   void dll_top::tl_consumer()
   {
       LOG_DEBUG<<"DLL: tl_consumer begins...";
       try{
           RefPciePacket receive_packet;
           int i,packet_size;
           sc_uint<32> lcrc_mapped;

           while (true) {

               if ( ltssm_L0s ) // || replay_buffer_size <= 0 )
               {
                   // Cease accepting TLPs from TL until the equation is not satisfied
               }
               else
               {
                   // Receive packet from TL
                   tl_dll_in.get_packet(receive_packet);
                   // Display packet
                   LOG_DEBUG << " _DLL_: Received packet from TL with PktId= " << receive_packet->getPacketId() << " Size= " <<  receive_packet->get_size(); 
                   //cout << sc_time_stamp() << "\t\t\t\t\t| DLL: Received TLP " << receive_packet->getPacketId() << " from ETL." << endl;
                   // Apply NEXT_TRANSMIT_SEQ to TLP
                   prepend_byte0.range(7,4) = 0;
                   prepend_byte0.range(3,0) = NEXT_TRANSMIT_SEQ.range(11,8); 

                   prepend_byte1 = NEXT_TRANSMIT_SEQ.range(7,0); 

                   receive_packet->modify_byte(1,prepend_byte0);
                   receive_packet->modify_byte(2,prepend_byte1);

                   lcrc_mapped=calculate_lcrc(receive_packet,1,receive_packet->get_size() - 4);

                   packet_size=receive_packet->get_size();

                   if(receive_packet->get_control() != 0x12){
                       receive_packet->set_control(0xa);
                       receive_packet->modify_byte(packet_size-4,lcrc_mapped.range(31,24));
                       receive_packet->modify_byte(packet_size-3,lcrc_mapped.range(23,16));
                       receive_packet->modify_byte(packet_size-2,lcrc_mapped.range(15,8));
                       receive_packet->modify_byte(packet_size-1,lcrc_mapped.range(7,0));
                   }
                   else{
                       LOG_DEBUG << "NULLifying PACKET";
                       receive_packet->modify_byte(packet_size-4,~lcrc_mapped.range(31,24));
                       receive_packet->modify_byte(packet_size-3,~lcrc_mapped.range(23,16));
                       receive_packet->modify_byte(packet_size-2,~lcrc_mapped.range(15,8));
                       receive_packet->modify_byte(packet_size-1,~lcrc_mapped.range(7,0));
                   }

                   queue_TLP.push(receive_packet);
                   eventPlPktRdy.notify();
                   // Update registers 
                   NEXT_TRANSMIT_SEQ++;

                   // Do FC init checks
                   if ( Flag_FC1 && !Flag_FC2 &&
                           (receive_packet->get_byte(0) == STP ) )
                   {
                       Flag_FC2=1;
                       LOG_DEBUG << "_DLL_:FI1 and FI2 flags are set! ";
                   }// if
               }// else
           }// while
       }
       catch(sc_exception &e){
           LOG_DEBUG<<"DLL: Out of tl_consumer";
       }
   } // tl_consumer


   /** This function polls LTSSM state **/
   void dll_top::ltssm_state_check()
   {
       LOG_DEBUG<<"DLL: ltssm_state_check begins...";
       try{

           while ( true)
           {
               WAIT(csr_core_status_ev);
               ltssm_state_reg = csr_port.read_csr(PEU_CSR_A_CORE_STATUS_HW_ADDR);
               if ( ltssm_state_reg.range(48,44) == 17 ) // ILUPEU_LTSSM_L0S
                   ltssm_L0s = 1;
               else
                   ltssm_L0s = 0;
           } // while
       }
       catch(sc_exception &e){
           LOG_DEBUG<<"DLL: Out of ltss_state_check";
       }
   } // ltssm_state_check 
}
#endif