Index: /branches/v5/modules/vci_cc_vcache_wrapper/caba/metadata/vci_cc_vcache_wrapper.sd
===================================================================
--- /branches/v5/modules/vci_cc_vcache_wrapper/caba/metadata/vci_cc_vcache_wrapper.sd	(revision 300)
+++ /branches/v5/modules/vci_cc_vcache_wrapper/caba/metadata/vci_cc_vcache_wrapper.sd	(revision 300)
@@ -0,0 +1,51 @@
+
+# -*- python -*-
+
+Module('caba:vci_cc_vcache_wrapper',
+	classname = 'soclib::caba::VciCcVCacheWrapper',
+	tmpl_parameters = [ parameter.Module('vci_param', default = 'caba:vci_param'),
+	                    parameter.Module('iss_t') ],
+	header_files =         [ '../source/include/vci_cc_vcache_wrapper.h' ],
+	implementation_files = [ '../source/src/vci_cc_vcache_wrapper.cpp' ],
+	uses = [ Uses('caba:base_module'),
+	         Uses('common:mapping_table'),
+	         Uses('common:iss2'),
+	         Uses('caba:multi_write_buffer'),
+	         Uses('caba:generic_fifo'),
+	         Uses('caba:generic_cache_tsar', 
+                       addr_t = parameter.StringExt('sc_dt::sc_uint<%d> ', 
+                       parameter.Reference('addr_size'))),
+	         Uses('caba:generic_tlb', 
+                       addr_t = parameter.StringExt('sc_dt::sc_uint<%d> ', 
+                       parameter.Reference('addr_size'))),
+	         Uses('common:address_masking_table', 
+                       data_t = parameter.StringExt('sc_dt::sc_uint<%d> ', 
+                       parameter.Reference('addr_size'))) ],
+	ports = [ Port('caba:vci_initiator', 'p_vci_ini_d'),
+	          Port('caba:vci_initiator', 'p_vci_ini_c'),
+	          Port('caba:vci_target', 'p_vci_tgt_d'),
+	          Port('caba:bit_in','p_irq', parameter.Constant('n_irq')),
+	          Port('caba:bit_in', 'p_resetn', auto = 'resetn'),
+	          Port('caba:clock_in', 'p_clk', auto = 'clock'), ],
+	instance_parameters = [ parameter.Int('proc_id'),
+	                        parameter.Module('mt', 'common:mapping_table'),
+	                        parameter.Module('mc', 'common:mapping_table'),
+	                        parameter.IntTab('initiator_rw_index'),
+	                        parameter.IntTab('initiator_c_index'),
+	                        parameter.IntTab('target_index'),
+    	                        parameter.Int('itlb_ways'),
+    	                        parameter.Int('itlb_sets'),
+    	                        parameter.Int('dtlb_ways'),
+    	                        parameter.Int('dtlb_sets'),
+    	                        parameter.Int('icache_ways'),
+    	                        parameter.Int('icache_sets'),
+    	                        parameter.Int('icache_words'),
+    	                        parameter.Int('dcache_ways'),
+    	                        parameter.Int('dcache_sets'),
+    	                        parameter.Int('dcache_words'),
+    	                        parameter.Int('wbuf_nlines'),
+    	                        parameter.Int('wbuf_nwords'),
+    	                        parameter.Int('max_frozen_cycles'), ],
+)
+
+
Index: /branches/v5/modules/vci_cc_vcache_wrapper/caba/source/include/vci_cc_vcache_wrapper.h
===================================================================
--- /branches/v5/modules/vci_cc_vcache_wrapper/caba/source/include/vci_cc_vcache_wrapper.h	(revision 300)
+++ /branches/v5/modules/vci_cc_vcache_wrapper/caba/source/include/vci_cc_vcache_wrapper.h	(revision 300)
@@ -0,0 +1,745 @@
+/* -*- c++ -*-
+ * File : vci_cc_vcache_wrapper.h
+ * Copyright (c) UPMC, Lip6, SoC
+ * Authors : Alain GREINER, Yang GAO
+ * Date : 27/11/2011
+ *
+ * SOCLIB_LGPL_HEADER_BEGIN
+ * 
+ * This file is part of SoCLib, GNU LGPLv2.1.
+ * 
+ * SoCLib 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; version 2.1 of the License.
+ * 
+ * SoCLib 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 SoCLib; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301 USA
+ * 
+ * SOCLIB_LGPL_HEADER_END
+ */
+ 
+#ifndef SOCLIB_CABA_VCI_CC_VCACHE_WRAPPER_H
+#define SOCLIB_CABA_VCI_CC_VCACHE_WRAPPER_H
+
+#include <inttypes.h>
+#include <systemc>
+#include "caba_base_module.h"
+#include "multi_write_buffer.h"
+#include "generic_fifo.h"
+#include "generic_tlb.h"
+#include "generic_cache.h"
+#include "vci_initiator.h"
+#include "vci_target.h"
+#include "mapping_table.h"
+#include "static_assert.h"
+#include "iss2.h"
+
+#define LLSC_TIMEOUT    10000
+
+namespace soclib {
+namespace caba {
+
+using namespace sc_core;
+
+////////////////////////////////////////////
+template<typename vci_param, typename iss_t>
+class VciCcVCacheWrapper
+////////////////////////////////////////////
+    : public soclib::caba::BaseModule
+{
+    typedef uint32_t vaddr_t;
+    typedef uint32_t tag_t;
+    typedef uint32_t type_t;
+    typedef typename iss_t::DataOperationType data_op_t;
+
+    typedef typename vci_param::addr_t  paddr_t;
+    typedef typename vci_param::data_t  vci_data_t;
+    typedef typename vci_param::be_t    vci_be_t;
+    typedef typename vci_param::srcid_t vci_srcid_t;
+    typedef typename vci_param::trdid_t vci_trdid_t;
+    typedef typename vci_param::pktid_t vci_pktid_t;
+    typedef typename vci_param::plen_t  vci_plen_t;
+
+    enum icache_fsm_state_e {  
+        ICACHE_IDLE,             
+        // handling XTN processor requests
+        ICACHE_XTN_TLB_FLUSH,
+        ICACHE_XTN_CACHE_FLUSH, 
+        ICACHE_XTN_CACHE_FLUSH_GO, 
+        ICACHE_XTN_TLB_INVAL,  
+        ICACHE_XTN_CACHE_INVAL_VA,
+        ICACHE_XTN_CACHE_INVAL_PA,  
+        ICACHE_XTN_CACHE_INVAL_GO,
+        // handling tlb miss
+        ICACHE_TLB_WAIT,
+        // handling cache miss
+        ICACHE_MISS_SELECT,   
+        ICACHE_MISS_CLEAN,   
+        ICACHE_MISS_WAIT,   
+        ICACHE_MISS_DATA_UPDT, 
+        ICACHE_MISS_DIR_UPDT, 
+        // handling unc read
+        ICACHE_UNC_WAIT,  
+        // handling coherence requests
+        ICACHE_CC_CLACK,
+        ICACHE_CC_CHECK, 
+        ICACHE_CC_INVAL, 
+        ICACHE_CC_UPDT,
+        ICACHE_CC_BROADCAST, 
+    };
+
+    enum dcache_fsm_state_e {  
+        DCACHE_IDLE,                
+        // handling itlb & dtlb miss
+        DCACHE_TLB_MISS,
+        DCACHE_TLB_PTE1_GET,           
+        DCACHE_TLB_PTE1_SELECT,      
+        DCACHE_TLB_PTE1_UPDT,       
+        DCACHE_TLB_PTE2_GET,    
+        DCACHE_TLB_PTE2_SELECT,       
+        DCACHE_TLB_PTE2_UPDT,           
+        DCACHE_TLB_LR_UPDT,           
+        DCACHE_TLB_LR_WAIT,           
+        DCACHE_TLB_RETURN,         
+	    // handling processor XTN requests
+        DCACHE_XTN_SWITCH,
+        DCACHE_XTN_SYNC,
+        DCACHE_XTN_IC_INVAL_VA,        
+        DCACHE_XTN_IC_FLUSH,        
+        DCACHE_XTN_IC_INVAL_PA,     
+        DCACHE_XTN_IT_INVAL,          
+        DCACHE_XTN_DC_FLUSH,        
+        DCACHE_XTN_DC_FLUSH_GO,     
+        DCACHE_XTN_DC_INVAL_VA,        
+        DCACHE_XTN_DC_INVAL_PA,     
+        DCACHE_XTN_DC_INVAL_END,
+        DCACHE_XTN_DC_INVAL_GO,          
+        DCACHE_XTN_DT_INVAL,          
+        //handling dirty bit update
+        DCACHE_DIRTY_GET_PTE,
+        DCACHE_DIRTY_WAIT,           
+	    // handling processor miss requests
+        DCACHE_MISS_SELECT,
+        DCACHE_MISS_CLEAN,
+        DCACHE_MISS_WAIT,           
+        DCACHE_MISS_DATA_UPDT,           
+        DCACHE_MISS_DIR_UPDT,           
+        // handling processor unc, ll and sc requests
+        DCACHE_UNC_WAIT,            
+        DCACHE_LL_WAIT,            
+        DCACHE_SC_WAIT,            
+        // handling coherence requests
+        DCACHE_CC_CLACK,            
+        DCACHE_CC_CHECK,            
+        DCACHE_CC_INVAL,            
+        DCACHE_CC_UPDT,             
+        DCACHE_CC_BROADCAST,        
+        // handling TLB inval (after a coherence or XTN request)
+        DCACHE_INVAL_TLB_SCAN,             
+    };
+
+    enum cmd_fsm_state_e {      
+        CMD_IDLE,
+        CMD_INS_MISS,
+        CMD_INS_UNC,
+        CMD_DATA_MISS,
+        CMD_DATA_UNC,
+        CMD_DATA_WRITE,
+        CMD_DATA_LL,
+        CMD_DATA_SC,
+        CMD_DATA_CAS, 
+    };
+
+    enum rsp_fsm_state_e {       
+        RSP_IDLE,
+        RSP_INS_MISS,
+        RSP_INS_UNC,
+        RSP_DATA_MISS,
+        RSP_DATA_UNC,
+        RSP_DATA_LL,
+        RSP_DATA_WRITE,
+    };
+
+    enum cleanup_cmd_fsm_state_e {
+        CLEANUP_CMD_DATA_IDLE,
+        CLEANUP_CMD_DATA_GO,
+        CLEANUP_CMD_INS_IDLE,
+        CLEANUP_CMD_INS_GO,
+    };
+
+    enum cleanup_rsp_fsm_state_e {
+        CLEANUP_RSP_IDLE,
+        CLEANUP_RSP_DATA,
+        CLEANUP_RSP_INS,
+    };
+
+    enum tgt_fsm_state_e {  
+        TGT_IDLE,
+        TGT_UPDT_WORD,
+        TGT_UPDT_DATA,
+        TGT_REQ_BROADCAST,
+        TGT_REQ_ICACHE,
+        TGT_REQ_DCACHE,
+        TGT_RSP_BROADCAST,
+        TGT_RSP_ICACHE, 
+        TGT_RSP_DCACHE,
+    };
+
+    /* transaction type, pktid field */
+    enum transaction_type_e
+    {
+        // b3 unused
+        // b2 READ / NOT READ
+        // if READ
+        //  b1 DATA / INS
+        //  b0 UNC / MISS
+        // else 
+        //  b1 accÃšs table llsc type SW / other
+        //  b2 WRITE/CAS/LL/SC
+        TYPE_READ_DATA_UNC          = 0x0,
+        TYPE_READ_DATA_MISS         = 0x1,
+        TYPE_READ_INS_UNC           = 0x2,
+        TYPE_READ_INS_MISS          = 0x3,
+        TYPE_WRITE                  = 0x4,
+        TYPE_CAS                    = 0x5,
+        TYPE_LL                     = 0x6,
+        TYPE_SC                     = 0x7
+    };
+    
+    /* SC return values */
+    enum sc_status_type_e
+    {
+        SC_SUCCESS  =   0x00000000,
+        SC_FAIL     =   0x00000001
+    };
+
+    // coherence request type
+    enum {
+        CC_TYPE_INVAL_DATA,
+        CC_TYPE_INVAL_INS,
+        CC_TYPE_UPDT_DATA,
+        CC_TYPE_UPDT_INS,
+        CC_TYPE_BROADCAST,
+    };
+
+    // TLB Mode : ITLB / DTLB / ICACHE / DCACHE
+    enum {          
+        INS_TLB_MASK    = 0x8,
+        DATA_TLB_MASK   = 0x4,
+        INS_CACHE_MASK  = 0x2,
+        DATA_CACHE_MASK = 0x1,
+    };
+
+    // Error Type
+    enum mmu_error_type_e 
+    {
+        MMU_NONE                      = 0x0000, // None
+        MMU_WRITE_PT1_UNMAPPED 	      = 0x0001, // Write & Page fault on PT1          
+        MMU_WRITE_PT2_UNMAPPED 	      = 0x0002, // Write & Page fault on PT2          
+        MMU_WRITE_PRIVILEGE_VIOLATION = 0x0004, // Write & Protected access in user mode      
+        MMU_WRITE_ACCES_VIOLATION     = 0x0008, // Write to non writable page
+        MMU_WRITE_UNDEFINED_XTN       = 0x0020, // Write & undefined external access  
+        MMU_WRITE_PT1_ILLEGAL_ACCESS  = 0x0040, // Write & Bus Error accessing PT1       
+        MMU_WRITE_PT2_ILLEGAL_ACCESS  = 0x0080, // Write & Bus Error accessing PT2      
+        MMU_WRITE_DATA_ILLEGAL_ACCESS = 0x0100, // Write & Bus Error in cache access     
+        MMU_READ_PT1_UNMAPPED 	      = 0x1001, // Read & Page fault on PT1  	
+        MMU_READ_PT2_UNMAPPED 	      = 0x1002, // Read & Page fault on PT2  
+        MMU_READ_PRIVILEGE_VIOLATION  = 0x1004, // Read & Protected access in user mode 
+        MMU_READ_EXEC_VIOLATION       = 0x1010, // Read & Exec access to a non exec page 
+        MMU_READ_UNDEFINED_XTN 	      = 0x1020, // Read & Undefined external access  
+        MMU_READ_PT1_ILLEGAL_ACCESS   = 0x1040, // Read & Bus Error accessing PT1      
+        MMU_READ_PT2_ILLEGAL_ACCESS   = 0x1080, // Read & Bus Error accessing PT2 	
+        MMU_READ_DATA_ILLEGAL_ACCESS  = 0x1100, // Read & Bus Error in cache access 
+    };
+
+    // miss types for data cache
+    enum dcache_miss_type_e
+    {
+        PTE1_MISS, 
+        PTE2_MISS,
+        PROC_MISS,  
+    };
+
+    enum transaction_type_d_e
+    {
+        // b0 : 1 if cached
+        // b1 : 1 if instruction
+        TYPE_DATA_UNC     = 0x0,
+        TYPE_DATA_MISS    = 0x1,
+        TYPE_INS_UNC      = 0x2,
+        TYPE_INS_MISS     = 0x3,
+    };
+
+public:
+    sc_in<bool>                             p_clk;
+    sc_in<bool>                             p_resetn;
+    sc_in<bool>                             p_irq[iss_t::n_irq];
+    soclib::caba::VciInitiator<vci_param>   p_vci_ini_d;
+    soclib::caba::VciInitiator<vci_param>   p_vci_ini_c;
+    soclib::caba::VciTarget<vci_param>      p_vci_tgt_c;
+
+private:
+
+    // STRUCTURAL PARAMETERS
+    soclib::common::AddressDecodingTable<uint32_t, bool>    	m_cacheability_table;
+    const soclib::common::Segment                           	m_segment;
+    const vci_srcid_t                                       	m_srcid_d;
+    const vci_srcid_t                                       	m_srcid_c;
+
+    const size_t  						m_itlb_ways;
+    const size_t  						m_itlb_sets;
+
+    const size_t  						m_dtlb_ways;
+    const size_t  						m_dtlb_sets;
+
+    const size_t  						m_icache_ways;
+    const size_t  						m_icache_sets;
+    const paddr_t 						m_icache_yzmask;
+    const size_t  						m_icache_words;
+
+    const size_t  						m_dcache_ways;
+    const size_t  						m_dcache_sets;
+    const paddr_t 						m_dcache_yzmask;
+    const size_t  						m_dcache_words;
+
+    const size_t                        m_x_width;
+    const size_t                        m_y_width;
+
+    const size_t                        m_memory_cache_local_id;
+    const size_t                        m_proc_id;
+    const uint32_t						m_max_frozen_cycles;
+    const size_t  						m_paddr_nbits;  
+
+    ////////////////////////////////////////
+    // Communication with processor ISS
+    ////////////////////////////////////////
+    typename iss_t::InstructionRequest  m_ireq;
+    typename iss_t::InstructionResponse m_irsp;
+    typename iss_t::DataRequest         m_dreq;
+    typename iss_t::DataResponse        m_drsp;
+
+    /////////////////////////////////////////////
+    // debug variables (for each FSM)
+    /////////////////////////////////////////////
+    uint32_t                            m_debug_start_cycle;
+    bool                                m_debug_ok;
+    bool                                m_debug_previous_hit;
+    bool                                m_idebug_previous_hit;
+    bool                                m_debug_dcache_fsm;
+    bool                                m_debug_icache_fsm;
+    bool                                m_debug_cleanup_fsm;
+    bool                                m_debug_inval_itlb_fsm;
+    bool                                m_debug_inval_dtlb_fsm;
+
+    ///////////////////////////////
+    // Software visible REGISTERS
+    ///////////////////////////////
+    sc_signal<uint32_t>     r_mmu_ptpr;             	// page table pointer register
+    sc_signal<uint32_t>     r_mmu_mode;             	// mmu mode register
+    sc_signal<uint32_t>     r_mmu_word_lo;          	// mmu misc data low
+    sc_signal<uint32_t>     r_mmu_word_hi;          	// mmu misc data hight
+    sc_signal<uint32_t>     r_mmu_ibvar;      	    	// mmu bad instruction address
+    sc_signal<uint32_t>     r_mmu_dbvar;              	// mmu bad data address
+    sc_signal<uint32_t>     r_mmu_ietr;                 // mmu instruction error type
+    sc_signal<uint32_t>     r_mmu_detr;                 // mmu data error type
+    uint32_t	            r_mmu_params;		        // read-only
+    uint32_t	            r_mmu_release;		        // read_only
+
+
+    //////////////////////////////
+    // ICACHE FSM REGISTERS
+    //////////////////////////////
+    sc_signal<int>          r_icache_fsm;               // state register
+    sc_signal<int>          r_icache_fsm_save;          // return state for coherence op
+    sc_signal<paddr_t>      r_icache_vci_paddr;      	// physical address 
+    sc_signal<uint32_t>     r_icache_vaddr_save;        // virtual address from processor
+
+    // icache miss handling
+    sc_signal<size_t>       r_icache_miss_way;		    // selected way for cache update
+    sc_signal<size_t>       r_icache_miss_set;		    // selected set for cache update 
+    sc_signal<size_t>       r_icache_miss_word;		    // word index ( cache update)
+    sc_signal<bool>         r_icache_miss_inval;        // coherence request matching a miss
+    sc_signal<bool>         r_icache_miss_clack;        // waiting for a cleanup acknowledge
+
+    // coherence request handling
+    sc_signal<size_t>       r_icache_cc_way;		    // selected way for cc update/inval
+    sc_signal<size_t>       r_icache_cc_set;		    // selected set for cc update/inval
+    sc_signal<size_t>       r_icache_cc_word;		    // word counter for cc update
+
+    // icache flush handling
+    sc_signal<size_t>       r_icache_flush_count;	    // slot counter used for cache flush
+
+    // communication between ICACHE FSM and VCI_CMD FSM
+    sc_signal<bool>         r_icache_miss_req;           // cached read miss
+    sc_signal<bool>         r_icache_unc_req;            // uncached read miss
+
+    // communication between ICACHE FSM and DCACHE FSM
+    sc_signal<bool>	        r_icache_tlb_miss_req;       // (set icache/reset dcache)
+    sc_signal<bool>         r_icache_tlb_rsp_error;      // tlb miss response error 
+
+    // communication between ICACHE FSM and CLEANUP FSMs
+    sc_signal<bool>         r_icache_cleanup_req;        // ICACHE cleanup request
+    sc_signal<paddr_t>      r_icache_cleanup_line;       // ICACHE cleanup NLINE
+    sc_signal<size_t>       r_icache_cleanup_way;        // ICACHE cleanup way 
+
+    ///////////////////////////////
+    // DCACHE FSM REGISTERS
+    ///////////////////////////////
+    sc_signal<int>          r_dcache_fsm;               // state register
+    sc_signal<int>          r_dcache_fsm_cc_save;       // return state for coherence op
+    sc_signal<int>          r_dcache_fsm_scan_save;     // return state for tlb scan op
+    // registers written in P0 stage (used in P1 stage)
+    sc_signal<bool>         r_dcache_wbuf_req;          // WBUF must be written in P1 stage
+    sc_signal<bool>         r_dcache_updt_req;          // DCACHE must be updated in P1 stage
+    sc_signal<uint32_t>     r_dcache_save_vaddr;        // virtual address (from proc)
+    sc_signal<uint32_t>     r_dcache_save_wdata;        // write data (from proc)
+    sc_signal<vci_be_t>     r_dcache_save_be;           // byte enable (from proc)
+    sc_signal<paddr_t>      r_dcache_save_paddr;        // physical address 
+    sc_signal<bool>         r_dcache_save_cacheable;	// address cacheable 
+    sc_signal<size_t>       r_dcache_save_cache_way;	// selected way (from dcache) 
+    sc_signal<size_t>       r_dcache_save_cache_set;	// selected set (from dcache)    
+    sc_signal<size_t>       r_dcache_save_cache_word;	// selected word (from dcache)    
+    // registers used by the Dirty bit sub-fsm
+    sc_signal<paddr_t>      r_dcache_dirty_paddr;       // PTE physical address 
+    sc_signal<size_t>       r_dcache_dirty_way;	        // way to invalidate in dcache
+    sc_signal<size_t>       r_dcache_dirty_set;	        // set to invalidate in dcache
+
+    // communication between DCACHE FSM and VCI_CMD FSM
+    sc_signal<paddr_t>      r_dcache_vci_paddr;		    // physical address for VCI command
+    sc_signal<bool>         r_dcache_vci_miss_req;      // read miss request
+    sc_signal<bool>         r_dcache_vci_unc_req;       // uncacheable read request
+    sc_signal<bool>         r_dcache_vci_unc_be;        // uncacheable read byte enable
+    sc_signal<bool>         r_dcache_vci_cas_req;       // atomic write request CAS
+    sc_signal<uint32_t>     r_dcache_vci_cas_old;       // previous data value for a CAS
+    sc_signal<uint32_t>     r_dcache_vci_cas_new;       // new data value for a CAS
+    sc_signal<bool>         r_dcache_vci_ll_req;        // atomic read request LL
+    sc_signal<bool>         r_dcache_vci_sc_req;        // atomic write request SC
+    sc_signal<vci_data_t>   r_dcache_vci_sc_data;       // SC data (command)
+
+    // register used for XTN inval
+    sc_signal<size_t>       r_dcache_xtn_way;		    // selected way (from dcache) 
+    sc_signal<size_t>       r_dcache_xtn_set;		    // selected set (from dcache)    
+
+    // write buffer state extension
+    sc_signal<bool>         r_dcache_pending_unc_write; // pending uncacheable write in WBUF
+
+    // handling dcache miss
+    sc_signal<int>	        r_dcache_miss_type;		    // depending on the requester
+    sc_signal<size_t>       r_dcache_miss_word;		    // word index for cache update
+    sc_signal<size_t>       r_dcache_miss_way;		    // selected way for cache update
+    sc_signal<size_t>       r_dcache_miss_set;		    // selected set for cache update
+    sc_signal<bool>         r_dcache_miss_inval;        // coherence request matching a miss
+    sc_signal<bool>         r_dcache_miss_clack;        // waiting for a cleanup acknowledge
+
+    // handling coherence requests
+    sc_signal<size_t>       r_dcache_cc_way;		    // selected way for cc update/inval
+    sc_signal<size_t>       r_dcache_cc_set;		    // selected set for cc update/inval
+    sc_signal<size_t>       r_dcache_cc_word;		    // word counter for cc update
+
+    // dcache flush handling
+    sc_signal<size_t>       r_dcache_flush_count;	    // slot counter used for cache flush
+
+    // ll response handling
+    sc_signal<size_t>       r_dcache_ll_rsp_count;	    // flit counter used for ll rsp
+
+    // used by the TLB miss sub-fsm
+    sc_signal<uint32_t>     r_dcache_tlb_vaddr;		    // virtual address for a tlb miss
+    sc_signal<bool>         r_dcache_tlb_ins;		    // target tlb (itlb if true)
+    sc_signal<paddr_t>      r_dcache_tlb_paddr;		    // physical address of pte
+    sc_signal<uint32_t>     r_dcache_tlb_pte_flags;	    // pte1 or first word of pte2
+    sc_signal<uint32_t>     r_dcache_tlb_pte_ppn;	    // second word of pte2
+    sc_signal<size_t>       r_dcache_tlb_cache_way;	    // selected way in dcache 
+    sc_signal<size_t>       r_dcache_tlb_cache_set;	    // selected set in dcache 
+    sc_signal<size_t>       r_dcache_tlb_cache_word;	// selected word in dcache
+    sc_signal<size_t>       r_dcache_tlb_way;		    // selected way in tlb    
+    sc_signal<size_t>       r_dcache_tlb_set;		    // selected set in tlb    
+
+    // ITLB and DTLB invalidation
+    sc_signal<paddr_t>      r_dcache_tlb_inval_line;	// line index 
+    sc_signal<size_t>       r_dcache_tlb_inval_set;     // tlb set counter
+
+    // communication between DCACHE FSM and ICACHE FSM
+    sc_signal<bool>         r_dcache_xtn_req;           // xtn request (caused by processor)
+    sc_signal<int>          r_dcache_xtn_opcode;        // xtn request type
+
+    // communication between DCACHE FSM and CLEANUP FSMs
+    sc_signal<bool>         r_dcache_cleanup_req;       // DCACHE cleanup request
+    sc_signal<paddr_t>      r_dcache_cleanup_line;      // DCACHE cleanup nline
+    sc_signal<size_t>       r_dcache_cleanup_way;       // DCACHE cleanup way 
+
+    // dcache directory extension
+    bool                    *r_dcache_in_tlb;           // copy exist in dtlb or itlb
+    bool                    *r_dcache_contains_ptd;     // cache line contains a PTD
+
+    ///////////////////////////////////
+    // VCI_CMD FSM REGISTERS
+    ///////////////////////////////////
+    sc_signal<int>          r_vci_cmd_fsm;
+    sc_signal<size_t>       r_vci_cmd_min;      	    // used for write bursts 
+    sc_signal<size_t>       r_vci_cmd_max;      	    // used for write bursts 
+    sc_signal<size_t>       r_vci_cmd_cpt;    		    // used for write bursts 
+    sc_signal<bool>         r_vci_cmd_imiss_prio;	    // round-robin between imiss & dmiss
+
+    ///////////////////////////////////
+    // VCI_RSP FSM REGISTERS
+    ///////////////////////////////////
+    sc_signal<int>          r_vci_rsp_fsm;
+    sc_signal<size_t>       r_vci_rsp_cpt;
+    sc_signal<bool>         r_vci_rsp_ins_error;
+    sc_signal<bool>         r_vci_rsp_data_error;
+    GenericFifo<uint32_t>   r_vci_rsp_fifo_icache;	    // response FIFO to ICACHE FSM
+    GenericFifo<uint32_t>   r_vci_rsp_fifo_dcache;	    // response FIFO to DCACHE FSM
+
+    ///////////////////////////////////
+    //  CLEANUP_CMD FSM REGISTER
+    ///////////////////////////////////
+    sc_signal<int>          r_cleanup_cmd_fsm;          // state register
+    sc_signal<size_t>       r_cleanup_cmd_trdid;        // contains way & data/ins flag
+
+    ///////////////////////////////////
+    //  CLEANUP_RSP FSM REGISTER
+    ///////////////////////////////////
+    sc_signal<int>          r_cleanup_rsp_fsm;          // state register
+    sc_signal<bool>         r_cleanup_icache_req;       // cleanup_rsp to icache request  
+    sc_signal<size_t>       r_cleanup_icache_way;       // cleanup_rsp to icache way      
+    sc_signal<size_t>       r_cleanup_icache_set;       // cleanup_rsp to icache set
+    sc_signal<bool>         r_cleanup_dcache_req;       // cleanup_rsp to dcache request  
+    sc_signal<size_t>       r_cleanup_dcache_way;       // cleanup_rsp to dcache way      
+    sc_signal<size_t>       r_cleanup_dcache_set;       // cleanup_rsp to dcache set
+
+    ///////////////////////////////////
+    //  TGT FSM REGISTERS
+    ///////////////////////////////////
+    sc_signal<int>          r_tgt_fsm;			        // state register
+    sc_signal<paddr_t>      r_tgt_paddr;		        // cache line physical address
+    sc_signal<size_t>       r_tgt_word_count;		    // word index
+    sc_signal<size_t>       r_tgt_word_min;		        // index of the first word 
+    sc_signal<size_t>       r_tgt_word_max;		        // index of the last word 
+    sc_signal<int>          r_tgt_cc_type;	            // type of coherence request
+    sc_signal<vci_srcid_t>  r_tgt_srcid;
+    sc_signal<vci_pktid_t>  r_tgt_pktid;
+    sc_signal<vci_trdid_t>  r_tgt_trdid;
+    uint32_t                *r_tgt_buf;			        // cache line word buffer 
+    vci_be_t                *r_tgt_be;			        // cache line be buffer 
+
+    // communications between TGT FSM and DCACHE/ICACHE FSMs
+    sc_signal<bool>         r_tgt_icache_req;		    // coherence request (set by tgt)
+    sc_signal<bool>         r_tgt_dcache_req;		    // coherence request (set by tgt)
+    sc_signal<bool>         r_icache_tgt_need_rsp;      // response required (set by icache)
+    sc_signal<bool>         r_dcache_tgt_need_rsp;      // response required (set by dcache)
+
+    //////////////////////////////////////////////////////////////////
+    // processor, write buffer, caches , TLBs and CAM for cleanups 
+    //////////////////////////////////////////////////////////////////
+
+    iss_t                       r_iss;   
+    MultiWriteBuffer<paddr_t>	r_wbuf;
+    GenericCache<paddr_t>   	r_icache;
+    GenericCache<paddr_t>    	r_dcache;
+    GenericTlb<paddr_t>       	r_itlb;
+    GenericTlb<paddr_t>     	r_dtlb;
+
+    //////////////////////////////////////////////////////////////////
+    // llsc registration buffer
+    //////////////////////////////////////////////////////////////////
+
+    sc_signal<paddr_t>                     r_dcache_llsc_paddr;
+    sc_signal<uint32_t>                    r_dcache_llsc_key;
+    sc_signal<uint32_t>                    r_dcache_llsc_count;
+    sc_signal<bool>                        r_dcache_llsc_valid;
+
+    ////////////////////////////////
+    // Activity counters
+    ////////////////////////////////
+    uint32_t m_cpt_dcache_data_read;        // DCACHE DATA READ
+    uint32_t m_cpt_dcache_data_write;       // DCACHE DATA WRITE
+    uint32_t m_cpt_dcache_dir_read;         // DCACHE DIR READ
+    uint32_t m_cpt_dcache_dir_write;        // DCACHE DIR WRITE
+
+    uint32_t m_cpt_icache_data_read;        // ICACHE DATA READ
+    uint32_t m_cpt_icache_data_write;       // ICACHE DATA WRITE
+    uint32_t m_cpt_icache_dir_read;         // ICACHE DIR READ
+    uint32_t m_cpt_icache_dir_write;        // ICACHE DIR WRITE
+
+    uint32_t m_cpt_frz_cycles;	            // number of cycles where the cpu is frozen
+    uint32_t m_cpt_total_cycles;	        // total number of cycles
+
+    // Cache activity counters
+    uint32_t m_cpt_data_read;               // total number of read data
+    uint32_t m_cpt_data_write;              // total number of write data
+    uint32_t m_cpt_data_miss;               // number of read miss
+    uint32_t m_cpt_ins_miss;                // number of instruction miss
+    uint32_t m_cpt_unc_read;                // number of read uncached
+    uint32_t m_cpt_write_cached;            // number of cached write
+    uint32_t m_cpt_ins_read;                // number of instruction read
+    uint32_t m_cpt_ins_spc_miss;            // number of speculative instruction miss
+
+    uint32_t m_cost_write_frz;              // number of frozen cycles related to write buffer         
+    uint32_t m_cost_data_miss_frz;          // number of frozen cycles related to data miss
+    uint32_t m_cost_unc_read_frz;           // number of frozen cycles related to uncached read
+    uint32_t m_cost_ins_miss_frz;           // number of frozen cycles related to ins miss
+
+    uint32_t m_cpt_imiss_transaction;       // number of VCI instruction miss transactions
+    uint32_t m_cpt_dmiss_transaction;       // number of VCI data miss transactions
+    uint32_t m_cpt_unc_transaction;         // number of VCI uncached read transactions
+    uint32_t m_cpt_write_transaction;       // number of VCI write transactions
+    uint32_t m_cpt_icache_unc_transaction;
+
+    uint32_t m_cost_imiss_transaction;      // cumulated duration for VCI IMISS transactions
+    uint32_t m_cost_dmiss_transaction;      // cumulated duration for VCI DMISS transactions
+    uint32_t m_cost_unc_transaction;        // cumulated duration for VCI UNC transactions
+    uint32_t m_cost_write_transaction;      // cumulated duration for VCI WRITE transactions
+    uint32_t m_cost_icache_unc_transaction; // cumulated duration for VCI IUNC transactions    
+    uint32_t m_length_write_transaction;    // cumulated length for VCI WRITE transactions
+
+    // TLB activity counters
+    uint32_t m_cpt_ins_tlb_read;            // number of instruction tlb read
+    uint32_t m_cpt_ins_tlb_miss;            // number of instruction tlb miss
+    uint32_t m_cpt_ins_tlb_update_acc;      // number of instruction tlb update 
+    uint32_t m_cpt_ins_tlb_occup_cache;     // number of instruction tlb occupy data cache line 
+    uint32_t m_cpt_ins_tlb_hit_dcache;      // number of instruction tlb hit in data cache
+
+    uint32_t m_cpt_data_tlb_read;           // number of data tlb read
+    uint32_t m_cpt_data_tlb_miss;           // number of data tlb miss
+    uint32_t m_cpt_data_tlb_update_acc;     // number of data tlb update 
+    uint32_t m_cpt_data_tlb_update_dirty;   // number of data tlb update dirty
+    uint32_t m_cpt_data_tlb_hit_dcache;     // number of data tlb hit in data cache
+    uint32_t m_cpt_data_tlb_occup_cache;    // number of data tlb occupy data cache line
+    uint32_t m_cpt_tlb_occup_dcache;
+    
+    uint32_t m_cost_ins_tlb_miss_frz;       // number of frozen cycles related to instruction tlb miss
+    uint32_t m_cost_data_tlb_miss_frz;      // number of frozen cycles related to data tlb miss
+    uint32_t m_cost_ins_tlb_update_acc_frz;    // number of frozen cycles related to instruction tlb update acc
+    uint32_t m_cost_data_tlb_update_acc_frz;   // number of frozen cycles related to data tlb update acc
+    uint32_t m_cost_data_tlb_update_dirty_frz; // number of frozen cycles related to data tlb update dirty
+    uint32_t m_cost_ins_tlb_occup_cache_frz;   // number of frozen cycles related to instruction tlb miss operate in dcache
+    uint32_t m_cost_data_tlb_occup_cache_frz;  // number of frozen cycles related to data tlb miss operate in dcache
+
+    uint32_t m_cpt_itlbmiss_transaction;       // number of itlb miss transactions
+    uint32_t m_cpt_itlb_ll_transaction;        // number of itlb ll acc transactions
+    uint32_t m_cpt_itlb_sc_transaction;        // number of itlb sc acc transactions
+    uint32_t m_cpt_dtlbmiss_transaction;       // number of dtlb miss transactions
+    uint32_t m_cpt_dtlb_ll_transaction;        // number of dtlb ll acc transactions
+    uint32_t m_cpt_dtlb_sc_transaction;        // number of dtlb sc acc transactions
+    uint32_t m_cpt_dtlb_ll_dirty_transaction;  // number of dtlb ll dirty transactions
+    uint32_t m_cpt_dtlb_sc_dirty_transaction;  // number of dtlb sc dirty transactions
+
+    uint32_t m_cost_itlbmiss_transaction;       // cumulated duration for VCI instruction TLB miss transactions
+    uint32_t m_cost_itlb_ll_transaction;        // cumulated duration for VCI instruction TLB ll acc transactions
+    uint32_t m_cost_itlb_sc_transaction;        // cumulated duration for VCI instruction TLB sc acc transactions
+    uint32_t m_cost_dtlbmiss_transaction;       // cumulated duration for VCI data TLB miss transactions
+    uint32_t m_cost_dtlb_ll_transaction;        // cumulated duration for VCI data TLB ll acc transactions
+    uint32_t m_cost_dtlb_sc_transaction;        // cumulated duration for VCI data TLB sc acc transactions
+    uint32_t m_cost_dtlb_ll_dirty_transaction;  // cumulated duration for VCI data TLB ll dirty transactions
+    uint32_t m_cost_dtlb_sc_dirty_transaction;  // cumulated duration for VCI data TLB sc dirty transactions
+
+    // coherence activity counters
+    uint32_t m_cpt_cc_update_icache;            // number of coherence update instruction commands
+    uint32_t m_cpt_cc_update_dcache;            // number of coherence update data commands
+    uint32_t m_cpt_cc_inval_icache;             // number of coherence inval instruction commands
+    uint32_t m_cpt_cc_inval_dcache;             // number of coherence inval data commands
+    uint32_t m_cpt_cc_broadcast;                // number of coherence broadcast commands
+    
+    uint32_t m_cost_updt_data_frz;              // number of frozen cycles related to coherence update data packets
+    uint32_t m_cost_inval_ins_frz;              // number of frozen cycles related to coherence inval instruction packets
+    uint32_t m_cost_inval_data_frz;             // number of frozen cycles related to coherence inval data packets
+    uint32_t m_cost_broadcast_frz;              // number of frozen cycles related to coherence broadcast packets
+
+    uint32_t m_cpt_cc_cleanup_ins;              // number of coherence cleanup packets
+    uint32_t m_cpt_cc_cleanup_data;             // number of coherence cleanup packets
+
+    uint32_t m_cpt_icleanup_transaction;        // number of instruction cleanup transactions
+    uint32_t m_cpt_dcleanup_transaction;        // number of instructinumber of data cleanup transactions
+    uint32_t m_cost_icleanup_transaction;       // cumulated duration for VCI instruction cleanup transactions
+    uint32_t m_cost_dcleanup_transaction;       // cumulated duration for VCI data cleanup transactions
+
+    uint32_t m_cost_ins_tlb_inval_frz;      // number of frozen cycles related to checking ins tlb invalidate
+    uint32_t m_cpt_ins_tlb_inval;           // number of ins tlb invalidate
+
+    uint32_t m_cost_data_tlb_inval_frz;     // number of frozen cycles related to checking data tlb invalidate    
+    uint32_t m_cpt_data_tlb_inval;          // number of data tlb invalidate
+
+    // FSM activity counters
+    uint32_t m_cpt_fsm_icache     [64];
+    uint32_t m_cpt_fsm_dcache     [64];
+    uint32_t m_cpt_fsm_cmd        [64];
+    uint32_t m_cpt_fsm_rsp        [64];
+    uint32_t m_cpt_fsm_tgt        [64];
+    uint32_t m_cpt_fsm_cmd_cleanup[64];
+    uint32_t m_cpt_fsm_rsp_cleanup[64];
+
+    uint32_t m_cpt_stop_simulation;		// used to stop simulation if frozen
+
+protected:
+    SC_HAS_PROCESS(VciCcVCacheWrapper);
+
+public:
+    VciCcVCacheWrapper(
+        sc_module_name insname,
+        int proc_id,
+        const soclib::common::MappingTable &mtp,
+        const soclib::common::MappingTable &mtc,
+        const soclib::common::IntTab &initiator_index_d,
+        const soclib::common::IntTab &initiator_index_c,
+        const soclib::common::IntTab &target_index_d,
+        size_t   itlb_ways,
+        size_t   itlb_sets,
+        size_t   dtlb_ways,
+        size_t   dtlb_sets,
+        size_t   icache_ways,
+        size_t   icache_sets,
+        size_t   icache_words,
+        size_t   dcache_ways,
+        size_t   dcache_sets,
+        size_t   dcache_words,
+        size_t   wbuf_nlines, 
+        size_t   wbuf_nwords, 
+        size_t   x_width,
+        size_t   y_width,
+        uint32_t memory_cache_local_id,
+        uint32_t max_frozen_cycles,
+        uint32_t debug_start_cycle,
+        bool     debug_ok);
+
+    ~VciCcVCacheWrapper();
+
+    void print_cpi();
+    void print_stats();
+    void clear_stats();
+    void print_trace(size_t mode = 0);
+    void cache_monitor(paddr_t addr);
+    inline void iss_set_debug_mask(uint v) {
+	r_iss.set_debug_mask(v);
+    }
+
+private:
+    void transition();
+    void genMoore();
+
+    soclib_static_assert((int)iss_t::SC_ATOMIC == (int)vci_param::STORE_COND_ATOMIC);
+    soclib_static_assert((int)iss_t::SC_NOT_ATOMIC == (int)vci_param::STORE_COND_NOT_ATOMIC);
+};
+
+}}
+
+#endif /* SOCLIB_CABA_VCI_CC_VCACHE_WRAPPER_H */
+
+// Local Variables:
+// tab-width: 4
+// c-basic-offset: 4
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=4:tabstop=4:softtabstop=4
+
+
+
+
Index: /branches/v5/modules/vci_cc_vcache_wrapper/caba/source/src/vci_cc_vcache_wrapper.cpp
===================================================================
--- /branches/v5/modules/vci_cc_vcache_wrapper/caba/source/src/vci_cc_vcache_wrapper.cpp	(revision 300)
+++ /branches/v5/modules/vci_cc_vcache_wrapper/caba/source/src/vci_cc_vcache_wrapper.cpp	(revision 300)
@@ -0,0 +1,5820 @@
+/* -*- c++ -*-
+ * File : vci_cc_vcache_wrapper.cpp
+ * Copyright (c) UPMC, Lip6, SoC
+ * Authors : Alain GREINER, Yang GAO
+ *
+ * SOCLIB_LGPL_HEADER_BEGIN
+ * 
+ * This file is part of SoCLib, GNU LGPLv2.1.
+ * 
+ * SoCLib 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; version 2.1 of the License.
+ * 
+ * SoCLib 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 SoCLib; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301 USA
+ * 
+ * SOCLIB_LGPL_HEADER_END
+ */
+
+#include <cassert>
+#include "arithmetics.h"
+#include "../include/vci_cc_vcache_wrapper.h"
+
+#define DEBUG_DCACHE		1
+#define DEBUG_ICACHE		1
+#define DEBUG_CLEANUP		0
+
+namespace soclib { 
+namespace caba {
+
+namespace {
+const char *icache_fsm_state_str[] = {
+        "ICACHE_IDLE",
+     
+        "ICACHE_XTN_TLB_FLUSH", 
+        "ICACHE_XTN_CACHE_FLUSH", 
+        "ICACHE_XTN_CACHE_FLUSH_GO", 
+        "ICACHE_XTN_TLB_INVAL",  
+        "ICACHE_XTN_CACHE_INVAL_VA",
+        "ICACHE_XTN_CACHE_INVAL_PA",
+        "ICACHE_XTN_CACHE_INVAL_GO",
+
+        "ICACHE_TLB_WAIT",
+
+        "ICACHE_MISS_SELECT",
+        "ICACHE_MISS_CLEAN",
+        "ICACHE_MISS_WAIT",
+        "ICACHE_MISS_DATA_UPDT",
+        "ICACHE_MISS_DIR_UPDT",
+
+        "ICACHE_UNC_WAIT",  
+
+        "ICACHE_CC_CLACK", 
+        "ICACHE_CC_CHECK", 
+        "ICACHE_CC_INVAL", 
+        "ICACHE_CC_UPDT", 
+        "ICACHE_CC_BROADCAST",
+    };
+
+const char *dcache_fsm_state_str[] = {
+        "DCACHE_IDLE",       
+
+        "DCACHE_TLB_MISS",
+        "DCACHE_TLB_PTE1_GET",
+        "DCACHE_TLB_PTE1_SELECT",  
+        "DCACHE_TLB_PTE1_UPDT", 
+        "DCACHE_TLB_PTE2_GET", 
+        "DCACHE_TLB_PTE2_SELECT",
+        "DCACHE_TLB_PTE2_UPDT",   
+        "DCACHE_TLB_LR_UPDT",
+        "DCACHE_TLB_LR_WAIT",
+        "DCACHE_TLB_RETURN",
+
+        "DCACHE_XTN_SWITCH", 
+        "DCACHE_XTN_SYNC", 
+        "DCACHE_XTN_IC_INVAL_VA",
+        "DCACHE_XTN_IC_FLUSH", 
+        "DCACHE_XTN_IC_INVAL_PA",
+        "DCACHE_XTN_IT_INVAL",
+        "DCACHE_XTN_DC_FLUSH", 
+        "DCACHE_XTN_DC_FLUSH_GO", 
+        "DCACHE_XTN_DC_INVAL_VA",
+        "DCACHE_XTN_DC_INVAL_PA",
+        "DCACHE_XTN_DC_INVAL_END",
+        "DCACHE_XTN_DC_INVAL_GO",
+        "DCACHE_XTN_DT_INVAL",
+
+        "DCACHE_DIRTY_PTE_GET",
+        "DCACHE_DIRTY_WAIT",  
+
+        "DCACHE_MISS_SELECT",
+        "DCACHE_MISS_CLEAN",
+        "DCACHE_MISS_WAIT",  
+        "DCACHE_MISS_DATA_UPDT",  
+        "DCACHE_MISS_DIR_UPDT",  
+
+        "DCACHE_UNC_WAIT",   
+        "DCACHE_LL_WAIT",   
+        "DCACHE_SC_WAIT",   
+
+        "DCACHE_CC_CLACK",
+        "DCACHE_CC_CHECK",
+        "DCACHE_CC_INVAL",
+        "DCACHE_CC_UPDT",
+        "DCACHE_CC_BROADCAST",
+
+        "DCACHE_INVAL_TLB_SCAN",
+    };
+
+const char *cmd_fsm_state_str[] = {
+        "CMD_IDLE",           
+        "CMD_INS_MISS",     
+        "CMD_INS_UNC",     
+        "CMD_DATA_MISS",    
+        "CMD_DATA_UNC",     
+        "CMD_DATA_WRITE", 
+        "CMD_DATA_LL",
+        "CMD_DATA_SC",
+        "CMD_DATA_CAS", 
+    };
+
+const char *rsp_fsm_state_str[] = {
+        "RSP_IDLE",                  
+        "RSP_INS_MISS",   
+        "RSP_INS_UNC",           
+        "RSP_DATA_MISS",             
+        "RSP_DATA_UNC",              
+        "RSP_DATA_LL",
+        "RSP_DATA_WRITE",     
+    };
+
+const char *cleanup_fsm_state_str[] = {
+        "CLEANUP_DATA_IDLE",           
+        "CLEANUP_DATA_GO",    
+        "CLEANUP_INS_IDLE",      
+        "CLEANUP_INS_GO",      
+    };
+
+const char *tgt_fsm_state_str[] = {
+        "TGT_IDLE",
+        "TGT_UPDT_WORD",
+        "TGT_UPDT_DATA",
+        "TGT_REQ_BROADCAST",
+        "TGT_REQ_ICACHE",
+        "TGT_REQ_DCACHE",
+        "TGT_RSP_BROADCAST",
+        "TGT_RSP_ICACHE",
+        "TGT_RSP_DCACHE",
+    };	
+}
+
+#define tmpl(...)  template<typename vci_param, typename iss_t> __VA_ARGS__ VciCcVCacheWrapper<vci_param, iss_t>
+
+using soclib::common::uint32_log2;
+
+/////////////////////////////////
+tmpl(/**/)::VciCcVCacheWrapper(
+    sc_module_name 			name,
+    int 				proc_id,
+    const soclib::common::MappingTable 	&mtd,
+    const soclib::common::MappingTable 	&mtc,
+    const soclib::common::IntTab 	&initiator_index_d,
+    const soclib::common::IntTab 	&initiator_index_c,
+    const soclib::common::IntTab 	&target_index_c,
+    size_t 				itlb_ways,
+    size_t 				itlb_sets,
+    size_t 				dtlb_ways,
+    size_t 				dtlb_sets,
+    size_t 				icache_ways,
+    size_t 				icache_sets,
+    size_t 				icache_words,
+    size_t 				dcache_ways,
+    size_t 				dcache_sets,
+    size_t 				dcache_words,
+    size_t 				wbuf_nlines, 
+    size_t 				wbuf_nwords, 
+    size_t				x_width,
+    size_t				y_width,
+    uint32_t			memory_cache_local_id,
+    uint32_t			max_frozen_cycles,
+    uint32_t			debug_start_cycle,
+    bool				debug_ok)
+    : soclib::caba::BaseModule(name),
+
+      p_clk("clk"),
+      p_resetn("resetn"),
+      p_vci_ini_d("vci_ini_d"),
+      p_vci_ini_c("vci_ini_c"),
+      p_vci_tgt_c("vci_tgt_d"),
+
+      m_cacheability_table(mtd.getCacheabilityTable()),
+      m_segment(mtc.getSegment(target_index_c)),
+      m_srcid_d(mtd.indexForId(initiator_index_d)),
+      m_srcid_c(mtc.indexForId(initiator_index_c)),
+
+      m_itlb_ways(itlb_ways),
+      m_itlb_sets(itlb_sets),
+
+      m_dtlb_ways(dtlb_ways),
+      m_dtlb_sets(dtlb_sets),
+
+      m_icache_ways(icache_ways),
+      m_icache_sets(icache_sets),
+      m_icache_yzmask((~0)<<(uint32_log2(icache_words) + 2)),
+      m_icache_words(icache_words),
+
+      m_dcache_ways(dcache_ways),
+      m_dcache_sets(dcache_sets),
+      m_dcache_yzmask((~0)<<(uint32_log2(dcache_words) + 2)),
+      m_dcache_words(dcache_words),
+
+      m_x_width(x_width),
+      m_y_width(y_width),
+
+      m_memory_cache_local_id(memory_cache_local_id),      
+      m_proc_id(proc_id),
+      m_max_frozen_cycles(max_frozen_cycles),
+      m_paddr_nbits(vci_param::N),
+
+      m_debug_start_cycle(debug_start_cycle),
+      m_debug_ok(debug_ok),
+
+      r_mmu_ptpr("r_mmu_ptpr"),
+      r_mmu_mode("r_mmu_mode"),
+      r_mmu_word_lo("r_mmu_word_lo"),
+      r_mmu_word_hi("r_mmu_word_hi"),
+      r_mmu_ibvar("r_mmu_ibvar"),
+      r_mmu_dbvar("r_mmu_dbvar"),
+      r_mmu_ietr("r_mmu_ietr"),
+      r_mmu_detr("r_mmu_detr"),
+
+      r_icache_fsm("r_icache_fsm"),
+      r_icache_fsm_save("r_icache_fsm_save"),
+      r_icache_vci_paddr("r_icache_vci_paddr"),
+      r_icache_vaddr_save("r_icache_vaddr_save"),
+
+      r_icache_miss_way("r_icache_miss_way"),
+      r_icache_miss_set("r_icache_miss_set"),
+      r_icache_miss_word("r_icache_miss_word"),
+      r_icache_miss_inval("r_icache_miss_inval"),
+      r_icache_miss_clack("r_icache_miss_clack"),
+
+      r_icache_cc_way("r_icache_cc_way"),
+      r_icache_cc_set("r_icache_cc_set"),
+      r_icache_cc_word("r_icache_cc_word"),
+
+      r_icache_flush_count("r_icache_flush_count"),
+
+      r_icache_miss_req("r_icache_miss_req"),
+      r_icache_unc_req("r_icache_unc_req"),
+
+      r_icache_tlb_miss_req("r_icache_tlb_read_req"),
+      r_icache_tlb_rsp_error("r_icache_tlb_rsp_error"),
+
+      r_icache_cleanup_req("r_icache_cleanup_req"),
+      r_icache_cleanup_line("r_icache_cleanup_line"),
+
+      r_dcache_fsm("r_dcache_fsm"),
+      r_dcache_fsm_cc_save("r_dcache_fsm_cc_save"),
+      r_dcache_fsm_scan_save("r_dcache_fsm_scan_save"),
+
+      r_dcache_wbuf_req("r_dcache_wbuf_req"),
+      r_dcache_updt_req("r_dcache_updt_req"),
+      r_dcache_save_vaddr("r_dcache_save_vaddr"),
+      r_dcache_save_wdata("r_dcache_save_wdata"),
+      r_dcache_save_be("r_dcache_save_be"),
+      r_dcache_save_paddr("r_dcache_save_paddr"),
+      r_dcache_save_cacheable("r_dcache_save_cacheable"), 
+      r_dcache_save_cache_way("r_dcache_save_cache_way"), 
+      r_dcache_save_cache_set("r_dcache_save_cache_set"), 
+      r_dcache_save_cache_word("r_dcache_save_cache_word"), 
+
+      r_dcache_dirty_paddr("r_dcache_dirty_paddr"),
+      r_dcache_dirty_way("r_dcache_dirty_way"),
+      r_dcache_dirty_set("r_dcache_dirty_set"),
+
+      r_dcache_vci_paddr("r_dcache_vci_paddr"),
+      r_dcache_vci_miss_req("r_dcache_vci_miss_req"),
+      r_dcache_vci_unc_req("r_dcache_vci_unc_req"),
+      r_dcache_vci_unc_be("r_dcache_vci_unc_be"),
+      r_dcache_vci_cas_req("r_dcache_vci_cas_req"),
+      r_dcache_vci_cas_old("r_dcache_vci_cas_old"),
+      r_dcache_vci_cas_new("r_dcache_vci_cas_new"),
+      r_dcache_vci_ll_req("r_dcache_vci_ll_req"),
+      r_dcache_vci_sc_req("r_dcache_vci_sc_req"),
+      r_dcache_vci_sc_data("r_dcache_vci_sc_data"),
+
+      r_dcache_xtn_way("r_dcache_xtn_way"),
+      r_dcache_xtn_set("r_dcache_xtn_set"),
+
+      r_dcache_pending_unc_write("r_dcache_pending_unc_write"),
+
+      r_dcache_miss_type("r_dcache_miss_type"),
+      r_dcache_miss_word("r_dcache_miss_word"),
+      r_dcache_miss_way("r_dcache_miss_way"),
+      r_dcache_miss_set("r_dcache_miss_set"),
+      r_dcache_miss_inval("r_dcache_miss_inval"),
+
+      r_dcache_cc_way("r_dcache_cc_way"),
+      r_dcache_cc_set("r_dcache_cc_set"),
+      r_dcache_cc_word("r_dcache_cc_word"),
+
+      r_dcache_flush_count("r_dcache_flush_count"),
+
+      r_dcache_ll_rsp_count("r_dcache_ll_rsp_count"),
+
+      r_dcache_tlb_vaddr("r_dcache_tlb_vaddr"),
+      r_dcache_tlb_ins("r_dcache_tlb_ins"),
+      r_dcache_tlb_pte_flags("r_dcache_tlb_pte_flags"),
+      r_dcache_tlb_pte_ppn("r_dcache_tlb_pte_ppn"),
+      r_dcache_tlb_cache_way("r_dcache_tlb_cache_way"),
+      r_dcache_tlb_cache_set("r_dcache_tlb_cache_set"),
+      r_dcache_tlb_cache_word("r_dcache_tlb_cache_word"),
+      r_dcache_tlb_way("r_dcache_tlb_way"),
+      r_dcache_tlb_set("r_dcache_tlb_set"),
+
+      r_dcache_tlb_inval_line("r_dcache_tlb_inval_line"),
+      r_dcache_tlb_inval_set("r_dcache_tlb_inval_set"),
+
+      r_dcache_xtn_req("r_dcache_xtn_req"),
+      r_dcache_xtn_opcode("r_dcache_xtn_opcode"),
+
+      r_dcache_cleanup_req("r_dcache_cleanup_req"),
+      r_dcache_cleanup_line("r_dcache_cleanup_line"),
+
+      r_vci_cmd_fsm("r_vci_cmd_fsm"),
+      r_vci_cmd_min("r_vci_cmd_min"),
+      r_vci_cmd_max("r_vci_cmd_max"),
+      r_vci_cmd_cpt("r_vci_cmd_cpt"),
+      r_vci_cmd_imiss_prio("r_vci_cmd_imiss_prio"),
+
+      r_vci_rsp_fsm("r_vci_rsp_fsm"),
+      r_vci_rsp_cpt("r_vci_rsp_cpt"),
+      r_vci_rsp_ins_error("r_vci_rsp_ins_error"),
+      r_vci_rsp_data_error("r_vci_rsp_data_error"),
+      r_vci_rsp_fifo_icache("r_vci_rsp_fifo_icache", 2),	// 2 words depth
+      r_vci_rsp_fifo_dcache("r_vci_rsp_fifo_dcache", 2),	// 2 words depth
+
+      r_cleanup_cmd_fsm("r_cleanup_cmd_fsm"),
+      r_cleanup_cmd_trdid("r_cleanup_cmd_trdid"),
+
+      r_cleanup_rsp_fsm("r_cleanup_rsp_fsm"),
+      r_cleanup_icache_req("r_cleanup_icache_req"),
+      r_cleanup_icache_way("r_cleanup_icache_way"),
+      r_cleanup_icache_set("r_cleanup_icache_set"),
+      r_cleanup_dcache_req("r_cleanup_dcache_req"),
+      r_cleanup_dcache_way("r_cleanup_dcache_way"),
+      r_cleanup_dcache_set("r_cleanup_dcache_set"),
+
+      r_tgt_fsm("r_tgt_fsm"),
+      r_tgt_paddr("r_tgt_paddr"),
+      r_tgt_word_count("r_tgt_word_count"),
+      r_tgt_word_min("r_tgt_word_min"),
+      r_tgt_word_max("r_tgt_word_max"),
+      r_tgt_cc_type("r_tgt_cc_type"),
+      r_tgt_srcid("r_tgt_srcid"),
+      r_tgt_pktid("r_tgt_pktid"),
+      r_tgt_trdid("r_tgt_trdid"),
+
+      r_tgt_icache_req("r_tgt_icache_req"),
+      r_tgt_dcache_req("r_tgt_dcache_req"),
+      r_icache_tgt_need_rsp("r_icache_tgt_need_rsp"),
+      r_dcache_tgt_need_rsp("r_dcache_tgt_need_rsp"),
+
+      r_iss(this->name(), proc_id),
+      r_wbuf("wbuf", wbuf_nwords, wbuf_nlines, dcache_words ),
+      r_icache("icache", icache_ways, icache_sets, icache_words),
+      r_dcache("dcache", dcache_ways, dcache_sets, dcache_words),
+      r_itlb("itlb", proc_id, itlb_ways,itlb_sets,vci_param::N),
+      r_dtlb("dtlb", proc_id, dtlb_ways,dtlb_sets,vci_param::N)
+{
+    assert( ((icache_words*vci_param::B) < (1<<vci_param::K)) and
+             "Need more PLEN bits.");
+
+    assert( (vci_param::T > 2) and ((1<<(vci_param::T-1)) >= (wbuf_nlines)) and
+             "Need more TRDID bits.");
+
+    assert( (icache_words == dcache_words) and
+             "icache_words and dcache_words parameters must be equal");
+
+    assert( (itlb_sets == dtlb_sets) and
+             "itlb_sets and dtlb_sets parameters must be etqual");
+
+    assert( (itlb_ways == dtlb_ways) and
+             "itlb_ways and dtlb_ways parameters must be etqual");
+
+    r_mmu_params = (uint32_log2(m_dtlb_ways)   << 29)   | (uint32_log2(m_dtlb_sets)   << 25) |
+                   (uint32_log2(m_dcache_ways) << 22)   | (uint32_log2(m_dcache_sets) << 18) |
+                   (uint32_log2(m_itlb_ways)   << 15)   | (uint32_log2(m_itlb_sets)   << 11) |
+                   (uint32_log2(m_icache_ways) << 8)    | (uint32_log2(m_icache_sets) << 4)  |
+                   (uint32_log2(m_icache_words<<2));
+
+    r_mmu_release = (uint32_t)(1 << 16) | 0x1;
+
+    r_tgt_buf             = new uint32_t[dcache_words];
+    r_tgt_be              = new vci_be_t[dcache_words];
+    r_dcache_in_tlb       = new bool[dcache_ways*dcache_sets];          
+    r_dcache_contains_ptd = new bool[dcache_ways*dcache_sets];          
+
+    SC_METHOD(transition);
+    dont_initialize();
+    sensitive << p_clk.pos();
+  
+    SC_METHOD(genMoore);
+    dont_initialize();
+    sensitive << p_clk.neg();
+
+    typename iss_t::CacheInfo cache_info;
+    cache_info.has_mmu = true;
+    cache_info.icache_line_size = icache_words*sizeof(uint32_t);
+    cache_info.icache_assoc = icache_ways;
+    cache_info.icache_n_lines = icache_sets;
+    cache_info.dcache_line_size = dcache_words*sizeof(uint32_t);
+    cache_info.dcache_assoc = dcache_ways;
+    cache_info.dcache_n_lines = dcache_sets;
+    r_iss.setCacheInfo(cache_info);
+}
+
+/////////////////////////////////////
+tmpl(/**/)::~VciCcVCacheWrapper()
+/////////////////////////////////////
+{
+    delete [] r_tgt_be;
+    delete [] r_tgt_buf;
+    delete [] r_dcache_in_tlb;          
+    delete [] r_dcache_contains_ptd;     
+}
+
+////////////////////////
+tmpl(void)::print_cpi()
+////////////////////////
+{
+    std::cout << name() << " CPI = " 
+        << (float)m_cpt_total_cycles/(m_cpt_total_cycles - m_cpt_frz_cycles) << std::endl ;
+}
+
+////////////////////////////////////
+tmpl(void)::print_trace(size_t mode)
+////////////////////////////////////
+{
+    // b0 : write buffer trace
+    // b1 : write buffer verbose
+    // b2 : dcache trace
+    // b3 : icache trace
+    // b4 : dtlb trace
+    // b5 : itlb trace
+
+    std::cout << std::dec << "PROC " << name() << std::endl;
+
+    std::cout << "  " << m_ireq << std::endl;
+    std::cout << "  " << m_irsp << std::endl;
+    std::cout << "  " << m_dreq << std::endl;
+    std::cout << "  " << m_drsp << std::endl;
+
+    std::cout << "  " << icache_fsm_state_str[r_icache_fsm.read()]
+              << " | " << dcache_fsm_state_str[r_dcache_fsm.read()]
+              << " | " << cmd_fsm_state_str[r_vci_cmd_fsm.read()]
+              << " | " << rsp_fsm_state_str[r_vci_rsp_fsm.read()]
+              << " | " << tgt_fsm_state_str[r_tgt_fsm.read()] 
+              << " | " << cleanup_fsm_state_str[r_cleanup_cmd_fsm.read()];
+    if (r_dcache_updt_req.read() ) std::cout << " | P1_UPDT";
+    if (r_dcache_wbuf_req.read() ) std::cout << " | P1_WBUF";
+    std::cout << std::endl;
+
+    if(mode & 0x01)
+    {
+        r_wbuf.printTrace((mode>>1)&1);
+    }
+    if(mode & 0x04)
+    {
+        std::cout << "  Data Cache" << std::endl;
+        r_dcache.printTrace();
+    }
+    if(mode & 0x08)
+    {
+        std::cout << "  Instruction Cache" << std::endl;
+        r_icache.printTrace();
+    }
+    if(mode & 0x10)
+    {
+        std::cout << "  Data TLB" << std::endl;
+        r_dtlb.printTrace();
+    }
+    if(mode & 0x20)
+    {
+        std::cout << "  Instruction TLB" << std::endl;
+        r_itlb.printTrace();
+    }
+}
+
+//////////////////////////////////////////
+tmpl(void)::cache_monitor( paddr_t addr )
+//////////////////////////////////////////
+{ 
+    size_t	cache_way;
+    size_t	cache_set;
+    size_t	cache_word;
+    uint32_t	cache_rdata;
+    bool	cache_hit = r_dcache.read_neutral( addr,
+                                           &cache_rdata,
+                                           &cache_way,
+                                           &cache_set,
+                                           &cache_word );
+    bool	icache_hit = r_icache.read_neutral( addr,
+                                           &cache_rdata,
+                                           &cache_way,
+                                           &cache_set,
+                                           &cache_word );
+    if ( cache_hit != m_debug_previous_hit )
+    {
+        std::cout << "PROC " << name() 
+                  << " dcache change at cycle " << std::dec << m_cpt_total_cycles
+                  << " for adresse " << std::hex << addr
+                  << " / HIT = " << std::dec << cache_hit << std::endl;
+	m_debug_previous_hit = cache_hit;
+    }
+    if ( icache_hit != m_idebug_previous_hit )
+    {
+        std::cout << "PROC " << name() 
+                  << " icache change at cycle " << std::dec << m_cpt_total_cycles
+                  << " for adresse " << std::hex << addr
+                  << " / HIT = " << icache_hit << std::endl;
+	m_idebug_previous_hit = icache_hit;
+    }
+}
+
+/*
+////////////////////////
+tmpl(void)::print_stats()
+////////////////////////
+{
+    float run_cycles = (float)(m_cpt_total_cycles - m_cpt_frz_cycles);
+    std::cout << name() << std::endl
+        << "- CPI                    = " << (float)m_cpt_total_cycles/run_cycles << std::endl 
+        << "- READ RATE              = " << (float)m_cpt_read/run_cycles << std::endl 
+        << "- WRITE RATE             = " << (float)m_cpt_write/run_cycles << std::endl
+        << "- IMISS_RATE             = " << (float)m_cpt_ins_miss/m_cpt_ins_read << std::endl
+        << "- DMISS RATE             = " << (float)m_cpt_data_miss/(m_cpt_read-m_cpt_unc_read) << std::endl  
+        << "- INS MISS COST          = " << (float)m_cost_ins_miss_frz/m_cpt_ins_miss << std::endl     
+        << "- DATA MISS COST         = " << (float)m_cost_data_miss_frz/m_cpt_data_miss << std::endl 
+        << "- WRITE COST             = " << (float)m_cost_write_frz/m_cpt_write << std::endl        
+        << "- UNC COST               = " << (float)m_cost_unc_read_frz/m_cpt_unc_read << std::endl
+        << "- UNCACHED READ RATE     = " << (float)m_cpt_unc_read/m_cpt_read << std::endl 
+        << "- CACHED WRITE RATE      = " << (float)m_cpt_write_cached/m_cpt_write << std::endl 
+        << "- INS TLB MISS RATE      = " << (float)m_cpt_ins_tlb_miss/m_cpt_ins_tlb_read << std::endl
+        << "- DATA TLB MISS RATE     = " << (float)m_cpt_data_tlb_miss/m_cpt_data_tlb_read << std::endl
+        << "- ITLB MISS COST         = " << (float)m_cost_ins_tlb_miss_frz/m_cpt_ins_tlb_miss << std::endl
+        << "- DTLB MISS COST         = " << (float)m_cost_data_tlb_miss_frz/m_cpt_data_tlb_miss << std::endl   
+        << "- ITLB UPDATE ACC COST   = " << (float)m_cost_ins_tlb_update_acc_frz/m_cpt_ins_tlb_update_acc << std::endl
+        << "- DTLB UPDATE ACC COST   = " << (float)m_cost_data_tlb_update_acc_frz/m_cpt_data_tlb_update_acc << std::endl
+        << "- DTLB UPDATE DIRTY COST = " << (float)m_cost_data_tlb_update_dirty_frz/m_cpt_data_tlb_update_dirty << std::endl
+        << "- ITLB HIT IN DCACHE RATE= " << (float)m_cpt_ins_tlb_hit_dcache/m_cpt_ins_tlb_miss << std::endl
+        << "- DTLB HIT IN DCACHE RATE= " << (float)m_cpt_data_tlb_hit_dcache/m_cpt_data_tlb_miss << std::endl
+        << "- DCACHE FROZEN BY ITLB  = " << (float)m_cost_ins_tlb_occup_cache_frz/m_cpt_dcache_frz_cycles << std::endl
+        << "- DCACHE FOR TLB %       = " << (float)m_cpt_tlb_occup_dcache/(m_dcache_ways*m_dcache_sets) << std::endl
+        << "- NB CC BROADCAST        = " << m_cpt_cc_broadcast << std::endl
+        << "- NB CC UPDATE DATA      = " << m_cpt_cc_update_data << std::endl
+        << "- NB CC INVAL DATA       = " << m_cpt_cc_inval_data << std::endl
+        << "- NB CC INVAL INS        = " << m_cpt_cc_inval_ins << std::endl
+        << "- CC BROADCAST COST      = " << (float)m_cost_broadcast_frz/m_cpt_cc_broadcast << std::endl
+        << "- CC UPDATE DATA COST    = " << (float)m_cost_updt_data_frz/m_cpt_cc_update_data << std::endl
+        << "- CC INVAL DATA COST     = " << (float)m_cost_inval_data_frz/m_cpt_cc_inval_data << std::endl
+        << "- CC INVAL INS COST      = " << (float)m_cost_inval_ins_frz/m_cpt_cc_inval_ins << std::endl
+        << "- NB CC CLEANUP DATA     = " << m_cpt_cc_cleanup_data << std::endl
+        << "- NB CC CLEANUP INS      = " << m_cpt_cc_cleanup_ins << std::endl
+        << "- IMISS TRANSACTION      = " << (float)m_cost_imiss_transaction/m_cpt_imiss_transaction << std::endl
+        << "- DMISS TRANSACTION      = " << (float)m_cost_dmiss_transaction/m_cpt_dmiss_transaction << std::endl
+        << "- UNC TRANSACTION        = " << (float)m_cost_unc_transaction/m_cpt_unc_transaction << std::endl
+        << "- WRITE TRANSACTION      = " << (float)m_cost_write_transaction/m_cpt_write_transaction << std::endl
+        << "- WRITE LENGTH           = " << (float)m_length_write_transaction/m_cpt_write_transaction << std::endl
+        << "- ITLB MISS TRANSACTION  = " << (float)m_cost_itlbmiss_transaction/m_cpt_itlbmiss_transaction << std::endl
+        << "- DTLB MISS TRANSACTION  = " << (float)m_cost_dtlbmiss_transaction/m_cpt_dtlbmiss_transaction << std::endl;
+}
+
+////////////////////////
+tmpl(void)::clear_stats()
+////////////////////////
+{
+    m_cpt_dcache_data_read  = 0;
+    m_cpt_dcache_data_write = 0;
+    m_cpt_dcache_dir_read   = 0;
+    m_cpt_dcache_dir_write  = 0;
+    m_cpt_icache_data_read  = 0;
+    m_cpt_icache_data_write = 0;
+    m_cpt_icache_dir_read   = 0;
+    m_cpt_icache_dir_write  = 0;
+    
+    m_cpt_frz_cycles        = 0;
+    m_cpt_dcache_frz_cycles = 0;
+    m_cpt_total_cycles      = 0;
+    
+    m_cpt_read         = 0;
+    m_cpt_write        = 0;
+    m_cpt_data_miss    = 0;
+    m_cpt_ins_miss     = 0;
+    m_cpt_unc_read     = 0;
+    m_cpt_write_cached = 0;
+    m_cpt_ins_read     = 0;
+    
+    m_cost_write_frz     = 0;
+    m_cost_data_miss_frz = 0;
+    m_cost_unc_read_frz  = 0;
+    m_cost_ins_miss_frz  = 0;
+    
+    m_cpt_imiss_transaction      = 0;
+    m_cpt_dmiss_transaction      = 0;
+    m_cpt_unc_transaction        = 0;
+    m_cpt_write_transaction      = 0;
+    m_cpt_icache_unc_transaction = 0;	
+    
+    m_cost_imiss_transaction      = 0;
+    m_cost_dmiss_transaction      = 0;
+    m_cost_unc_transaction        = 0;
+    m_cost_write_transaction      = 0;
+    m_cost_icache_unc_transaction = 0;
+    m_length_write_transaction    = 0;
+    
+    m_cpt_ins_tlb_read       = 0;             
+    m_cpt_ins_tlb_miss       = 0;             
+    m_cpt_ins_tlb_update_acc = 0;         
+    
+    m_cpt_data_tlb_read         = 0;           
+    m_cpt_data_tlb_miss         = 0;           
+    m_cpt_data_tlb_update_acc   = 0;       
+    m_cpt_data_tlb_update_dirty = 0;    
+    m_cpt_ins_tlb_hit_dcache    = 0;
+    m_cpt_data_tlb_hit_dcache   = 0;
+    m_cpt_ins_tlb_occup_cache   = 0;
+    m_cpt_data_tlb_occup_cache  = 0;
+    
+    m_cost_ins_tlb_miss_frz          = 0;      
+    m_cost_data_tlb_miss_frz         = 0;      
+    m_cost_ins_tlb_update_acc_frz    = 0;
+    m_cost_data_tlb_update_acc_frz   = 0;
+    m_cost_data_tlb_update_dirty_frz = 0;
+    m_cost_ins_tlb_occup_cache_frz   = 0;
+    m_cost_data_tlb_occup_cache_frz  = 0;
+    
+    m_cpt_itlbmiss_transaction      = 0;    
+    m_cpt_itlb_ll_transaction       = 0;  
+    m_cpt_itlb_sc_transaction       = 0;  
+    m_cpt_dtlbmiss_transaction      = 0;  
+    m_cpt_dtlb_ll_transaction       = 0;  
+    m_cpt_dtlb_sc_transaction       = 0;  
+    m_cpt_dtlb_ll_dirty_transaction = 0;  
+    m_cpt_dtlb_sc_dirty_transaction = 0;  
+    
+    m_cost_itlbmiss_transaction      = 0;   
+    m_cost_itlb_ll_transaction       = 0;  
+    m_cost_itlb_sc_transaction       = 0;  
+    m_cost_dtlbmiss_transaction      = 0;   
+    m_cost_dtlb_ll_transaction       = 0;   
+    m_cost_dtlb_sc_transaction       = 0;   
+    m_cost_dtlb_ll_dirty_transaction = 0;   
+    m_cost_dtlb_sc_dirty_transaction = 0;
+
+    m_cpt_cc_update_data = 0;
+    m_cpt_cc_inval_ins   = 0;
+    m_cpt_cc_inval_data  = 0;
+    m_cpt_cc_broadcast   = 0;
+
+    m_cost_updt_data_frz  = 0;
+    m_cost_inval_ins_frz  = 0;
+    m_cost_inval_data_frz = 0;
+    m_cost_broadcast_frz  = 0;
+
+    m_cpt_cc_cleanup_data = 0;
+    m_cpt_cc_cleanup_ins  = 0;
+}
+
+*/
+
+/////////////////////////
+tmpl(void)::transition()
+/////////////////////////
+{
+    #define LLSCLocalTable GenericLLSCLocalTable<8000, 1, paddr_t, vci_trdid_t, vci_data_t>
+    if ( not p_resetn.read() ) 
+    {
+        r_iss.reset();
+        r_wbuf.reset();
+        r_icache.reset();
+        r_dcache.reset();
+        r_itlb.reset();    
+        r_dtlb.reset();    
+
+        r_dcache_fsm      = DCACHE_IDLE;
+        r_icache_fsm      = ICACHE_IDLE;
+        r_vci_cmd_fsm     = CMD_IDLE;
+        r_vci_rsp_fsm     = RSP_IDLE;
+        r_tgt_fsm         = TGT_IDLE;
+        r_cleanup_cmd_fsm = CLEANUP_CMD_DATA_IDLE;
+        r_cleanup_rsp_fsm = CLEANUP_RSP_IDLE;
+
+        // reset dcache directory extension
+        for (size_t i=0 ; i< m_dcache_ways*m_dcache_sets ; i++)
+        {
+            r_dcache_in_tlb[i]       = false;
+            r_dcache_contains_ptd[i] = false;
+        } 
+
+        // Response FIFOs and cleanup buffer
+        r_vci_rsp_fifo_icache.init();
+        r_vci_rsp_fifo_dcache.init();
+
+        // ICACHE & DCACHE activated
+        r_mmu_mode = 0x3;
+
+	    // No request from ICACHE FSM to CMD FSM
+        r_icache_miss_req          = false;
+        r_icache_unc_req           = false;
+
+        // No request from ICACHE_FSM to DCACHE FSM
+        r_icache_tlb_miss_req      = false;      
+ 
+        // No request from ICACHE_FSM to CLEANUP_CMD FSM
+        r_icache_cleanup_req       = false;      
+        
+        // No pending write in pipeline
+        r_dcache_wbuf_req          = false;
+        r_dcache_updt_req          = false;
+
+        // No request from DCACHE_FSM to CMD_FSM
+        r_dcache_vci_miss_req      = false;
+        r_dcache_vci_unc_req       = false;
+        r_dcache_vci_cas_req       = false;
+        r_dcache_vci_ll_req        = false;
+        r_dcache_vci_sc_req        = false;
+
+        // No uncacheable write pending
+        r_dcache_pending_unc_write = false;
+
+        // No processor XTN request pending
+        r_dcache_xtn_req           = false;
+
+        // No request from DCACHE FSM to CLEANUP_CMD FSM
+        r_dcache_cleanup_req      = false;
+
+        // No request from CLEANUP_RSP FSM to ICACHE/DCACHE FSMs
+        r_cleanup_icache_req      = false;
+        r_cleanup_dcache_req      = false;
+
+        // No request from TGT FSM to ICACHE/DCACHE FSMs
+        r_tgt_icache_req          = false;
+        r_tgt_dcache_req          = false;
+
+        // No pending cleanup after a replacement
+        r_icache_miss_clack        = false;
+        r_dcache_miss_clack        = false;
+
+        // No signalisation of a coherence request matching a pending miss
+        r_icache_miss_inval       = false;
+        r_dcache_miss_inval       = false;
+
+        // No signalisation  of errors
+        r_vci_rsp_ins_error       = false;
+        r_vci_rsp_data_error      = false;
+
+        // Debug variables
+        m_debug_previous_hit      = false;
+        m_idebug_previous_hit     = false;
+        m_debug_dcache_fsm	      = false;
+        m_debug_icache_fsm	      = false;
+        m_debug_cleanup_fsm  	  = false;
+
+        // activity counters
+        m_cpt_dcache_data_read  = 0;
+        m_cpt_dcache_data_write = 0;
+        m_cpt_dcache_dir_read   = 0;
+        m_cpt_dcache_dir_write  = 0;
+        m_cpt_icache_data_read  = 0;
+        m_cpt_icache_data_write = 0;
+        m_cpt_icache_dir_read   = 0;
+        m_cpt_icache_dir_write  = 0;
+
+        m_cpt_frz_cycles        = 0;
+        m_cpt_total_cycles      = 0;
+        m_cpt_stop_simulation   = 0;
+
+        m_cpt_data_miss         = 0;
+        m_cpt_ins_miss          = 0;
+        m_cpt_unc_read          = 0;
+        m_cpt_write_cached      = 0;
+        m_cpt_ins_read          = 0;
+
+        m_cost_write_frz        = 0;
+        m_cost_data_miss_frz    = 0;
+        m_cost_unc_read_frz     = 0;
+        m_cost_ins_miss_frz     = 0;
+
+        m_cpt_imiss_transaction = 0;
+        m_cpt_dmiss_transaction = 0;
+        m_cpt_unc_transaction   = 0;
+        m_cpt_write_transaction = 0;
+        m_cpt_icache_unc_transaction = 0;	
+
+        m_cost_imiss_transaction      = 0;
+        m_cost_dmiss_transaction      = 0;
+        m_cost_unc_transaction        = 0;
+        m_cost_write_transaction      = 0;
+        m_cost_icache_unc_transaction = 0;
+        m_length_write_transaction    = 0;
+
+        m_cpt_ins_tlb_read       = 0;             
+        m_cpt_ins_tlb_miss       = 0;             
+        m_cpt_ins_tlb_update_acc = 0;         
+
+        m_cpt_data_tlb_read         = 0;           
+        m_cpt_data_tlb_miss         = 0;           
+        m_cpt_data_tlb_update_acc   = 0;       
+        m_cpt_data_tlb_update_dirty = 0;    
+        m_cpt_ins_tlb_hit_dcache    = 0;
+        m_cpt_data_tlb_hit_dcache   = 0;
+        m_cpt_ins_tlb_occup_cache   = 0;
+        m_cpt_data_tlb_occup_cache  = 0;
+
+        m_cost_ins_tlb_miss_frz          = 0;      
+        m_cost_data_tlb_miss_frz         = 0;      
+        m_cost_ins_tlb_update_acc_frz    = 0;
+        m_cost_data_tlb_update_acc_frz   = 0;
+        m_cost_data_tlb_update_dirty_frz = 0;
+        m_cost_ins_tlb_occup_cache_frz   = 0;
+        m_cost_data_tlb_occup_cache_frz  = 0;
+
+    	m_cpt_ins_tlb_inval       = 0;           
+    	m_cpt_data_tlb_inval      = 0;          
+    	m_cost_ins_tlb_inval_frz  = 0;     
+    	m_cost_data_tlb_inval_frz = 0;         
+
+        m_cpt_cc_broadcast   = 0;
+
+   	    m_cost_updt_data_frz  = 0;
+   	    m_cost_inval_ins_frz  = 0;
+   	    m_cost_inval_data_frz = 0;
+   	    m_cost_broadcast_frz  = 0;
+
+   	    m_cpt_cc_cleanup_data = 0;
+   	    m_cpt_cc_cleanup_ins  = 0;
+
+        m_cpt_itlbmiss_transaction      = 0;    
+        m_cpt_itlb_ll_transaction       = 0;  
+        m_cpt_itlb_sc_transaction       = 0;  
+        m_cpt_dtlbmiss_transaction      = 0;  
+        m_cpt_dtlb_ll_transaction       = 0;  
+        m_cpt_dtlb_sc_transaction       = 0;  
+        m_cpt_dtlb_ll_dirty_transaction = 0;  
+        m_cpt_dtlb_sc_dirty_transaction = 0;  
+ 
+        m_cost_itlbmiss_transaction      = 0;   
+        m_cost_itlb_ll_transaction       = 0;  
+        m_cost_itlb_sc_transaction       = 0;  
+        m_cost_dtlbmiss_transaction      = 0;   
+        m_cost_dtlb_ll_transaction       = 0;   
+        m_cost_dtlb_sc_transaction       = 0;   
+        m_cost_dtlb_ll_dirty_transaction = 0;   
+        m_cost_dtlb_sc_dirty_transaction = 0;    
+/* 
+        m_cpt_dcache_frz_cycles = 0;
+        m_cpt_read              = 0;
+        m_cpt_write             = 0;
+   	    m_cpt_cc_update_data = 0;
+   	    m_cpt_cc_inval_ins   = 0;
+   	    m_cpt_cc_inval_data  = 0;
+*/
+
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_icache      [i]   = 0;
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_dcache      [i]   = 0;
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_cmd         [i]   = 0;
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_rsp         [i]   = 0;
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_tgt         [i]   = 0;
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_cmd_cleanup [i]   = 0;
+        for (uint32_t i=0; i<32 ; ++i) m_cpt_fsm_rsp_cleanup [i]   = 0;
+
+        // init the llsc reservation buffer
+        r_dcache_llsc_valid = false;
+
+        return;
+    }
+
+    // Response FIFOs default values
+    bool       vci_rsp_fifo_icache_get       = false;
+    bool       vci_rsp_fifo_icache_put       = false;
+    uint32_t   vci_rsp_fifo_icache_data      = 0;
+
+    bool       vci_rsp_fifo_dcache_get       = false;
+    bool       vci_rsp_fifo_dcache_put       = false;
+    uint32_t   vci_rsp_fifo_dcache_data      = 0;
+
+#ifdef INSTRUMENTATION
+    m_cpt_fsm_dcache  [r_dcache_fsm.read() ] ++;
+    m_cpt_fsm_icache  [r_icache_fsm.read() ] ++;
+    m_cpt_fsm_cmd     [r_vci_cmd_fsm.read()] ++;
+    m_cpt_fsm_rsp     [r_vci_rsp_fsm.read()] ++;
+    m_cpt_fsm_tgt     [r_tgt_fsm.read()    ] ++;
+    m_cpt_fsm_cleanup [r_cleanup_cmd_fsm.read()] ++;
+#endif
+
+    m_cpt_total_cycles++;
+
+    m_debug_cleanup_fsm    = (m_cpt_total_cycles > m_debug_start_cycle) and m_debug_ok;
+    m_debug_icache_fsm     = (m_cpt_total_cycles > m_debug_start_cycle) and m_debug_ok;
+    m_debug_dcache_fsm     = (m_cpt_total_cycles > m_debug_start_cycle) and m_debug_ok;
+
+    //////////////////////////////////////////////////////////////////////////////
+    //   TARGET TSM
+    // All VCI commands must be CMD_WRITE.
+    // - If the 2 LSB bits of the VCI address are 11, it is a broadcast request.
+    //   It is a multicast request otherwise.
+    // - For multicast requests, the ADDRESS[2] bit distinguishes DATA/INS
+    //   (0 for data / 1 for instruction), and the ADDRESS[3] bit distinguishes
+    //   INVAL/UPDATE (0 for invalidate / 1 for UPDATE).
+    //
+    // For all types of coherence request, the line index (i.e. the Z & Y fields) 
+    // is coded on 34 bits, and is contained in the WDATA and BE fields 
+    // of the first VCI flit.
+    // -  for a multicast invalidate or for a broadcast invalidate request
+    //    the VCI packet length is 1 word. 
+    // -  for an update request the VCI packet length is (n+2) words.
+    //    The WDATA field of the second VCI word contains the word index.
+    //    The WDATA field of the n following words contains the values.
+    // -  for all transaction types, the VCI response is one single word.
+    // In case of errors in the VCI command packet, the simulation
+    // is stopped with an error message.
+    //
+    // This FSM is NOT pipelined : It consumes a new coherence request 
+    // on the VCI port only when the previous request is completed.
+    //
+    // The VCI_TGT FSM stores the external request arguments in the
+    // IDLE, UPDT_WORD & UPDT_DATA states. It sets the r_tgt_icache_req 
+    // and/or the r_tgt_dcache_req flip-flops to signal the coherence request 
+    // to the ICACHE & DCACHE FSMs in the REQ_ICACHE, REQ_DCACHE & REQ_BROADCAST
+    // states. It waits the completion of the coherence request  by polling the
+    // r_tgt_*cache_req flip-flops in the RSP_ICACHE, RSP_DCACHE & RSP_BROADCAST
+    // states. These flip-flops are reset by the ICACHE and DCACHE FSMs. 
+    // These two FSMs signal if a VCI answer must be send by setting
+    // the r_tgt_icache_rsp and/or the r_tgt_dcache_rsp flip_flops.
+    ///////////////////////////////////////////////////////////////////////////////
+    //   CC_RECEIVE  FSM (To Be Done)
+    // This FSM receive all coherence packets on a DSPIN40 port.
+    // There is 4 packet types:
+    // - CC_DATA_INVAL : DCACHE invalidate request
+    // - CC_DATA_UPDT  : DCACHE update request (multi-words)
+    // - CC_INST_INVAL : ICACHE invalidate request
+    // - CC_INST_UPDT  : ICACHE update request (multi-words)
+    // - CC_BROADCAST  : Broadcast invalidate request (both DCACHE & ICACHE)
+    // - CC_DATA_CLACK : DCACHE cleanup acknowledge
+    // - CC_INST_CLACK : ICACHE cleanup acknowledge
+    //////////////////////////////////////////////////////////////////////////////
+
+    switch( r_tgt_fsm.read() ) 
+    {
+    //////////////
+    case TGT_IDLE:
+    {
+        if ( p_vci_tgt_c.cmdval.read() ) 
+        {
+            paddr_t address = p_vci_tgt_c.address.read();
+
+            // command checking
+            if ( p_vci_tgt_c.cmd.read() != vci_param::CMD_WRITE) 
+            {
+                std::cout << "error in component VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                std::cout << "the received VCI coherence command is not a write" << std::endl;
+                exit(0);
+            }
+
+            // address checking
+            if ( ( (address & 0x3) != 0x3 ) && ( not m_segment.contains(address)) ) 
+            {
+                std::cout << "error in component VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                std::cout << "out of segment VCI coherence command received" << std::endl;
+                exit(0);
+            }
+
+            r_tgt_srcid = p_vci_tgt_c.srcid.read();
+            r_tgt_trdid = p_vci_tgt_c.trdid.read();
+            r_tgt_pktid = p_vci_tgt_c.pktid.read();
+
+	    if (sizeof(paddr_t) <= 32) 
+        {
+		     assert(p_vci_tgt_c.be.read() == 0 
+             && "byte enable should be 0 for 32bits paddr");
+             r_tgt_paddr  = (paddr_t)p_vci_tgt_c.wdata.read() * m_dcache_words * 4; 
+	    }
+        else 
+        {
+             r_tgt_paddr  = (paddr_t)(p_vci_tgt_c.be.read() & 0x3) << 32 |
+			                (paddr_t)p_vci_tgt_c.wdata.read() * m_dcache_words * 4; 
+	    }
+
+            if ( (address&0x3) == 0x3 ) // broadcast invalidate for data or instruction type
+            {
+                if ( not p_vci_tgt_c.eop.read() ) 
+                {
+                    std::cout << "error in VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                    std::cout << "the BROADCAST INVALIDATE command must be one flit" << std::endl;
+                    exit(0);
+                }
+                r_tgt_cc_type = CC_TYPE_BROADCAST;
+                r_tgt_fsm     = TGT_REQ_BROADCAST;
+
+#ifdef INSTRUMENTATION
+m_cpt_cc_broadcast++;
+#endif
+            }
+            else                // multi-update or multi-invalidate for data type
+            {
+                paddr_t cell = address - m_segment.baseAddress();   
+
+                if (cell == 0)                      // invalidate data
+                {                         
+                    if ( not p_vci_tgt_c.eop.read() ) 
+                    {
+                        std::cout << "error in VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                        std::cout << "the MULTI-INVALIDATE command must be one flit" << std::endl;
+                        exit(0);
+                    }
+                    r_tgt_cc_type = CC_TYPE_INVAL_DATA; 
+                    r_tgt_fsm     = TGT_REQ_DCACHE;
+
+#ifdef INSTRUMENTATION
+m_cpt_cc_inval_dcache++;
+#endif
+                }
+                else if (cell == 4)                // invalidate instruction
+                {                                
+                    if ( not p_vci_tgt_c.eop.read() ) 
+                    {
+                        std::cout << "error in VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                        std::cout << "the MULTI-INVALIDATE command must be one flit" << std::endl;
+                        exit(0);
+                    }
+                    r_tgt_cc_type = CC_TYPE_INVAL_INS;
+                    r_tgt_fsm     = TGT_REQ_ICACHE;
+
+#ifdef INSTRUMENTATION
+m_cpt_cc_inval_icache++;
+#endif
+                }     
+                else if (cell == 8)		                // update data
+                {
+                    if ( p_vci_tgt_c.eop.read() ) 
+                    {
+                        std::cout << "error in VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                        std::cout << "the MULTI-UPDATE command must be N+2 flits" << std::endl;
+                        exit(0);
+                    }
+                    r_tgt_cc_type     = CC_TYPE_UPDT_DATA; 
+                    r_tgt_fsm         = TGT_UPDT_WORD;
+
+#ifdef INSTRUMENTATION
+m_cpt_cc_update_dcache++;
+#endif
+		        }
+                else                                  // update instruction
+                {
+                    if ( p_vci_tgt_c.eop.read() ) 
+                    {
+                        std::cout << "error in VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                        std::cout << "the MULTI-UPDATE command must be N+2 flits" << std::endl;
+                        exit(0);
+                    }
+                    r_tgt_cc_type     = CC_TYPE_UPDT_INS; 
+                    r_tgt_fsm         = TGT_UPDT_WORD;
+
+#ifdef INSTRUMENTATION
+m_cpt_cc_update_icache++;
+#endif
+                }
+            } // end if multi      
+        } // end if cmdval
+        break;
+    }
+    ///////////////////
+    case TGT_UPDT_WORD:		// first word index acquisition
+    {
+        if (p_vci_tgt_c.cmdval.read()) 
+        {
+            if ( p_vci_tgt_c.eop.read() ) 
+            {
+                std::cout << "error in component VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                std::cout << "the MULTI-UPDATE command must be N+2 flits" << std::endl;
+                exit(0);
+            }
+            for ( size_t i=0 ; i<m_dcache_words ; i++ ) r_tgt_be[i] = false;
+
+            r_tgt_word_min   = p_vci_tgt_c.wdata.read(); // first modifid word index
+            r_tgt_word_count = p_vci_tgt_c.wdata.read(); // initializing word index
+            r_tgt_fsm = TGT_UPDT_DATA;
+        }
+        break;
+    }
+    ///////////////////
+    case TGT_UPDT_DATA:
+    {
+        if (p_vci_tgt_c.cmdval.read()) 
+        {
+            size_t word = r_tgt_word_count.read();
+            if (word >= m_dcache_words) 
+            {
+                std::cout << "error in component VCI_CC_VCACHE_WRAPPER " << name() << std::endl;
+                std::cout << "the reveived MULTI-UPDATE command is wrong" << std::endl;
+                exit(0);
+            }
+            r_tgt_buf[word]  = p_vci_tgt_c.wdata.read();
+            r_tgt_be[word]   = p_vci_tgt_c.be.read();
+            r_tgt_word_count = word + 1;	
+
+            if (p_vci_tgt_c.eop.read()) 	// last word
+            {
+                 r_tgt_word_max = word;
+                 if ( r_tgt_cc_type.read() == CC_TYPE_UPDT_DATA ) r_tgt_fsm = TGT_REQ_DCACHE;
+                 else					                          r_tgt_fsm = TGT_REQ_ICACHE;
+            }
+        }
+        break;
+    }
+    ///////////////////////
+    case TGT_REQ_BROADCAST:	// set requests to DCACHE & ICACHE FSMs 
+    {
+        if ( not r_tgt_icache_req.read() and not r_tgt_dcache_req.read() ) 
+        {
+            r_tgt_fsm = TGT_RSP_BROADCAST; 
+            r_tgt_icache_req = true;
+            r_tgt_dcache_req = true;
+        }
+        break;
+    }
+    /////////////////////
+    case TGT_REQ_ICACHE:	// set request to ICACHE FSM (if no previous request pending)
+    {
+        if ( not r_tgt_icache_req.read() ) 
+        {
+            r_tgt_fsm = TGT_RSP_ICACHE; 
+            r_tgt_icache_req = true;
+        }
+        break;
+    }
+    ////////////////////
+    case TGT_REQ_DCACHE:	// set request to DCACHE FSM (if no previous request pending)
+    {
+        if ( not r_tgt_dcache_req.read() ) 
+        {
+            r_tgt_fsm = TGT_RSP_DCACHE; 
+            r_tgt_dcache_req = true;
+        }
+        break;
+    }
+    ///////////////////////
+    case TGT_RSP_BROADCAST:	// waiting responses from both DCACHE & ICACHE FSMs
+                            // no VCI response por a broadcast
+    {
+        if ( not r_tgt_icache_req.read() and not r_tgt_dcache_req.read() ) 
+        {
+            r_tgt_fsm = TGT_IDLE;
+        }
+        break;
+    }
+    ////////////////////
+    case TGT_RSP_ICACHE:	// waiting response from ICACHE FSM
+                            // a VCI response is sent only
+                            // if r_icache_tgt_need_rsp is set
+    {
+        if ( not r_tgt_icache_req.read() ) 
+        {
+            if ( not r_icache_tgt_need_rsp.read() or
+                 p_vci_tgt_c.rspack.read() ) r_tgt_fsm = TGT_IDLE;
+        }
+        break;
+    }
+    ////////////////////
+    case TGT_RSP_DCACHE:    // waiting response from DCACHE FSM
+                            // a VCI response is sent only
+                            // if r_dcache_tgt_need_rsp is set
+    {
+        if ( not r_tgt_dcache_req.read() )
+        {
+            if ( not r_icache_tgt_need_rsp.read() or
+                 p_vci_tgt_c.rspack.read() ) r_tgt_fsm = TGT_IDLE;
+        }
+        break;
+    }
+    } // end switch TGT_FSM
+
+    /////////////////////////////////////////////////////////////////////
+    // Get data and instruction requests from processor
+    ///////////////////////////////////////////////////////////////////////
+
+    r_iss.getRequests(m_ireq, m_dreq);
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //      ICACHE_FSM
+    //
+    // 1/ Coherence operations 
+    //    They are handled as interrupts generated by the CC_RECEIVE FSM.
+    //    - There is a coherence request when r_tgt_icache_req is set.
+    //    They are taken in IDLE, MISS_WAIT, MISS_DIR_UPDT, UNC_WAIT, states.
+    //    - There is a cleanup ack request when r_cleanup_icache_req is set. 
+    //    They are taken in IDLE, MISS_SELECT, MISS_CLEAN, MISS_WAIT,
+    //    MISS_DATA_UPDT, MISS_DIR_UPDT and UNC_WAIT states.
+    //    - For both types of requests, actions associated to the pre-empted state 
+    //    are not executed. The DCACHE FSM goes to the proper sub-FSM (CC_CHECK 
+    //    or CC_CLACK) to execute the requested coherence operation, and returns 
+    //    to the pre-empted state.
+    //
+    // 2/ Processor requests
+    //    They are taken in IDLE state only. In case of cache miss, or uncacheable
+    //    instruction, the ICACHE FSM request a VCI transaction to CMD FSM,
+    //    using the r_icache_miss_req or r_icache_unc_req flip-flops. These
+    //    flip-flops are reset when the transaction starts. 
+    //    - In case of miss the ICACHE FSM  goes to the ICACHE_MISS_SELECT state 
+    //    to select a slot and possibly request a cleanup transaction to the CC_SEND FSM. 
+    //    It goes next to the ICACHE_MISS_WAIT state waiting a response from RSP FSM, 
+    //    The availability of the missing cache line is signaled by the response fifo,
+    //    and the cache update is done (one word per cycle) in the ICACHE_MISS_DATA_UPDT
+    //    and ICACHE_MISS_DIR_UPDT states. 
+    //    - In case of uncacheable instruction, the ICACHE FSM goes to ICACHE_UNC_WAIT 
+    //    to wait the response from the RSP FSM, through the response fifo. 
+    //    The missing instruction is directly returned to processor in this state.
+    // 
+    // 3/ TLB miss
+    //    In case of tlb miss, the ICACHE FSM request to the DCACHE FSM to update the 
+    //    ITLB using the r_icache_tlb_miss_req flip-flop and the r_icache_tlb_miss_vaddr 
+    //    register, and goes to the ICACHE_TLB_WAIT state.
+    //    The tlb update is entirely done by the DCACHE FSM (who becomes the owner 
+    //    of ITLB until the update is completed, and reset r_icache_tlb_miss_req 
+    //    to signal the completion.
+    //
+    // 4/ XTN requests
+    //    The DCACHE FSM signals XTN processor requests to ICACHE_FSM
+    //    using the r_dcache_xtn_req flip-flop. 
+    //    The request opcode and the address to be invalidated are transmitted
+    //    in the r_dcache_xtn_opcode and r_dcache_save_wdata registers respectively.
+    //    The r_dcache_xtn_req flip-flop is reset by the ICACHE_FSM when the operation 
+    //    is completed.
+    //
+    // 5/ Error Handling
+    //    The r_vci_rsp_ins_error flip-flop is set by the RSP FSM in case of bus error
+    //    in a cache miss or uncacheable read VCI transaction. Nothing is written 
+    //    in the response fifo. This flip-flop is reset by the ICACHE-FSM.
+    ////////////////////////////////////////////////////////////////////////////////////////
+
+    // default value for m_irsp
+    m_irsp.valid       = false;
+    m_irsp.error       = false;
+    m_irsp.instruction = 0;
+
+    switch( r_icache_fsm.read() ) 
+    {
+    /////////////////
+    case ICACHE_IDLE:	// In this state, we handle processor requests, XTN requests,
+                        // and coherence requests with a fixed priority:
+                        // 1/ Coherence requests 				        => ICACHE_CC_CHECK
+                        // 2/ Cleanup ack requests 				        => ICACHE_CC_CLACK
+                        // 3/ XTN processor requests (from DCACHE FSM)  => ICACHE_XTN_*
+                        // 4/ tlb miss                                  => ICACHE_TLB_WAIT 
+                        // 5/ cacheable read miss 				        => ICACHE_MISS_SELECT
+                        // 6/ uncacheable read miss 				    => ICACHE_UNC_REQ 
+    {
+        // coherence interrupt
+        if ( r_tgt_icache_req.read() )
+        {
+            r_icache_fsm = ICACHE_CC_CHECK;
+            r_icache_fsm_save = r_icache_fsm.read();
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )
+        {
+            r_icache_fsm = ICACHE_CC_CLACK;
+            r_icache_fsm_save = r_icache_fsm.read();
+            break;
+        }
+
+        // XTN requests sent by DCACHE FSM  
+        // These request are not executed in this IDLE state, because
+        // they require access to icache or itlb, that are already accessed
+        if ( r_dcache_xtn_req.read() )
+        {
+            if ( (int)r_dcache_xtn_opcode.read() == (int)iss_t::XTN_PTPR ) 
+            {
+                r_icache_fsm         = ICACHE_XTN_TLB_FLUSH;   
+            }
+            else if ( (int)r_dcache_xtn_opcode.read() == (int)iss_t::XTN_ICACHE_FLUSH)
+            {
+                r_icache_flush_count = 0;
+                r_icache_fsm         = ICACHE_XTN_CACHE_FLUSH;   
+            }
+            else if ( (int)r_dcache_xtn_opcode.read() == (int)iss_t::XTN_ITLB_INVAL) 
+            {
+                r_icache_fsm         = ICACHE_XTN_TLB_INVAL;   
+            }
+            else if ( (int)r_dcache_xtn_opcode.read() == (int)iss_t::XTN_ICACHE_INVAL) 
+            {
+                r_icache_fsm         = ICACHE_XTN_CACHE_INVAL_VA;   
+            }
+            else if ( (int)r_dcache_xtn_opcode.read() == (int)iss_t::XTN_MMU_ICACHE_PA_INV) 
+            {
+		        if (sizeof(paddr_t) <= 32) 
+                {
+			        assert(r_mmu_word_hi.read() == 0 &&
+			        "illegal XTN request in ICACHE: high bits should be 0 for 32bit paddr");
+			        r_icache_vci_paddr = (paddr_t)r_mmu_word_lo.read();
+                } 
+                else 
+                {
+			        r_icache_vci_paddr = (paddr_t)r_mmu_word_hi.read() << 32 | 
+				                         (paddr_t)r_mmu_word_lo.read();
+		        }
+                r_icache_fsm         = ICACHE_XTN_CACHE_INVAL_PA;   
+            }
+            else
+            {
+               assert( false and
+               "undefined XTN request received by ICACHE FSM");
+            }
+            break;
+        } // end if xtn_req
+
+        // processor request
+        if ( m_ireq.valid )
+        {
+            bool	    cacheable;
+            paddr_t	    paddr;
+            bool        tlb_hit = false;  
+            pte_info_t  tlb_flags; 
+            size_t      tlb_way;  
+            size_t      tlb_set;
+            paddr_t     tlb_nline;
+            uint32_t    cache_inst = 0;
+            size_t      cache_way;
+            size_t      cache_set;
+            size_t      cache_word;
+            int         cache_state = CACHE_SLOT_STATE_EMPTY;
+
+            // We register processor request
+            r_icache_vaddr_save = m_ireq.addr;
+
+            // sytematic itlb access (if activated)
+            if ( r_mmu_mode.read() & INS_TLB_MASK )
+            {
+
+#ifdef INSTRUMENTATION
+m_cpt_itlb_read++;
+#endif
+                tlb_hit = r_itlb.translate( m_ireq.addr,
+                                            &paddr,
+                                            &tlb_flags,
+                                            &tlb_nline,	// unused
+                                            &tlb_way,	// unused
+                                            &tlb_set );	// unused
+            }
+            else
+            {
+                paddr = (paddr_t)m_ireq.addr;
+            }
+
+            // systematic icache access (if activated)
+            if ( r_mmu_mode.read() & INS_CACHE_MASK )
+            {
+
+                
+#ifdef INSTRUMENTATION
+m_cpt_icache_data_read++;
+m_cpt_icache_dir_read++;
+#endif
+                r_icache.read( paddr,
+                               &cache_inst,
+                               &cache_way,
+                               &cache_set,
+                               &cache_word,
+                               &cache_state );
+            }
+           
+            // We compute cacheability and check access rights:
+            // - If MMU activated : cacheability is defined by the C bit in the PTE,
+            //   and the access rights are defined by the U and X bits in the PTE.
+            // - If MMU not activated : cacheability is defined by the segment table,
+            //   and there is no access rights checking
+
+            if ( not (r_mmu_mode.read() & INS_TLB_MASK) ) 	// tlb not activated: 
+            {
+                // cacheability
+                if ( not (r_mmu_mode.read() & INS_CACHE_MASK) ) cacheable = false;
+                else     cacheable = m_cacheability_table[m_ireq.addr];
+            }
+            else						        // itlb activated
+            {
+                if ( tlb_hit )	// ITLB hit
+                {  
+                    // cacheability
+                    if ( not (r_mmu_mode.read() & INS_CACHE_MASK) ) cacheable = false;
+                    else  cacheable = tlb_flags.c;
+
+                    // access rights checking 
+                    if ( not tlb_flags.u && (m_ireq.mode == iss_t::MODE_USER) )
+                    {
+                        r_mmu_ietr          = MMU_READ_PRIVILEGE_VIOLATION;
+                        r_mmu_ibvar         = m_ireq.addr;
+                        m_irsp.valid        = true;
+                        m_irsp.error        = true;
+                        m_irsp.instruction  = 0;
+                        break;
+                    }
+                    else if ( not tlb_flags.x )
+                    {
+                        r_mmu_ietr          = MMU_READ_EXEC_VIOLATION;
+                        r_mmu_ibvar         = m_ireq.addr;
+                        m_irsp.valid        = true;
+                        m_irsp.error        = true;
+                        m_irsp.instruction  = 0;
+                        break;
+                    }
+                }
+                else           // ITLB miss 
+                {
+
+#ifdef INSTRUMENTATION
+m_cpt_itlb_miss++;
+#endif
+                    r_icache_fsm          = ICACHE_TLB_WAIT;
+                    r_icache_tlb_miss_req = true;
+                    break;
+                } 
+            } // end if itlb activated
+
+            // physical address registration 
+            r_icache_vci_paddr   = paddr;
+
+            // Finally, we send the response to processor, and compute next state
+            if ( cacheable )  
+            {
+                if (cache_state == CACHE_SLOT_STATE_EMPTY)	    // cache miss
+                {
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_miss++;
+#endif
+                    // we request a VCI transaction
+                    r_icache_fsm      = ICACHE_MISS_SELECT;
+                    r_icache_miss_req = true;
+                }
+                else if (cache_state == CACHE_SLOT_STATE_ZOMBI )	// pending cleanup
+                {
+                    // stalled until cleanup is acknowledged
+                    r_icache_fsm       = ICACHE_IDLE;
+                }
+                else			                            // cache hit
+                {
+      
+#ifdef INSTRUMENTATION
+m_cpt_ins_read++; 
+#endif
+                    // return instruction to processor
+                    m_irsp.valid       = true;
+                    m_irsp.instruction = cache_inst;
+                    r_icache_fsm       = ICACHE_IDLE;
+                }
+            }
+            else             	// non cacheable read
+            {
+                r_icache_unc_req  = true;
+                r_icache_fsm      = ICACHE_UNC_WAIT;
+            }
+        }    // end if m_ireq.valid
+        break;
+    }
+    /////////////////////
+    case ICACHE_TLB_WAIT:	// Waiting the itlb update by the DCACHE FSM after a tlb miss
+                            // the itlb is udated by the DCACHE FSM, as well as the 
+                            // r_mmu_ietr and r_mmu_ibvar registers in case of error.
+                            // the itlb is not accessed by ICACHE FSM until DCACHE FSM
+                            // reset the r_icache_tlb_miss_req flip-flop
+                            // external coherence request are accepted in this state.
+    {
+        // external coherence request
+        if ( r_tgt_icache_req.read() )
+        {
+            r_icache_fsm = ICACHE_CC_CHECK;
+            r_icache_fsm_save = r_icache_fsm.read();
+            break;
+        }
+
+        if ( m_ireq.valid ) m_cost_ins_tlb_miss_frz++;
+
+        // DCACHE FSM signals response by reseting the request flip-flop
+        if ( not r_icache_tlb_miss_req.read() )
+        {
+            if ( r_icache_tlb_rsp_error.read() ) // error reported : tlb not updated
+            {
+                r_icache_tlb_rsp_error = false;
+                m_irsp.error             = true;
+                m_irsp.valid             = true;
+                r_icache_fsm             = ICACHE_IDLE;
+            }
+            else				// tlb updated : return to IDLE state
+            {
+                r_icache_fsm  = ICACHE_IDLE;
+            }
+        }
+        break;
+    }
+    //////////////////////////
+    case ICACHE_XTN_TLB_FLUSH:   	// invalidate in one cycle all non global TLB entries
+    {   
+        r_itlb.flush();   
+        r_dcache_xtn_req     = false;
+        r_icache_fsm         = ICACHE_IDLE;
+        break;
+    }
+    ////////////////////////////
+    case ICACHE_XTN_CACHE_FLUSH:	// Invalidate sequencially all cache lines, using
+                                    // r_icache_flush_count as a slot counter,
+                                	// looping in this state until all slots are visited.
+                                    // It can require two cycles per slot:
+                                    // We test here the slot state, and make the actual inval
+                                    // (if line is valid) in ICACHE_XTN_CACHE_FLUSH_GO state.
+                       		        // A cleanup request is generated for each valid line 
+    {
+        if ( not r_icache_cleanup_req.read() ) // blocked until previous cleanup is sent
+        {
+            int       state;
+            uint32_t  tag;
+            size_t	  way = r_icache_flush_count.read()/m_icache_sets;
+            size_t	  set = r_icache_flush_count.read()%m_icache_sets;
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_read++;
+#endif
+            r_icache.read_dir( way, 
+                               set, 
+                               &tag,
+                               &state );
+
+            if ( state == CACHE_SLOT_STATE_VALID )    // inval required
+            {
+                // request cleanup
+                r_icache_cleanup_req  = true;
+                r_icache_cleanup_line = tag * m_icache_sets;
+                r_icache_cleanup_way  = way;
+                
+                // goes to ICACHE_XTN_CACHE_FLUSH_GO to make inval
+                r_icache_miss_way     = way;
+                r_icache_miss_set     = set;
+                r_icache_fsm          = ICACHE_XTN_CACHE_FLUSH_GO;
+            }
+            else if ( r_icache_flush_count.read() ==
+                      (m_icache_sets*m_icache_ways - 1) )  // last slot
+            {
+            	r_dcache_xtn_req = false;
+                m_drsp.valid     = true;
+            	r_icache_fsm 	 = ICACHE_IDLE;
+            }
+
+            // saturation counter, to have the same last slot condition
+            // in ICACHE_XTN_CACHE_FLUSH and ICACHE_XTN_CACHE_FLUSH_GO states
+            if ( r_icache_flush_count.read() < (m_icache_sets*m_icache_ways - 1) )
+            {
+                r_icache_flush_count = r_icache_flush_count.read() + 1;
+            }
+        }
+        break;
+    }    
+    ///////////////////////////////
+    case ICACHE_XTN_CACHE_FLUSH_GO:	    // Switch slot state to ZOMBI for an XTN flush
+    {
+        size_t	  way = r_icache_miss_way.read();
+        size_t	  set = r_icache_miss_set.read();
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+
+        r_icache.write_dir( 0,
+                            way,
+                            set,
+                            CACHE_SLOT_STATE_ZOMBI );
+
+        if ( r_icache_flush_count.read() ==
+                      (m_icache_sets*m_icache_ways - 1) )  // last slot
+        {
+         	r_dcache_xtn_req = false;
+            m_drsp.valid     = true;
+         	r_icache_fsm 	 = ICACHE_IDLE;
+        }
+        else
+        {
+            r_icache_fsm         = ICACHE_XTN_CACHE_FLUSH;
+        }
+        break;
+    }
+                          
+    //////////////////////////
+    case ICACHE_XTN_TLB_INVAL: 		// invalidate one TLB entry selected by the virtual address 
+        				            // stored in the r_dcache_save_wdata register
+    {
+        r_itlb.inval(r_dcache_save_wdata.read());
+        r_dcache_xtn_req     = false;
+        r_icache_fsm         = ICACHE_IDLE;
+        break;
+    }
+    ///////////////////////////////
+    case ICACHE_XTN_CACHE_INVAL_VA:	// Selective cache line invalidate with virtual address
+                                    // requires 3 cycles (in case of hit on itlb and icache).
+					                // In this state, access TLB to translate virtual address 
+        				            // stored in the r_dcache_save_wdata register.
+    {
+        paddr_t 	paddr;                     
+        bool    	hit;
+
+        // read physical address in TLB when MMU activated
+        if ( r_mmu_mode.read() & INS_TLB_MASK ) 	// itlb activated
+        {
+
+#ifdef INSTRUMENTATION
+m_cpt_itlb_read++;
+#endif
+            hit = r_itlb.translate(r_dcache_save_wdata.read(), 
+                                   &paddr); 
+        } 
+        else 						// itlb not activated
+        {
+            paddr 	= (paddr_t)r_dcache_save_wdata.read();
+            hit 	= true;
+        }
+
+        if ( hit )		// continue the selective inval process
+        {
+            r_icache_vci_paddr    = paddr;                
+            r_icache_fsm          = ICACHE_XTN_CACHE_INVAL_PA;
+        }
+        else			// miss : send a request to DCACHE FSM
+        {
+
+#ifdef INSTRUMENTATION
+m_cpt_itlb_miss++;
+#endif
+            r_icache_tlb_miss_req = true;
+	        r_icache_vaddr_save   = r_dcache_save_wdata.read();
+            r_icache_fsm          = ICACHE_TLB_WAIT;
+        }
+        break;
+    }
+    ///////////////////////////////
+    case ICACHE_XTN_CACHE_INVAL_PA:	// selective invalidate cache line with physical address 
+                                    // require 2 cycles. In this state, we read directory
+                                    // with address stored in r_icache_vci_paddr register.
+    {
+        int         state;
+        size_t		way;
+        size_t		set;
+        size_t		word;
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_read++;
+#endif
+        r_icache.read_dir(r_icache_vci_paddr.read(),
+                          &state,
+                          &way,
+                          &set,
+                          &word);
+
+        if ( state == CACHE_SLOT_STATE_VALID )	// inval to be done
+        {
+            r_icache_miss_way = way;
+            r_icache_miss_set = set;
+            r_icache_fsm      = ICACHE_XTN_CACHE_INVAL_GO;
+        }
+        else		// miss : acknowlege the XTN request and return
+        {
+            r_dcache_xtn_req = false; 
+            r_icache_fsm     = ICACHE_IDLE;
+        }
+        break;
+    }
+    ///////////////////////////////
+    case ICACHE_XTN_CACHE_INVAL_GO:  // Switch slot to ZOMBI state for an XTN inval
+    {
+        if ( not r_icache_cleanup_req.read() )  // blocked if previous cleanup not sent
+        {
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+            r_icache.write_dir( 0,
+                                r_icache_miss_way.read(),
+                                r_icache_miss_set.read(),
+                                CACHE_SLOT_STATE_ZOMBI );
+
+            // request cleanup 
+            r_icache_cleanup_req  = true;
+            r_icache_cleanup_line = r_icache_vci_paddr.read() / (m_icache_words<<2);
+            r_icache_cleanup_way  = r_icache_miss_way.read();
+
+            // acknowledge the XTN request and return
+            r_dcache_xtn_req      = false; 
+            r_icache_fsm          = ICACHE_IDLE;
+        }
+        break;
+    }
+    ////////////////////////
+    case ICACHE_MISS_SELECT:       // Try to select a slot in associative set,
+                                   // if previous cleanup has been sent.
+                                   // Waiting in this state if no slot available. 
+                                   // Set the r_icache_cleanup_req flip-flop
+                                   // and the r_icache_miss_clack flip-flop,
+                                   // when a cleanup is required
+    {
+        if (m_ireq.valid) m_cost_ins_miss_frz++;
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )     
+        {
+            r_icache_fsm_save = r_icache_fsm.read();
+            r_icache_fsm = ICACHE_CC_CLACK;
+            break;
+        }
+        
+        if ( not r_icache_cleanup_req.read() )
+        {
+            bool        found;
+            bool        cleanup;
+            size_t  	way;
+            size_t  	set;
+            paddr_t 	victim;
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_read++;
+#endif
+            r_icache.read_select(r_icache_vci_paddr.read(),
+                                 &victim, 
+                                 &way, 
+                                 &set,
+                                 &found,
+                                 &cleanup );
+            if ( found )
+            {
+                r_icache_miss_way     = way;
+                r_icache_miss_set     = set;
+            
+                if ( cleanup ) 
+                {
+                    r_icache_fsm          = ICACHE_MISS_CLEAN;
+                    r_icache_cleanup_req  = true;
+                    r_icache_cleanup_line = victim;
+                    r_icache_cleanup_way  = way;
+                    r_icache_miss_clack   = true;
+                }
+                else
+                {
+                    r_icache_fsm          = ICACHE_MISS_WAIT;
+                }
+
+#if DEBUG_ICACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " DCACHE_MISS_SELECT> Select a slot:" << std::dec
+              << " / WAY = " << way 
+              << " / SET = " << set;
+    if (cleanup) std::cout << " / VICTIM = " << std::hex << victim << std::endl;
+    else         std::cout << std::endl;
+}
+#endif
+            }
+        }
+        break;
+    }
+    ///////////////////////
+    case ICACHE_MISS_CLEAN:	         // switch the slot to zombi state
+    {
+        if (m_ireq.valid) m_cost_ins_miss_frz++;
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )     
+        {
+            r_icache_fsm_save = r_icache_fsm.read();
+            r_icache_fsm = ICACHE_CC_CLACK;
+            break;
+        }
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+        r_icache.write_dir( 0,
+                            r_icache_miss_way.read(),
+                            r_icache_miss_set.read(),
+                            CACHE_SLOT_STATE_ZOMBI);
+#if DEBUG_ICACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " DCACHE_MISS_CLEAN> Switch to ZOMBI state" << std::dec
+              << " / WAY = " << r_icache_miss_way.read() 
+              << " / SET = " << r_icache_miss_set.read() << std::endl;
+}
+#endif
+
+        r_icache_fsm = ICACHE_MISS_WAIT;
+        break;
+    }
+    //////////////////////
+    case ICACHE_MISS_WAIT:	  // waiting response from VCI_RSP FSM
+    {
+        if (m_ireq.valid) m_cost_ins_miss_frz++;
+
+        // coherence interrupt
+        if ( r_tgt_icache_req.read() )
+        {
+            r_icache_fsm = ICACHE_CC_CHECK;
+            r_icache_fsm_save = r_icache_fsm.read();
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )     
+        {
+            r_icache_fsm_save = r_icache_fsm.read();
+            r_icache_fsm = ICACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_ins_error.read() ) // bus error 
+        {
+            r_mmu_ietr          = MMU_READ_DATA_ILLEGAL_ACCESS; 
+            r_mmu_ibvar         = r_icache_vaddr_save.read();
+            m_irsp.valid        = true;
+            m_irsp.error        = true;
+            r_vci_rsp_ins_error = false;
+            r_icache_fsm        = ICACHE_IDLE;
+        }
+        else if ( r_vci_rsp_fifo_icache.rok() ) // response available
+        {
+            r_icache_miss_word = 0;
+            r_icache_fsm       = ICACHE_MISS_DATA_UPDT;  
+        }	
+        break;
+    }
+    ///////////////////////////
+    case ICACHE_MISS_DATA_UPDT:	  // update the cache (one word per cycle) 
+    {
+        if ( m_ireq.valid ) m_cost_ins_miss_frz++;
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )     
+        {
+            r_icache_fsm_save = r_icache_fsm.read();
+            r_icache_fsm = ICACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_fifo_icache.rok() )	// response available
+        {
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_data_write++;
+#endif
+            r_icache.write( r_icache_miss_way.read(),
+                            r_icache_miss_set.read(),
+                            r_icache_miss_word.read(),
+                            r_vci_rsp_fifo_icache.read() );
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " ICACHE_MISS_DATA_UPDT> Write one word:"
+              << " WDATA = " << r_vci_rsp_fifo_icache.read()
+              << " WAY = " << r_icache_miss_way.read()
+              << " SET = " << r_icache_miss_set.read()
+              << " WORD = " << r_icache_miss_word.read() << std::endl;
+}
+#endif
+            vci_rsp_fifo_icache_get = true;
+            r_icache_miss_word = r_icache_miss_word.read() + 1;
+
+            if ( r_icache_miss_word.read() == m_icache_words-1 ) 	// last word
+            {
+                r_icache_fsm = ICACHE_MISS_DIR_UPDT;
+            }
+        }
+        break;
+    }
+    //////////////////////////
+    case ICACHE_MISS_DIR_UPDT:	// Stalled if a victim line has been evicted,
+                                // and the cleanup ack has not been received,
+                                // as indicated by r_icache_miss_clack.
+                                // - If no matching coherence request (r_icache_miss_inval) 
+                                //   switch directory slot to VALID state.
+                                // - If matching coherence request, switch directory slot
+                                //   to ZOMBI state, and send a cleanup request.
+    {
+        if ( m_ireq.valid ) m_cost_ins_miss_frz++;
+
+        // coherence interrupt
+        if ( r_tgt_icache_req.read() )
+        {
+            r_icache_fsm = ICACHE_CC_CHECK;
+            r_icache_fsm_save = r_icache_fsm.read();
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )     
+        {
+            r_icache_fsm_save = r_icache_fsm.read();
+            r_icache_fsm = ICACHE_CC_CLACK;
+            break;
+        }
+                    
+        if ( not r_icache_miss_clack.read() ) // waiting cleanup acknowledge for victim line
+        {
+            if ( r_icache_miss_inval )    // Switch slot to ZOMBI state, and new cleanup
+            {
+                if ( not r_icache_cleanup_req.read() )	
+                {
+                    r_icache_cleanup_req    = true;
+                    r_icache_cleanup_line   = r_icache_vci_paddr.read() / (m_icache_words<<2);
+                    r_icache_cleanup_way    = r_icache_miss_way.read();
+                    r_icache_miss_inval     = false;
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+                    r_icache.write_dir( r_icache_vci_paddr.read(),
+                                        r_icache_miss_way.read(),
+                                        r_icache_miss_set.read(),
+                                        CACHE_SLOT_STATE_ZOMBI );
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " ICACHE_MISS_DIR_UPDT> Switch cache slot to ZOMBI state"
+              << " PADDR = " << std::hex << r_icache_vci_paddr.read()
+              << " WAY = " << std::dec << r_icache_miss_way.read()
+              << " SET = " << r_icache_miss_set.read() << std::endl;
+}
+#endif
+                }
+            }
+            else                          // Switch slot to VALID state
+            {
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+                r_icache.write_dir( r_icache_vci_paddr.read(),
+                                    r_icache_miss_way.read(),
+                                    r_icache_miss_set.read(),
+                                    CACHE_SLOT_STATE_VALID );
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " ICACHE_MISS_DIR_UPDT> Switch cache slot to VALID state"
+              << " PADDR = " << std::hex << r_icache_vci_paddr.read()
+              << " WAY = " << std::dec << r_icache_miss_way.read()
+              << " SET = " << r_icache_miss_set.read() << std::endl;
+}
+#endif
+            }   
+
+            r_icache_fsm = ICACHE_IDLE;
+        }
+        break;
+    }
+    ////////////////////
+    case ICACHE_UNC_WAIT:	// waiting a response to an uncacheable read from VCI_RSP FSM
+    {
+        // coherence interrupt
+        if ( r_tgt_icache_req.read() ) 
+        {
+            r_icache_fsm      = ICACHE_CC_CHECK;
+            r_icache_fsm_save = r_icache_fsm.read();
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_icache_req.read() )     
+        {
+            r_icache_fsm_save = r_icache_fsm.read();
+            r_icache_fsm = ICACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_ins_error.read() ) // bus error
+        {
+            r_mmu_ietr          = MMU_READ_DATA_ILLEGAL_ACCESS;    
+            r_mmu_ibvar         = m_ireq.addr;
+            r_vci_rsp_ins_error = false;
+            m_irsp.valid        = true;
+            m_irsp.error        = true;
+            r_icache_fsm        = ICACHE_IDLE;
+        }
+        else if (r_vci_rsp_fifo_icache.rok() ) // instruction available
+        {
+            vci_rsp_fifo_icache_get = true;
+            r_icache_fsm            = ICACHE_IDLE;
+            if ( m_ireq.valid and 
+                (m_ireq.addr == r_icache_vaddr_save.read()) ) // request unmodified
+            {
+                m_irsp.valid       = true;
+                m_irsp.instruction = r_vci_rsp_fifo_icache.read();
+            }
+        }	
+        break;
+    }
+    /////////////////////
+    case ICACHE_CC_CLACK:  	// This state is the entry point of the sub-fsm
+                            // handling the cleanup ack requests for ICACHE.
+                           	// We switch the directory slot to EMPTY state
+                            // and reset r_icache_miss_clack if the cleanup ack
+                            // is matching a pending miss
+    {
+        if ( m_ireq.valid ) m_cost_ins_miss_frz++;
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+        r_icache.write_dir( 0,
+                            r_cleanup_icache_way.read(),
+                            r_cleanup_icache_set.read(),
+                            CACHE_SLOT_STATE_EMPTY);
+
+        if ( (r_icache_miss_set.read() == r_cleanup_icache_set.read()) and
+             (r_icache_miss_way.read() == r_cleanup_icache_way.read()) )
+              r_icache_miss_clack = false;
+ 
+        r_icache_fsm = r_icache_fsm_save.read() ;
+
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " ICACHE_CC_CLACK> slot returns to empty state"
+              << " set = " << r_cleanup_icache_set.read()
+              << " / way = " << r_cleanup_icache_way.read() << std::endl;
+}
+#endif
+        
+        break;
+    }
+    /////////////////////
+    case ICACHE_CC_CHECK:   	// This state is the entry point of a sub-fsm
+                                // handling coherence requests.
+                                // if there is a matching pending miss, it is
+                                // signaled in the r_icache_miss_inval flip-flop.
+                                // The return state is defined in r_icache_fsm_save.
+    {
+        paddr_t  paddr = r_tgt_paddr.read();
+        paddr_t  mask  = ~((m_icache_words<<2)-1);
+
+        if( (r_icache_fsm_save.read() == ICACHE_MISS_WAIT) and
+                ((r_icache_vci_paddr.read() & mask) == (paddr & mask))) // matching 
+        {
+            // signaling the matching
+            r_icache_miss_inval   = true;
+
+            // coherence request completed, CC_ACK required if update  
+            r_tgt_icache_req      = false;
+            r_icache_tgt_need_rsp = (r_tgt_cc_type.read() == CC_TYPE_UPDT_INS);
+            r_icache_fsm          = r_icache_fsm_save.read();
+        }
+        else  								                            // no match
+        {
+            int	        state;
+            size_t 	    way;
+            size_t 	    set;
+            size_t 	    word;
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_read++;
+#endif
+            r_icache.read_dir(paddr, 
+                              &state,
+                              &way, 
+                              &set, 
+                              &word);
+
+            r_icache_cc_way = way;
+            r_icache_cc_set = set;
+
+            if ( state == CACHE_SLOT_STATE_VALID)            // hit  
+            {
+                if (r_tgt_cc_type.read() == CC_TYPE_UPDT_INS)  // hit update
+                {
+                    r_icache_fsm          = ICACHE_CC_UPDT;
+                    r_icache_cc_word      = r_tgt_word_min.read();
+                }
+                else if (r_tgt_cc_type == CC_TYPE_INVAL_INS)   // hit inval
+                {
+                    r_icache_fsm          = ICACHE_CC_INVAL;
+                }
+                else if ( r_tgt_cc_type == CC_TYPE_BROADCAST)  // hit broadcast
+                {
+                    r_icache_fsm          = ICACHE_CC_BROADCAST;                
+                }
+            }
+            else                                      // miss
+            {
+                // coherence request completed, CC_ACK required if update only 
+                r_tgt_icache_req      = false;
+                r_icache_tgt_need_rsp = (r_tgt_cc_type.read() == CC_TYPE_UPDT_INS);
+                r_icache_fsm          = r_icache_fsm_save.read();
+            }
+        }
+        break;
+    }
+    /////////////////////
+    case ICACHE_CC_INVAL:  	// hit inval : switch slot to EMPTY state
+    {                       
+
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " ICACHE_CC_INVAL> slot returns to empty state"
+              << " set = " << r_icache_cc_set.read()
+              << " / way = " << r_icache_cc_way.read() << std::endl;
+}
+#endif
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_read++;
+#endif
+        r_icache.write_dir( 0,
+	                        r_icache_cc_way.read(),
+	                        r_icache_cc_set.read(),
+                            CACHE_SLOT_STATE_EMPTY );
+
+        // coherence request completed, CC_ACK required if hit inval
+        r_tgt_icache_req      = false;
+        r_icache_tgt_need_rsp = true;
+        r_icache_fsm          = r_icache_fsm_save.read();
+        break;
+    }
+    ////////////////////
+    case ICACHE_CC_UPDT:	// hit update : write one word per cycle 
+    {
+
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " ICACHE_CC_UPDT> Write one word "
+              << " set = " << r_icache_cc_set.read()
+              << " / way = " << r_icache_cc_way.read() 
+              << " / word = " << r_icache_cc_word.read() << std::endl;
+}
+#endif
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_data_write++;
+#endif
+        size_t  word  = r_icache_cc_word.read();
+        size_t  way   = r_icache_cc_way.read();
+        size_t  set   = r_icache_cc_set.read();
+
+        r_icache.write( way,
+                        set,
+                        word,
+                        r_tgt_buf[word],
+                        r_tgt_be[word] );
+
+        r_icache_cc_word = word+1;
+
+        if ( word == r_tgt_word_max.read() )	// last word
+        {
+            // coherence operation request, CC_ACK required if hit update  
+            r_tgt_icache_req      = false;
+            r_icache_tgt_need_rsp = true;
+            r_icache_fsm          = r_icache_fsm_save.read();
+        }
+        break;
+    }
+    /////////////////////////
+    case ICACHE_CC_BROADCAST:  // hit broadcast : switch slot to ZOMBI state
+                               // and request a cleanup
+    {
+
+#if DEBUG_ICACHE
+if ( m_debug_icache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " ICACHE_CC_BROADCAST > Slot goes to zombi state "
+              << " set = " << r_icache_cc_set.read()
+              << " / way = " << r_icache_cc_way.read() << std::endl;
+}
+#endif
+
+#ifdef INSTRUMENTATION
+m_cpt_icache_dir_write++;
+#endif
+        r_icache.write_dir( 0,
+	                        r_icache_cc_way.read(),
+	                        r_icache_cc_set.read(),
+                            CACHE_SLOT_STATE_ZOMBI );
+	    
+        // coherence operation completed, no CC_ACK for hit broadcast
+        r_icache_tgt_need_rsp = false;
+        r_tgt_icache_req      = false;
+        r_icache_cleanup_req  = true;
+        r_icache_cleanup_line = r_tgt_paddr.read() / (m_icache_words<<2);
+        r_icache_cleanup_way  = r_icache_cc_way.read();
+        r_icache_fsm          = r_icache_fsm_save.read();
+        break;
+    }
+    } // end switch r_icache_fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //      DCACHE FSM 
+    //
+    // 1/ Coherence operations 
+    //    They are handled as interrupts generated by the CC_RECEIVE FSM.
+    //    - There is a coherence request when r_tgt_dcache_req is set.
+    //    They are taken in IDLE, MISS_WAIT, MISS_DIR_UPDT, UNC_WAIT, LL_WAIT 
+    //    and SC_WAIT states.
+    //    - There is a cleanup acknowledge request when r_cleanup_dcache_req is set. 
+    //    They are taken in IDLE, MISS_SELECT, MISS_CLEAN, MISS_WAIT, MISS_DATA_UPDT, 
+    //    MISS_DIR_UPDT, UNC_WAIT, LL_WAIT, SC_WAIT states.
+    //    - For both types of requests, actions associated to the pre-empted state 
+    //    are not executed. The DCACHE FSM goes to the proper sub-FSM (CC_CHECK 
+    //    or CC_CLACK) to execute the requested coherence operation, and returns 
+    //    to the pre-empted state.
+    //
+    // 2/ TLB miss
+    //    The page tables are generally cacheable.
+    //    In case of miss in itlb or dtlb, the tlb miss is handled by a dedicated
+    //    sub-fsm (DCACHE_TLB_MISS state), that handle possible miss in DCACHE,
+    //    this sub-fsm implement the table-walk...
+    //
+    // 3/ processor requests 
+    //    Processor requests are taken in IDLE state only.
+    //    The IDLE state implements a two stages pipe-line to handle write bursts:
+    //    - Both DTLB and DCACHE are accessed in stage P0 (if processor request valid).
+    //    - The registration in wbuf and the dcache update is done in stage P1
+    //      (if the processor request is a write).  
+    //    The two r_dcache_wbuf_req and r_dcache_updt_req flip-flops define
+    //    the operations that must be done in P1 stage, and the access type
+    //    (read or write) to the DATA part of DCACHE depends on r_dcache_updt_req.
+    //    READ requests are delayed if a cache update is requested.
+    //    WRITE or SC requests can require a PTE Dirty bit update (in memory), 
+    //    that is done (before handling the processor request) by a dedicated sub-fsm.
+    //    If a PTE is modified, both the itlb and dtlb are selectively, but sequencially
+    //    cleared by a dedicated sub_fsm (DCACHE_INVAL_TLB_SCAN state).
+    //
+    // 4/ Atomic instructions LL/SC
+    //    The LL/SC address are non cacheable (systematic access to memory).
+    //    The llsc buffer contains a registration for an active LL/SC operation 
+    //    (with an address, a registration key, an aging counter and a valid bit).
+    //    - LL requests from the processor are transmitted as a one flit VCI command
+    //      (CMD_LOCKED_READ as CMD, and TYPE_LL as PKTID value). PLEN must
+    //      be 8 as the response is 2 flits long (data and registration key) 
+    //    - SC requests from the processor are systematically transmitted to the 
+    //      memory cache as 2 flits VCI command (CMD_STORE_COND as CMD, and TYPE_SC 
+    //      as PKTID value).  The first flit contains the registration key, the second 
+    //      flit contains the data to write in case of success.
+    //      The cache is not updated, as this is done in case of success by the
+    //      coherence transaction.
+    //
+    // 5/ Non cacheable access:
+    //    This component implement a strong order between non cacheable access
+    //    (read or write) : A new non cacheable VCI transaction starts only when
+    //    the previous non cacheable transaction is completed. Both cacheable and
+    //    non cacheable transactions use the write buffer, but the DCACHE FSM registers
+    //    a non cacheable write transaction posted in the write buffer by setting the
+    //    r_dcache_pending_unc_write flip_flop. All other non cacheable requests
+    //    are stalled until this flip-flop is reset by the VCI_RSP_FSM (when the 
+    //    pending non cacheable write transaction completes).
+    //
+    // 6/ Error handling:  
+    //    When the MMU is not activated, Read Bus Errors are synchronous events, 
+    //    but Write Bus Errors are asynchronous events (processor is not frozen).
+    //    - If a Read Bus Error is detected, the VCI_RSP FSM sets the
+    //      r_vci_rsp_data_error flip-flop, without writing any data in the
+    //      r_vci_rsp_fifo_dcache FIFO, and the synchronous error is signaled
+    //      by the DCACHE FSM.
+    //    - If a Write Bus Error is detected, the VCI_RSP FSM  signals
+    //      the asynchronous error using the setWriteBerr() method.
+    //    When the MMU is activated bus error are rare events, as the MMU
+    //    checks the physical address before the VCI transaction starts.
+    ////////////////////////////////////////////////////////////////////////////////////////
+
+    // default value for m_drsp
+    m_drsp.valid = false;
+    m_drsp.error = false;
+    m_drsp.rdata = 0;
+
+    switch ( r_dcache_fsm.read() ) 
+    {
+    case DCACHE_IDLE: // There are 10 conditions to exit the IDLE state :
+                      // 1) ITLB/DTLB inval request (update)  => DCACHE_INVAL_TLB_SCAN
+                      // 2) Coherence request (TGT FSM)       => DCACHE_CC_CHECK 
+                      // 3) ITLB miss request (ICACHE FSM)    => DCACHE_TLB_MISS
+                      // 4) XTN request (processor)           => DCACHE_XTN_*
+                      // 5) DTLB miss (processor)             => DCACHE_TLB_MISS
+                      // 6) Dirty bit update (processor)      => DCACHE_DIRTY_GET_PTE
+                      // 7) Cacheable read miss (processor)   => DCACHE_MISS_SELECT
+                      // 8) Uncacheable read (processor)      => DCACHE_UNC_WAIT 
+                      // 9) LL access (processor)             => DCACHE_LL_WAIT
+                      // 10) SC access (processor)            => DCACHE_SC_WAIT
+                      //
+                      // There is a fixed priority to handle requests to DCACHE: 
+                      //    1/ the ITLB/DTLB invalidate requests
+                      //    2/ the coherence requests,
+                      //    3/ the processor requests (including DTLB miss), 
+                      //    4/ the ITLB miss requests,
+                      // The address space processor request are handled as follows:
+                      // - WRITE request is blocked if the Dirty bit mus be set.
+                      // If DTLB hit, the P1 stage is activated (writes WBUF, and
+                      // updates DCACHE if DCACHE hit) & processor request acknowledged.
+                      // - READ request generate a simultaneouss access to  DCACHE.DATA 
+                      // and DCACHE.DIR, but is delayed if DCACHE update required.
+                      //
+                      // There is 4 configurations defining the access type to
+                      // DTLB, DCACHE.DATA, and DCACHE.DIR, depending on the
+                      // dreq.valid (dreq) and r_dcache_updt_req (updt) signals:
+                      //    dreq / updt / DTLB  / DCACHE.DIR / DCACHE.DATA /                   
+                      //     0   /  0   / NOP   / NOP        / NOP         /
+                      //     0   /  1   / NOP   / NOP        / WRITE       /
+                      //     1   /  0   / READ  / READ       / NOP         /
+                      //     1   /  1   / READ  / READ       / WRITE       /
+                      // Those two registers are set at each cycle from the 3 signals
+                      // updt_request, wbuf_request, wbuf_write_miss.
+    { 
+        paddr_t     paddr;                          // physical address
+        pte_info_t 	tlb_flags; 
+        size_t     	tlb_way; 
+        size_t     	tlb_set; 
+        paddr_t    	tlb_nline; 
+        size_t		cache_way;
+        size_t		cache_set;
+        size_t		cache_word;
+        uint32_t	cache_rdata = 0;
+        bool	    tlb_hit = false;                     
+        int	        cache_state = CACHE_SLOT_STATE_EMPTY; 
+
+        bool        tlb_inval_required = false;     // request TLB inval after cache update
+        bool        wbuf_write_miss    = false;     // miss a WBUF write request
+        bool        updt_request       = false;     // request DCACHE update in P1 stage
+        bool        wbuf_request       = false;     // request WBUF write in P1 stage
+
+        // physical address computation : systematic DTLB access if activated)
+        if ( m_dreq.valid )
+        {
+            if ( r_mmu_mode.read() & DATA_TLB_MASK )  // DTLB activated
+            {
+                tlb_hit = r_dtlb.translate( m_dreq.addr,
+                                            &paddr,
+                                            &tlb_flags,
+                                            &tlb_nline,
+                                            &tlb_way,	
+                                            &tlb_set );	
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_read++;
+#endif
+            }
+            else                                    // identity mapping
+            {
+                paddr       = (paddr_t)m_dreq.addr;
+            }
+        } // end physical address computation
+
+        // systematic DCACHE access depending on r_dcache_updt_req (if activated)
+        if ( r_mmu_mode.read() & DATA_CACHE_MASK)  	
+        {
+            if ( m_dreq.valid and r_dcache_updt_req.read() ) // read DIR and write DATA
+            {
+                r_dcache.read_dir( paddr,
+                                   &cache_state,
+                                   &cache_way,
+                                   &cache_set,
+                                   &cache_word );
+
+                r_dcache.write( r_dcache_save_cache_way.read(),
+                                r_dcache_save_cache_set.read(),
+                                r_dcache_save_cache_word.read(),
+                                r_dcache_save_wdata.read(),
+                                r_dcache_save_be.read() );
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+m_cpt_dcache_data_write++;
+#endif
+            }
+            else if ( m_dreq.valid and not r_dcache_updt_req.read() ) // read DIR and DATA
+            {
+                r_dcache.read( paddr,
+                               &cache_rdata,
+                               &cache_way,
+                               &cache_set,
+                               &cache_word,
+                               &cache_state );
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+m_cpt_dcache_data_read++;
+#endif
+            }
+            else if ( not m_dreq.valid and r_dcache_updt_req.read() ) // write DATA
+            {
+                r_dcache.write( r_dcache_save_cache_way.read(),
+                                r_dcache_save_cache_set.read(),
+                                r_dcache_save_cache_word.read(),
+                                r_dcache_save_wdata.read(), 
+                                r_dcache_save_be.read() );
+#ifdef INSTRUMENTATION
+m_cpt_dcache_data_write++;
+#endif
+            }
+        } // end dcache access    
+
+        // DCACHE update in P1 stage can require ITLB / DTLB inval or flush
+        if ( r_dcache_updt_req.read() )
+        {
+            size_t way = r_dcache_save_cache_way.read();
+            size_t set = r_dcache_save_cache_set.read();
+
+            if ( r_dcache_in_tlb[way*m_dcache_sets+set] )
+            {
+                tlb_inval_required       = true;
+	            r_dcache_tlb_inval_set   = 0;
+	            r_dcache_tlb_inval_line  = r_dcache_save_paddr.read()>>
+                                           (uint32_log2(m_dcache_words<<2)); 
+	            r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+            }
+            else if ( r_dcache_contains_ptd[way*m_dcache_sets+set] )
+            {
+                r_itlb.reset();
+                r_dtlb.reset();
+	            r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+            }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_IDLE> Cache update in P1 stage" << std::dec
+              << " / WAY = " << r_dcache_save_cache_way.read() 
+              << " / SET = " << r_dcache_save_cache_set.read() 
+              << " / WORD = " << r_dcache_save_cache_word.read() << std::hex
+              << " / DATA = " << r_dcache_save_wdata.read()
+              << " / BE = " << r_dcache_save_be.read() << std::endl;
+}
+#endif
+        } // end test TLB inval
+
+        // Try WBUF update in P1 stage
+        // Miss if the write request is non cacheable, and there is a pending
+        // non cacheable write, or if the write buffer is full.
+        if ( r_dcache_updt_req.read() )
+        {
+            // miss if write not cacheable, and previous non cacheable write registered
+            if ( not r_dcache_save_cacheable.read() and r_dcache_pending_unc_write.read() ) 
+            {
+                wbuf_write_miss = true;
+            }
+            else		// try a registration into write buffer
+            {
+                bool wok = r_wbuf.write( r_dcache_save_paddr.read(),
+                                         r_dcache_save_be.read(),
+                                         r_dcache_save_wdata.read(),
+                                         r_dcache_save_cacheable.read() );
+#ifdef INSTRUMENTATION 
+m_cpt_wbuf_write++;
+#endif
+                if ( not wok ) // miss if write buffer full
+                {
+                    wbuf_write_miss = true;
+                }
+                else          // update the write_buffer state extension
+                {
+                    if(not r_dcache_pending_unc_write.read())
+                        r_dcache_pending_unc_write = not r_dcache_save_cacheable.read();
+                }
+            }
+        } // end WBUF update
+
+        // Computing the response to processor, 
+        // and the next value for r_dcache_fsm 
+
+        // itlb/dtlb invalidation self-request
+        if ( tlb_inval_required )
+        {
+            r_dcache_fsm_scan_save = r_dcache_fsm.read();
+            r_dcache_fsm           = DCACHE_INVAL_TLB_SCAN;
+        }
+
+        // coherence request (from CC_RECEIVE FSM)
+        else if ( r_tgt_dcache_req.read() )   
+        {
+            r_dcache_fsm_cc_save   = r_dcache_fsm.read();
+            r_dcache_fsm           = DCACHE_CC_CHECK;
+        }
+
+        // cleanup ack request (from CC_RECEIVE FSM)
+        else if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save   = r_dcache_fsm.read();
+            r_dcache_fsm           = DCACHE_CC_CLACK;
+        }
+
+        // processor request (READ, WRITE, LL, SC, XTN_READ, XTN_WRITE)
+        // we don't take the processor request, and registers
+        // are frozen in case of wbuf_write_miss
+        else if ( m_dreq.valid and not wbuf_write_miss )
+        {
+            // READ XTN requests from processor
+            // They are executed in this DCACHE_IDLE state.
+            // The processor must not be in user mode
+            if (m_dreq.type == iss_t::XTN_READ) 
+            {
+                int xtn_opcode = (int)m_dreq.addr/4;
+
+                // checking processor mode:
+                if (m_dreq.mode  == iss_t::MODE_USER)
+                {
+                    r_mmu_detr   = MMU_READ_PRIVILEGE_VIOLATION; 
+                    r_mmu_dbvar  = m_dreq.addr;
+                    m_drsp.valid = true;
+                    m_drsp.error = true;
+                    m_drsp.rdata = 0;
+                    r_dcache_fsm = DCACHE_IDLE;
+                }
+                else 
+                {
+                    switch( xtn_opcode ) 
+                    {
+                    case iss_t::XTN_INS_ERROR_TYPE:
+                        m_drsp.rdata = r_mmu_ietr.read();
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_DATA_ERROR_TYPE:
+                        m_drsp.rdata = r_mmu_detr.read();
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_INS_BAD_VADDR:
+                        m_drsp.rdata = r_mmu_ibvar.read();       
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_DATA_BAD_VADDR:
+                        m_drsp.rdata = r_mmu_dbvar.read();        
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_PTPR:
+                        m_drsp.rdata = r_mmu_ptpr.read();
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_TLB_MODE:
+                        m_drsp.rdata = r_mmu_mode.read();
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_MMU_PARAMS:
+                        m_drsp.rdata = r_mmu_params;
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_MMU_RELEASE:
+                        m_drsp.rdata = r_mmu_release;
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_MMU_WORD_LO:
+                        m_drsp.rdata = r_mmu_word_lo.read();
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    case iss_t::XTN_MMU_WORD_HI:
+                        m_drsp.rdata = r_mmu_word_hi.read();
+                        m_drsp.valid = true;
+                        m_drsp.error = false;
+                        break;
+
+                    default:
+                        r_mmu_detr = MMU_READ_UNDEFINED_XTN; 
+                        r_mmu_dbvar  = m_dreq.addr;
+                        m_drsp.valid = true;
+                        m_drsp.error = true;
+                        m_drsp.rdata = 0;
+                        break;
+                    } // end switch xtn_opcode
+                } // end else
+            } // end if XTN_READ
+
+            // Handling WRITE XTN requests from processor.
+            // They are not executed in this DCACHE_IDLE state
+            // if they require access to the caches or the TLBs
+            // that are already accessed.
+            // Caches can be invalidated or flushed in user mode,
+            // and the sync instruction can be executed in user mode
+            else if (m_dreq.type == iss_t::XTN_WRITE) 
+            {
+                int xtn_opcode      = (int)m_dreq.addr/4;
+                r_dcache_xtn_opcode = xtn_opcode;
+
+                // checking processor mode:
+                if ( (m_dreq.mode  == iss_t::MODE_USER) &&
+                     (xtn_opcode != iss_t:: XTN_SYNC) &&
+                     (xtn_opcode != iss_t::XTN_DCACHE_INVAL) &&
+                     (xtn_opcode != iss_t::XTN_DCACHE_FLUSH) &&
+                     (xtn_opcode != iss_t::XTN_ICACHE_INVAL) &&
+                     (xtn_opcode != iss_t::XTN_ICACHE_FLUSH) )
+                {
+                    r_mmu_detr   = MMU_WRITE_PRIVILEGE_VIOLATION; 
+                    r_mmu_dbvar  = m_dreq.addr;
+                    m_drsp.valid = true;
+                    m_drsp.error = true;
+                    m_drsp.rdata = 0;
+                    r_dcache_fsm = DCACHE_IDLE;
+                }
+                else
+                {
+                    switch( xtn_opcode ) 
+                    {     
+                    case iss_t::XTN_PTPR:   			// itlb & dtlb must be flushed
+                        r_dcache_xtn_req = true;
+                        r_dcache_fsm     = DCACHE_XTN_SWITCH;
+                        break;
+
+                    case iss_t::XTN_TLB_MODE:			// no cache or tlb access 
+                        r_mmu_mode       = m_dreq.wdata;
+                        m_drsp.valid     = true;
+                        r_dcache_fsm     = DCACHE_IDLE;
+                        break;
+
+                    case iss_t::XTN_DTLB_INVAL:     		// dtlb access
+                        r_dcache_fsm     = DCACHE_XTN_DT_INVAL;  
+                        break;
+
+                    case iss_t::XTN_ITLB_INVAL:     		// itlb access
+                        r_dcache_xtn_req = true;
+                        r_dcache_fsm     = DCACHE_XTN_IT_INVAL;  
+                        break;
+
+                    case iss_t::XTN_DCACHE_INVAL:   		// dcache, dtlb & itlb access
+                        r_dcache_fsm     = DCACHE_XTN_DC_INVAL_VA;
+                        break;
+
+                    case iss_t::XTN_MMU_DCACHE_PA_INV:  	// dcache, dtlb & itlb access
+                        r_dcache_fsm     = DCACHE_XTN_DC_INVAL_PA;
+                        if (sizeof(paddr_t) <= 32) 
+                        {
+                            assert(r_mmu_word_hi.read() == 0 &&
+                            "high bits should be 0 for 32bit paddr");
+                            r_dcache_save_paddr = (paddr_t)r_mmu_word_lo.read();
+                        } 
+                        else 
+                        {
+                            r_dcache_save_paddr = (paddr_t)r_mmu_word_hi.read() << 32 | 
+                                                  (paddr_t)r_mmu_word_lo.read();
+                        }
+                        break;
+
+                    case iss_t::XTN_DCACHE_FLUSH:   	       // itlb and dtlb must be reset  
+                        r_dcache_flush_count = 0;
+                        r_dcache_fsm     = DCACHE_XTN_DC_FLUSH; 
+                        break;
+
+                    case iss_t::XTN_ICACHE_INVAL:   		// icache and itlb access
+                        r_dcache_xtn_req = true;
+                        r_dcache_fsm     = DCACHE_XTN_IC_INVAL_VA; 
+                        break;
+
+                    case iss_t::XTN_MMU_ICACHE_PA_INV:		// icache access 
+                        r_dcache_xtn_req = true;
+                        r_dcache_fsm     = DCACHE_XTN_IC_INVAL_PA; 
+                        break;
+
+                    case iss_t::XTN_ICACHE_FLUSH:   		// icache access
+                        r_dcache_xtn_req = true; 
+                        r_dcache_fsm     = DCACHE_XTN_IC_FLUSH;
+                        break;
+
+                    case iss_t::XTN_SYNC:           		// wait until write buffer empty
+                        r_dcache_fsm     = DCACHE_XTN_SYNC;
+                        break;
+
+                    case iss_t::XTN_MMU_WORD_LO: 		// no cache or tlb access
+                        r_mmu_word_lo    = m_dreq.wdata;
+                        m_drsp.valid     = true;
+                        r_dcache_fsm     = DCACHE_IDLE;
+                        break;
+
+                    case iss_t::XTN_MMU_WORD_HI: 		// no cache or tlb access
+                        r_mmu_word_hi    = m_dreq.wdata;
+                        m_drsp.valid     = true;
+                        r_dcache_fsm     = DCACHE_IDLE;
+                        break;
+
+                    case iss_t::XTN_MMU_LL_RESET:      // no cache or tlb access
+                        r_dcache_llsc_valid = false;
+                        m_drsp.valid     = true;
+                        r_dcache_fsm     = DCACHE_IDLE;
+                    break;
+
+	                case iss_t::XTN_ICACHE_PREFETCH:		// not implemented : no action
+	                case iss_t::XTN_DCACHE_PREFETCH:		// not implemented : no action
+                        m_drsp.valid     = true;
+                        r_dcache_fsm     = DCACHE_IDLE;
+		            break;
+	
+                    default:
+                        r_mmu_detr   = MMU_WRITE_UNDEFINED_XTN; 
+                        r_mmu_dbvar  = m_dreq.addr;
+                        m_drsp.valid = true;
+                        m_drsp.error = true;
+                        r_dcache_fsm = DCACHE_IDLE;
+                        break;
+                    } // end switch xtn_opcode
+                } // end else 
+            } // end if XTN_WRITE
+
+            // Handling processor requests to address space (READ/WRITE/LL/SC)
+            // The dtlb and dcache can be activated or not.
+            // We compute the cacheability, and check processor request validity:
+            // - If DTLB not activated : cacheability is defined by the segment table,
+            //   and there is no access rights checking.
+            // - If DTLB activated : cacheability is defined by the C bit in the PTE,
+            //   and the U & W bits of the PTE are checked, as well as the DTLB hit. 
+            //   Jumps to the TLB_MISS sub-fsm in case of dtlb miss.
+            else
+            {
+                bool	    valid_req;
+                bool	    cacheable;
+
+                if ( not (r_mmu_mode.read() & DATA_TLB_MASK) )		// dtlb not activated 
+                {
+                    valid_req     = true;
+
+                    if ( not (r_mmu_mode.read() & DATA_CACHE_MASK) ) cacheable = false;
+                    else cacheable = m_cacheability_table[m_dreq.addr];
+                }
+                else 							                   // dtlb activated
+                {
+                    if ( tlb_hit )					// tlb hit
+                    {
+                        // cacheability
+                        if ( not (r_mmu_mode.read() & DATA_CACHE_MASK) ) cacheable = false;
+                        else cacheable = tlb_flags.c;
+
+                        // access rights checking 
+                        if ( not tlb_flags.u and (m_dreq.mode == iss_t::MODE_USER)) 
+                        {
+                            if ( (m_dreq.type == iss_t::DATA_READ) or 
+                                 (m_dreq.type == iss_t::DATA_LL) )
+                            {
+                                r_mmu_detr = MMU_READ_PRIVILEGE_VIOLATION;
+                            }
+                            else 
+                            {
+                                r_mmu_detr = MMU_WRITE_PRIVILEGE_VIOLATION;
+                            }
+                            valid_req    = false;
+                            r_mmu_dbvar  = m_dreq.addr;
+                            m_drsp.valid = true;
+                            m_drsp.error = true;
+                            m_drsp.rdata = 0;
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_IDLE> HIT in dtlb, but privilege violation" << std::endl;
+}
+#endif
+                        }
+                        else if ( not tlb_flags.w and 
+                                  ((m_dreq.type == iss_t::DATA_WRITE) or 
+                                   (m_dreq.type == iss_t::DATA_SC)) ) 
+                        {
+                            r_mmu_detr   = MMU_WRITE_ACCES_VIOLATION;  
+                            valid_req    = false;
+                            r_mmu_dbvar  = m_dreq.addr;
+                            m_drsp.valid = true;
+                            m_drsp.error = true;
+                            m_drsp.rdata = 0;
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_IDLE> HIT in dtlb, but writable violation" << std::endl;
+}
+#endif
+                        }
+                        else
+                        {
+                            valid_req    = true;
+                        }
+                    }
+                    else						// tlb miss
+                    {
+                        valid_req            = false;
+                        r_dcache_tlb_vaddr   = m_dreq.addr;
+                        r_dcache_tlb_ins     = false; 
+                        r_dcache_fsm         = DCACHE_TLB_MISS;
+                    }
+                }    // end DTLB activated
+
+                if ( valid_req ) 	// processor request is valid after TLB check
+                {
+                    // register processor request and DCACHE response
+                    r_dcache_save_vaddr      = m_dreq.addr;
+                    r_dcache_save_be         = m_dreq.be;
+                    r_dcache_save_wdata      = m_dreq.wdata;
+                    r_dcache_save_paddr      = paddr;
+                    r_dcache_save_cache_way  = cache_way;
+                    r_dcache_save_cache_set  = cache_set;
+                    r_dcache_save_cache_word = cache_word;
+                    r_dcache_save_cacheable  = cacheable;
+
+                    // READ request
+                    // The read requests are taken only if there is no cache update.
+                    // We request a VCI transaction to CMD FSM if miss or uncachable
+                    if ( ((m_dreq.type == iss_t::DATA_READ)) 
+                          and not r_dcache_updt_req.read() )
+                    { 
+                        if ( cacheable )           	// cacheable read
+                        {
+                            if ( cache_state == CACHE_SLOT_STATE_EMPTY )   // cache miss
+                            {
+#ifdef INSTRUMENTATION
+m_cpt_dcache_miss++;
+#endif
+                                // request a VCI DMISS transaction
+                                r_dcache_vci_paddr    = paddr;
+                                r_dcache_vci_miss_req = true;
+                                r_dcache_miss_type    = PROC_MISS;
+                                r_dcache_fsm          = DCACHE_MISS_SELECT;
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_IDLE> READ MISS in dcache" << std::endl;
+}
+#endif
+                            }
+                            else if (cache_state == CACHE_SLOT_STATE_ZOMBI ) // pending cleanup
+                            {
+                                // stalled until cleanup is acknowledged
+                                r_dcache_fsm   = DCACHE_IDLE;
+                            }
+                            else                                      // cache hit
+                            {
+#ifdef INSTRUMENTATION
+m_cpt_data_read++;
+#endif
+                                // returns data to processor
+                                m_drsp.valid   = true;
+                                m_drsp.error   = false;
+                                m_drsp.rdata   = cache_rdata;
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_IDLE> READ HIT in dcache" << std::endl;
+}
+#endif
+                            }
+                        }
+                        else					// uncacheable read
+                        {
+                            r_dcache_vci_paddr    = paddr;
+                            r_dcache_vci_unc_be   = m_dreq.be;
+                            r_dcache_vci_unc_req  = true;
+                            r_dcache_fsm          = DCACHE_UNC_WAIT;
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_IDLE> READ UNCACHEABLE in dcache" << std::endl;
+}
+#endif
+                        }
+                    } // end READ
+
+                    // LL request (non cachable)
+                    // We request a VCI LL transaction to CMD FSM and register
+                    // the LL/SC operation in llsc buffer.
+                    else if (m_dreq.type == iss_t::DATA_LL)
+                    {
+                        // register paddr in LLSC buffer 
+                        r_dcache_llsc_paddr = paddr;
+                        r_dcache_llsc_count = LLSC_TIMEOUT;
+                        r_dcache_llsc_valid = true;
+
+                        // request an LL VCI transaction and go to DCACHE_LL_WAIT state
+                        r_dcache_vci_ll_req   = true;
+                        r_dcache_vci_paddr    = paddr;
+                        r_dcache_ll_rsp_count = 0;
+                        r_dcache_fsm          = DCACHE_LL_WAIT;
+
+                    }// end LL
+
+                    // WRITE request:
+                    // If the TLB is activated and the PTE Dirty bit is not set, we stall 
+                    // the processor and set the Dirty bit before handling the write request,
+                    // going to the DCACHE_DIRTY_GT_PTE state.
+                    // If we don't need to set the Dirty bit, we can acknowledge
+                    // the processor request, as the write arguments (including the
+                    // physical address) are registered in r_dcache_save registers,
+                    // and the write will be done in the P1 pipeline stage.
+                    else if ( m_dreq.type == iss_t::DATA_WRITE )
+                    {
+                        if ( (r_mmu_mode.read() & DATA_TLB_MASK ) 
+                              and not tlb_flags.d )		// Dirty bit must be set
+                        {
+                            // The PTE physical address is obtained from the nline value (dtlb),
+                            // and from the virtual address (word index)
+                            if ( tlb_flags.b )	// PTE1
+                            {
+                                r_dcache_dirty_paddr = (paddr_t)(tlb_nline*(m_dcache_words<<2)) |
+                                                       (paddr_t)((m_dreq.addr>>19) & 0x3c);
+                            }
+                            else		// PTE2
+                            {
+                                r_dcache_dirty_paddr = (paddr_t)(tlb_nline*(m_dcache_words<<2)) |
+                                                       (paddr_t)((m_dreq.addr>>9) & 0x38);
+                            }
+                            r_dcache_fsm      = DCACHE_DIRTY_GET_PTE;
+                        }
+                        else					// Write request accepted
+                        {
+#ifdef INSTRUMENTATION
+m_cpt_data_write++;
+#endif
+                            // cleaning llsc buffer if address matching
+                            if ( paddr == r_dcache_llsc_paddr.read() )
+                                r_dcache_llsc_valid = false;
+
+                            // response to processor
+                            m_drsp.valid        = true;
+
+                            // activating P1 stage
+                            wbuf_request = true;
+                            updt_request = (cache_state == CACHE_SLOT_STATE_VALID);
+                        }
+                    } // end WRITE
+ 
+                    // SC request:
+                    // If the TLB is activated and the PTE Dirty bit is not set, we stall 
+                    // the processor and set the Dirty bit before handling the write request, 
+                    // going to the DCACHE_DIRTY_GT_PTE state.
+                    // If we don't need to set the Dirty bit, we test the llsc buffer:
+                    // If failure, we send a negative response to processor.
+                    // If success, we request a SC transaction to CMD FSM and go 
+                    // to DCACHE_SC_WAIT state.
+                    // We don't check a possible write hit in dcache, as the cache update 
+                    // is done by the coherence transaction induced by the SC...
+                    else if ( m_dreq.type == iss_t::DATA_SC )
+                    {
+                        if ( (r_mmu_mode.read() & DATA_TLB_MASK ) 
+                              and not tlb_flags.d )			// Dirty bit must be set
+                        {
+                            // The PTE physical address is obtained from the nline value (dtlb),
+                            // and the word index (virtual address)
+                            if ( tlb_flags.b )	// PTE1
+                            {
+                                r_dcache_dirty_paddr = (paddr_t)(tlb_nline*(m_dcache_words<<2)) |
+                                                       (paddr_t)((m_dreq.addr>>19) & 0x3c);
+                            }
+                            else			// PTE2
+                            {
+                                r_dcache_dirty_paddr = (paddr_t)(tlb_nline*(m_dcache_words<<2)) |
+                                                       (paddr_t)((m_dreq.addr>>9) & 0x38);
+                            }
+                            r_dcache_fsm           = DCACHE_DIRTY_GET_PTE;
+                            m_drsp.valid = false;
+                            m_drsp.error = false;
+                            m_drsp.rdata = 0;
+                        }
+                        else					// SC request accepted
+                        {
+#ifdef INSTRUMENTATION
+m_cpt_data_sc++;
+#endif
+                            // checking local success
+                            if( r_dcache_llsc_valid.read() and
+                                (r_dcache_llsc_paddr.read() == paddr) )  // local success
+                            {
+                                // request an SC CMD and go to DCACHE_SC_WAIT state
+                                r_dcache_vci_paddr   = paddr;
+                                r_dcache_vci_sc_req  = true;
+                                r_dcache_vci_sc_data = m_dreq.wdata;
+                                r_dcache_fsm         = DCACHE_SC_WAIT;
+                            }
+                            else                                          // local fail
+                            {
+	                            m_drsp.valid = true;
+	                            m_drsp.error = false;
+	                            m_drsp.rdata = 0x1;
+                            }
+                        }
+                    } // end SC
+                } // end valid_req
+            }  // end if read/write/ll/sc request	
+        } // end processor request
+        
+        // itlb miss request 
+    	else if ( r_icache_tlb_miss_req.read() )
+        {
+            r_dcache_tlb_ins    = true;
+            r_dcache_tlb_vaddr  = r_icache_vaddr_save.read();
+            r_dcache_fsm        = DCACHE_TLB_MISS;
+        }
+
+        // Computing requests for P1 stage : r_dcache_wbuf_req & r_dcache_updt_req
+        r_dcache_updt_req = updt_request; 
+        r_dcache_wbuf_req = wbuf_request or
+                            (r_dcache_wbuf_req.read() and wbuf_write_miss);  
+        break;
+    } 
+    /////////////////////
+    case DCACHE_TLB_MISS: // This is the entry point for the sub-fsm handling all tlb miss.
+                          // Input arguments are:
+                          // - r_dcache_tlb_vaddr
+                          // - r_dcache_tlb_ins (true when itlb miss) 
+                          // The sub-fsm access the dcache to find the missing TLB entry,
+                          // and activates the cache miss procedure in case of miss.
+                          // It bypass the first level page table access if possible.
+                          // It uses atomic access to update the R/L access bits
+                          // in the page table if required.
+                          // It directly updates the itlb or dtlb, and writes into the 
+                          // r_mmu_ins_* or r_mmu_data* error reporting registers.
+    {
+        uint32_t	ptba = 0;
+        bool		bypass;
+        paddr_t		pte_paddr;
+
+        // evaluate bypass in order to skip first level page table access
+        if ( r_dcache_tlb_ins.read() )				// itlb miss
+        {
+            bypass = r_itlb.get_bypass(r_dcache_tlb_vaddr.read(), &ptba);
+        }
+        else							// dtlb miss
+        {
+            bypass = r_dtlb.get_bypass(r_dcache_tlb_vaddr.read(), &ptba);
+        }
+
+        if ( not bypass )     // Try to read PTE1/PTD1 in dcache
+        {
+            pte_paddr = (paddr_t)r_mmu_ptpr.read() << (INDEX1_NBITS+2) |
+                        (paddr_t)((r_dcache_tlb_vaddr.read() >> PAGE_M_NBITS) << 2);
+            r_dcache_tlb_paddr = pte_paddr;
+            r_dcache_fsm       = DCACHE_TLB_PTE1_GET;
+        }
+        else                  // Try to read PTE2 in dcache
+        {
+            pte_paddr = (paddr_t)ptba << PAGE_K_NBITS |
+                        (paddr_t)(r_dcache_tlb_vaddr.read()&PTD_ID2_MASK)>>(PAGE_K_NBITS-3);
+            r_dcache_tlb_paddr = pte_paddr;
+            r_dcache_fsm       = DCACHE_TLB_PTE2_GET;
+        }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    if ( r_dcache_tlb_ins.read() ) 
+    {
+        std::cout << "  <PROC " << name() << ".DCACHE_TLB_MISS> ITLB miss";
+    }
+    else
+    {                           
+        std::cout << "  <PROC " << name() << ".DCACHE_TLB_MISS> DTLB miss";
+    }
+    std::cout << " / VADDR = " << std::hex << r_dcache_tlb_vaddr.read()
+              << " / BYPASS = " << bypass 
+              << " / PTE_ADR = " << pte_paddr << std::endl;
+}
+#endif
+  
+        break;
+    }
+    /////////////////////////  
+    case DCACHE_TLB_PTE1_GET:	// try to read a PT1 entry in dcache
+    {
+        uint32_t 	entry;
+        size_t		way;
+        size_t		set;
+        size_t		word;
+
+        bool     hit = r_dcache.read( r_dcache_tlb_paddr.read(),
+                                      &entry,
+                                      &way,
+                                      &set,
+                                      &word );
+#ifdef INSTRUMENTATION
+m_cpt_dcache_data_read++;
+m_cpt_dcache_dir_read++;
+#endif
+        if ( hit )	//  hit in dcache 
+        {
+            if ( not (entry & PTE_V_MASK) )	// unmapped
+            {
+                if ( r_dcache_tlb_ins.read() ) 
+                {
+                    r_mmu_ietr             = MMU_READ_PT1_UNMAPPED;
+                    r_mmu_ibvar            = r_dcache_tlb_vaddr.read();
+                    r_icache_tlb_miss_req  = false;
+                    r_icache_tlb_rsp_error = true;
+                }
+                else
+                {
+                    r_mmu_detr             = MMU_READ_PT1_UNMAPPED;
+                    r_mmu_dbvar            = r_dcache_tlb_vaddr.read();
+                    m_drsp.valid             = true;
+                    m_drsp.error             = true;
+                }
+                r_dcache_fsm          = DCACHE_IDLE;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_GET> HIT in dcache, but unmapped"
+              << std::hex << " / paddr = " << r_dcache_tlb_paddr.read()
+              << std::dec << " / way = " << way
+              << std::dec << " / set = " << set
+              << std::dec << " / word = " << word
+              << std::hex << " / PTE1 = " << entry << std::endl;
+}
+#endif
+  
+            }
+            else if( entry & PTE_T_MASK ) 	//  PTD : me must access PT2
+            {
+                // mark the cache line ac containing a PTD
+                r_dcache_contains_ptd[m_dcache_sets*way+set] = true;
+
+                // register bypass
+                if ( r_dcache_tlb_ins.read() )		// itlb
+                {
+                    r_itlb.set_bypass(r_dcache_tlb_vaddr.read(),
+                                      entry & ((1 << (m_paddr_nbits-PAGE_K_NBITS)) - 1), 
+                                      r_dcache_tlb_paddr.read() / (m_icache_words<<2) ); 
+                }
+                else					// dtlb
+                {
+                    r_dtlb.set_bypass(r_dcache_tlb_vaddr.read(),
+                                      entry & ((1 << (m_paddr_nbits-PAGE_K_NBITS)) - 1),
+                                      r_dcache_tlb_paddr.read() / (m_dcache_words<<2) );
+                }
+                r_dcache_tlb_paddr = 
+                    (paddr_t)(entry & ((1<<(m_paddr_nbits-PAGE_K_NBITS))-1)) << PAGE_K_NBITS |
+                    (paddr_t)(((r_dcache_tlb_vaddr.read() & PTD_ID2_MASK) >> PAGE_K_NBITS) << 3);
+                r_dcache_fsm       = DCACHE_TLB_PTE2_GET;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_GET> HIT in dcache"
+              << std::hex << " / paddr = " << r_dcache_tlb_paddr.read()
+              << std::dec << " / way = " << way
+              << std::dec << " / set = " << set
+              << std::dec << " / word = " << word
+              << std::hex << " / PTD = " << entry << std::endl;
+}
+#endif
+            }
+            else			//  PTE1 :  we must update the TLB
+            {
+                r_dcache_in_tlb[m_icache_sets*way+set] = true;
+                r_dcache_tlb_pte_flags  = entry;
+                r_dcache_tlb_cache_way  = way;
+                r_dcache_tlb_cache_set  = set;
+                r_dcache_tlb_cache_word = word;
+                r_dcache_fsm            = DCACHE_TLB_PTE1_SELECT;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_GET> HIT in dcache"
+              << std::hex << " / paddr = " << r_dcache_tlb_paddr.read()
+              << std::dec << " / way = " << way
+              << std::dec << " / set = " << set
+              << std::dec << " / word = " << word
+              << std::hex << " / PTE1 = " << entry << std::endl;
+}
+#endif
+            }
+        }
+        else		// we must load the missing cache line in dcache
+        {
+            r_dcache_vci_miss_req  = true;		
+            r_dcache_vci_paddr     = r_dcache_tlb_paddr.read(); 
+            r_dcache_miss_type     = PTE1_MISS;
+            r_dcache_fsm           = DCACHE_MISS_SELECT;	 
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_GET> MISS in dcache:"
+              << " PTE1 address = " << std::hex << r_dcache_tlb_paddr.read() << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    ////////////////////////////
+    case DCACHE_TLB_PTE1_SELECT:	// select a slot for PTE1 
+    {
+        size_t 	way;
+        size_t 	set;
+
+        if ( r_dcache_tlb_ins.read() )
+        {
+            r_itlb.select( r_dcache_tlb_vaddr.read(),
+                           true,  // PTE1 
+                           &way,
+                           &set );
+#ifdef INSTRUMENTATION
+m_cpt_itlb_read++;
+#endif
+        }
+        else
+        {
+            r_dtlb.select( r_dcache_tlb_vaddr.read(),
+                           true,  // PTE1 
+                           &way,
+                           &set );
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_read++;
+#endif
+        }
+        r_dcache_tlb_way = way;
+        r_dcache_tlb_set = set;
+        r_dcache_fsm     = DCACHE_TLB_PTE1_UPDT;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    if ( r_dcache_tlb_ins.read() ) 
+        std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_SELECT> Select a slot in ITLB:";
+    else                           
+        std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_SELECT> Select a slot in DTLB:";
+        std::cout << " way = " << std::dec << way
+                  << " / set = " << set << std::endl;
+}
+#endif
+        break;
+    }
+    //////////////////////////
+    case DCACHE_TLB_PTE1_UPDT:	// write a new PTE1 in tlb after testing the L/R bit
+                                // - if L/R bit already set, exit the sub-fsm.
+                                // - if not, we update the page table but we dont write
+                                //   neither in DCACHE, nor in TLB, as this will be done by
+                                //   the coherence mechanism.
+    {
+        paddr_t	  nline    = r_dcache_tlb_paddr.read() >> (uint32_log2(m_dcache_words)+2);   
+        uint32_t  pte      = r_dcache_tlb_pte_flags.read();
+        bool	  pt_updt  = false;
+        bool	  local    = true;
+
+        // We should compute the access locality: 
+        // The PPN MSB bits define the destination cluster index.
+        // The m_srcid_d MSB bits define the source cluster index.
+        // The number of bits to compare depends on the number of clusters, 
+        // and can be obtained in the mapping table.
+        // As long as this computation is not done, all access are local.
+
+        if ( local )						// local access
+        {
+            if ( not ((pte & PTE_L_MASK) == PTE_L_MASK) ) // we must set the L bit
+            {
+                pt_updt                = true;
+                r_dcache_vci_cas_old    = pte;
+                r_dcache_vci_cas_new    = pte | PTE_L_MASK;
+                pte                    = pte | PTE_L_MASK;
+                r_dcache_tlb_pte_flags = pte;
+            }
+        }
+        else 							// remote access
+        {
+            if ( not ((pte & PTE_R_MASK) == PTE_R_MASK) ) // we must set the R bit
+            {
+                pt_updt                = true;
+                r_dcache_vci_cas_old    = pte;
+                r_dcache_vci_cas_new    = pte | PTE_R_MASK;
+                pte                    = pte | PTE_R_MASK;
+                r_dcache_tlb_pte_flags = pte;
+            }
+        }
+
+        if ( not pt_updt )					// update TLB and return
+        {
+            if ( r_dcache_tlb_ins.read() )  
+            {
+                r_itlb.write( true,		// 2M page
+                              pte,
+                              0,		// argument unused for a PTE1
+                              r_dcache_tlb_vaddr.read(),    
+                              r_dcache_tlb_way.read(), 
+                              r_dcache_tlb_set.read(),
+                              nline );
+#ifdef INSTRUMENTATION
+m_cpt_itlb_write++;
+#endif
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_UPDT> write PTE1 in ITLB";
+    std::cout << " / set = " << std::dec << r_dcache_tlb_set.read()
+              << " / way = " << r_dcache_tlb_way.read() << std::endl;
+    r_itlb.printTrace();
+}
+#endif
+            }
+            else
+            {
+                r_dtlb.write( true,		// 2M page
+                              pte,
+                              0,		// argument unused for a PTE1
+                              r_dcache_tlb_vaddr.read(),    
+                              r_dcache_tlb_way.read(), 
+                              r_dcache_tlb_set.read(),
+                              nline );
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_write++;
+#endif
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_UPDT> write PTE1 in DTLB";
+    std::cout << " / set = " << std::dec << r_dcache_tlb_set.read()
+              << " / way = " << r_dcache_tlb_way.read() << std::endl;
+    r_dtlb.printTrace();
+}
+#endif
+            }
+            r_dcache_fsm = DCACHE_TLB_RETURN;
+        }
+        else                            // update page table but not TLB
+        {
+            r_dcache_fsm = DCACHE_TLB_LR_UPDT; 
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE1_UPDT> L/R bit update required"
+              << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    /////////////////////////
+    case DCACHE_TLB_PTE2_GET:	// Try to get a PTE2 (64 bits) in the dcache
+    {
+        uint32_t 	pte_flags;
+        uint32_t 	pte_ppn;
+        size_t   	way;
+        size_t   	set;
+        size_t		word; 
+ 
+        bool     hit = r_dcache.read( r_dcache_tlb_paddr.read(),
+                                      &pte_flags,
+                                      &pte_ppn,
+                                      &way,
+                                      &set,
+                                      &word );
+#ifdef INSTRUMENTATION
+m_cpt_dcache_data_read++;
+m_cpt_dcache_dir_read++;
+#endif
+        if ( hit )      // request hits in dcache 
+        {
+            if ( not (pte_flags & PTE_V_MASK) )	// unmapped
+            {
+                if ( r_dcache_tlb_ins.read() ) 
+                {
+                    r_mmu_ietr             = MMU_READ_PT2_UNMAPPED;
+                    r_mmu_ibvar            = r_dcache_tlb_vaddr.read();
+                    r_icache_tlb_miss_req  = false;
+                    r_icache_tlb_rsp_error = true;
+                }
+                else
+                {
+                    r_mmu_detr             = MMU_READ_PT2_UNMAPPED;
+                    r_mmu_dbvar            = r_dcache_tlb_vaddr.read();
+                    m_drsp.valid             = true;
+                    m_drsp.error             = true;
+                }
+                r_dcache_fsm          = DCACHE_IDLE;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_PTE2_GET> HIT in dcache, but PTE is unmapped"
+              << " PTE_FLAGS = " << std::hex << pte_flags 
+              << " PTE_PPN = " << std::hex << pte_ppn << std::endl;
+}
+#endif
+            }
+            else				// mapped : we must update the TLB
+            {
+                r_dcache_in_tlb[m_dcache_sets*way+set] = true;
+                r_dcache_tlb_pte_flags  = pte_flags;
+                r_dcache_tlb_pte_ppn    = pte_ppn;
+                r_dcache_tlb_cache_way  = way;
+                r_dcache_tlb_cache_set  = set;
+                r_dcache_tlb_cache_word = word;
+                r_dcache_fsm            = DCACHE_TLB_PTE2_SELECT;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() << ".DCACHE_TLB_PTE2_GET> HIT in dcache:"
+              << " PTE_FLAGS = " << std::hex << pte_flags 
+              << " PTE_PPN = " << std::hex << pte_ppn << std::endl;
+}
+#endif
+             }
+        }
+        else            // we must load the missing cache line in dcache
+        {
+            r_dcache_fsm          = DCACHE_MISS_SELECT; 
+            r_dcache_vci_miss_req = true;
+            r_dcache_vci_paddr    = r_dcache_tlb_paddr.read();
+            r_dcache_miss_type    = PTE2_MISS;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_PTE2_GET> MISS in dcache:"
+              << " PTE address = " << std::hex << r_dcache_tlb_paddr.read() << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    ////////////////////////////
+    case DCACHE_TLB_PTE2_SELECT:    // select a slot for PTE2
+    {
+        size_t way;
+        size_t set;
+
+        if ( r_dcache_tlb_ins.read() )
+        {
+            r_itlb.select( r_dcache_tlb_vaddr.read(),
+                           false,	// PTE2 
+                           &way,
+                           &set );
+#ifdef INSTRUMENTATION
+m_cpt_itlb_read++;
+#endif
+        }
+        else
+        {
+            r_dtlb.select( r_dcache_tlb_vaddr.read(),
+                           false,	// PTE2 
+                           &way,
+                           &set );
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_read++;
+#endif
+        }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    if ( r_dcache_tlb_ins.read() ) 
+        std::cout << "  <PROC " << name() 
+                  << " DCACHE_TLB_PTE2_SELECT> Select a slot in ITLB:";
+    else                           
+        std::cout << "  <PROC " << name() 
+                  << " DCACHE_TLB_PTE2_SELECT> Select a slot in DTLB:";
+        std::cout << " way = " << std::dec << way
+                  << " / set = " << set << std::endl;
+}
+#endif
+        r_dcache_tlb_way = way;
+        r_dcache_tlb_set = set;
+        r_dcache_fsm     = DCACHE_TLB_PTE2_UPDT;
+        break;
+    }
+    //////////////////////////
+    case DCACHE_TLB_PTE2_UPDT:	// write a new PTE2 in tlb after testing the L/R bit
+                                // - if L/R bit already set, exit the sub-fsm.
+                                // - if not, we update the page table but we dont write
+                                //   neither in DCACHE, nor in TLB, as this will be done by
+                                //   the coherence mechanism.
+    {
+        paddr_t	        nline     = r_dcache_tlb_paddr.read() >> (uint32_log2(m_dcache_words)+2);   
+        uint32_t        pte_flags = r_dcache_tlb_pte_flags.read();
+        uint32_t        pte_ppn   = r_dcache_tlb_pte_ppn.read();
+        bool            pt_updt   = false;
+        bool            local     = true;
+
+        // We should compute the access locality: 
+        // The PPN MSB bits define the destination cluster index.
+        // The m_srcid_d MSB bits define the source cluster index.
+        // The number of bits to compare depends on the number of clusters, 
+        // and can be obtained in the mapping table.
+        // As long as this computation is not done, all access are local.
+
+        if ( local )						// local access
+        {
+            if ( not ((pte_flags & PTE_L_MASK) == PTE_L_MASK) ) // we must set the L bit
+            {
+                pt_updt                = true;
+                r_dcache_vci_cas_old    = pte_flags;
+                r_dcache_vci_cas_new    = pte_flags | PTE_L_MASK;
+                pte_flags              = pte_flags | PTE_L_MASK;
+		        r_dcache_tlb_pte_flags = pte_flags;
+            }
+        }
+        else                                                    // remote access
+        {
+            if ( not ((pte_flags & PTE_R_MASK) == PTE_R_MASK) ) // we must set the R bit
+            {
+                pt_updt                = true;
+                r_dcache_vci_cas_old    = pte_flags;
+                r_dcache_vci_cas_new    = pte_flags | PTE_R_MASK;
+                pte_flags              = pte_flags | PTE_R_MASK;
+		        r_dcache_tlb_pte_flags = pte_flags;
+            }
+        }
+        
+        if ( not pt_updt )                       // update TLB 
+        {
+            if ( r_dcache_tlb_ins.read() )  
+            {
+                r_itlb.write( false,	// 4K page
+                              pte_flags,
+                              pte_ppn,
+                              r_dcache_tlb_vaddr.read(),    
+                              r_dcache_tlb_way.read(), 
+                              r_dcache_tlb_set.read(),
+                              nline );
+#ifdef INSTRUMENTATION
+m_cpt_itlb_write++;
+#endif
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_PTE2_UPDT> write PTE2 in ITLB"
+              << " / set = " << std::dec << r_dcache_tlb_set.read()
+              << " / way = " << r_dcache_tlb_way.read() << std::endl;
+    r_itlb.printTrace();
+}
+#endif
+            }
+            else
+            {
+                r_dtlb.write( false,	// 4K page
+                              pte_flags,
+                              pte_ppn,
+                              r_dcache_tlb_vaddr.read(),    
+                              r_dcache_tlb_way.read(), 
+                              r_dcache_tlb_set.read(),
+                              nline );
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_write++;
+#endif
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_PTE2_UPDT> write PTE2 in DTLB"
+              << " / set = " << std::dec << r_dcache_tlb_set.read()
+              << " / way = " << r_dcache_tlb_way.read() << std::endl;
+    r_dtlb.printTrace();
+}
+#endif
+
+            }
+            r_dcache_fsm = DCACHE_TLB_RETURN;
+        }
+        else                                   // update page table but not TLB
+        {
+            r_dcache_fsm = DCACHE_TLB_LR_UPDT; 	// dcache and page table update
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_PTE2_UPDT> L/R bit update required" << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    ////////////////////////
+    case DCACHE_TLB_LR_UPDT:        // request a CAS transaction to update L/R bit
+    {
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_LR_UPDT> Update dcache: (L/R) bit" << std::endl;
+}
+#endif
+        // r_dcache_vci_cas_old & r_dcache_vci_cas_new registers are already set
+        r_dcache_vci_paddr = r_dcache_tlb_paddr.read();
+
+        // checking llsc reservation buffer
+        if ( r_dcache_llsc_paddr.read() == r_dcache_tlb_paddr.read() )
+            r_dcache_llsc_valid = false;
+
+        // request a CAS CMD and go to DCACHE_TLB_LR_WAIT state
+        r_dcache_vci_cas_req = true;
+        r_dcache_fsm         = DCACHE_TLB_LR_WAIT;
+        break;
+    }
+    ////////////////////////
+    case DCACHE_TLB_LR_WAIT:		// Waiting the response to SC transaction for DIRTY bit.
+                                    // We consume the response in rsp FIFO, 
+                                    // and exit the sub-fsm, but we don't
+                                    // analyse the response, because we don't
+                                    // care if the L/R bit update is not done.
+                                    // We must take the coherence requests because
+                                    // there is a risk of dead-lock
+
+    {
+        // external coherence request
+        if ( r_tgt_dcache_req )
+        {
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            break;
+        }
+
+        if ( r_vci_rsp_data_error.read() ) 	// bus error
+        {
+            std::cout << "BUS ERROR in DCACHE_TLB_LR_WAIT state" << std::endl;
+            std::cout << "This should not happen in this state" << std::endl;
+            exit(0);
+        }
+	else if ( r_vci_rsp_fifo_dcache.rok() ) // response available
+	{
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_LR_WAIT> SC response received" << std::endl;
+}
+#endif
+            vci_rsp_fifo_dcache_get = true;     
+            r_dcache_fsm            = DCACHE_TLB_RETURN;
+        }
+        break;
+    }
+    ///////////////////////
+    case DCACHE_TLB_RETURN:		// return to caller depending on tlb miss type
+    {
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_TLB_RETURN> TLB MISS completed" << std::endl;
+}
+#endif
+        if ( r_dcache_tlb_ins.read() ) r_icache_tlb_miss_req = false;
+        r_dcache_fsm = DCACHE_IDLE;
+        break;
+    }
+    ///////////////////////
+    case DCACHE_XTN_SWITCH:		// The r_ptpr registers must be written,
+                                // and both itlb and dtlb must be flushed.
+                                // Caution : the itlb miss requests must be taken 
+                                // to avoid dead-lock in case of simultaneous ITLB miss
+    {
+        // itlb miss request
+        if ( r_icache_tlb_miss_req.read() )
+        {
+            r_dcache_tlb_ins    = true;
+            r_dcache_tlb_vaddr  = r_icache_vaddr_save.read();
+            r_dcache_fsm        = DCACHE_TLB_MISS;
+            break;
+        }
+
+        if ( not r_dcache_xtn_req.read() )
+        {
+            r_dtlb.flush();
+            r_mmu_ptpr   = m_dreq.wdata;
+            r_dcache_fsm = DCACHE_IDLE;
+            m_drsp.valid = true;
+        }
+        break;
+    }
+    /////////////////////
+    case DCACHE_XTN_SYNC:		// waiting until write buffer empty
+                                // The coherence request must be taken
+                                // as there is a risk of dead-lock
+    {
+        // external coherence request 
+        if ( r_tgt_dcache_req.read() )   
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+        }        
+
+        if ( r_wbuf.empty() )
+        {
+            m_drsp.valid   = true;
+            r_dcache_fsm = DCACHE_IDLE;
+        }
+        break;
+    }
+    ////////////////////////
+    case DCACHE_XTN_IC_FLUSH:		// Waiting completion of an XTN request to the ICACHE FSM
+    case DCACHE_XTN_IC_INVAL_VA:	// Caution : the itlb miss requests must be taken 
+    case DCACHE_XTN_IC_INVAL_PA:	// because the XTN_ICACHE_INVAL request to icache
+    case DCACHE_XTN_IT_INVAL:		// can generate an itlb miss,
+                                    // and because it can exist a simultaneous ITLB miss
+    {
+        // external coherence request
+        if ( r_tgt_dcache_req )   
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }  
+
+        // itlb miss request
+        if ( r_icache_tlb_miss_req.read() )
+        {
+            r_dcache_tlb_ins    = true;
+            r_dcache_tlb_vaddr  = r_icache_vaddr_save.read();
+            r_dcache_fsm        = DCACHE_TLB_MISS;
+            break;
+        }
+
+        // test if XTN request to icache completed
+        if ( not r_dcache_xtn_req.read() ) 
+        {
+            r_dcache_fsm = DCACHE_IDLE;
+            m_drsp.valid = true;
+        }
+        break;
+    }
+    /////////////////////////
+    case DCACHE_XTN_DC_FLUSH:	// Invalidate sequencially all cache lines, using
+                                // r_dcache_flush_count as a slot counter,
+                                // looping in this state until all slots have been visited.
+                                // It can require two cycles per slot:
+                                // We test here the slot state, and make the actual inval
+                                // (if line is valid) in DCACHE_XTN_DC_FLUSH_GO state.
+                                // A cleanup request is generated for each valid line. 
+                                // returns to IDLE and flush TLBs when last slot
+    {
+        if ( not r_dcache_cleanup_req.read() ) // blocked until previous cleanup is sent
+        {
+            int       state;
+            uint32_t  tag;
+            size_t    way = r_dcache_flush_count.read()/m_dcache_sets;
+            size_t    set = r_dcache_flush_count.read()%m_dcache_sets;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+#endif
+            r_dcache.read_dir( way,
+                               set,
+                               &tag,
+                               &state );
+
+            if ( state == CACHE_SLOT_STATE_VALID )         // inval required
+            {
+                // request cleanup
+                r_dcache_cleanup_req  = true;
+                r_dcache_cleanup_line = tag * m_icache_sets;
+                r_dcache_cleanup_way  = way;
+
+                // goes to DCACHE_XTN_DC_FLUSH_GO to inval directory
+                r_dcache_miss_way     = way;
+                r_dcache_miss_set     = set;
+                r_dcache_fsm          = DCACHE_XTN_DC_FLUSH_GO;
+            }
+            else if ( r_dcache_flush_count.read() == 
+                      (m_dcache_sets*m_dcache_ways - 1) )  // last slot
+            {
+                r_dtlb.reset();    
+                r_itlb.reset(); 
+                r_dcache_fsm = DCACHE_IDLE;
+                m_drsp.valid = true;
+            }
+
+            // saturation counter
+            if ( r_dcache_flush_count.read() < (m_dcache_sets*m_dcache_ways - 1) )  
+                r_dcache_flush_count = r_dcache_flush_count.read() + 1;
+        }
+        break;
+    }
+    ////////////////////////////
+    case DCACHE_XTN_DC_FLUSH_GO:    // Switch the cache slot to ZOMBI state
+                                    // and reset directory extension.
+                                    // returns to IDLE and flush TLBs when last slot
+    {
+        size_t way = r_dcache_miss_way.read();
+        size_t set = r_dcache_miss_set.read();
+
+        r_dcache_in_tlb[m_dcache_sets*way+set]       = false;
+        r_dcache_contains_ptd[m_dcache_sets*way+set] = false;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_write++;
+#endif
+        r_dcache.write_dir( 0,
+                            way,
+                            set,
+                            CACHE_SLOT_STATE_ZOMBI );
+
+        if ( r_dcache_flush_count.read() == 
+             (m_dcache_sets*m_dcache_ways - 1) )  // last slot 
+        {
+            r_dtlb.reset();    
+            r_itlb.reset(); 
+            r_dcache_fsm = DCACHE_IDLE;
+            m_drsp.valid = true;
+        }
+        else
+        {
+            r_dcache_fsm = DCACHE_XTN_DC_FLUSH;
+        }
+        break;
+    }
+    /////////////////////////
+    case DCACHE_XTN_DT_INVAL: 	// handling processor XTN_DTLB_INVAL request
+    {
+        r_dtlb.inval(r_dcache_save_wdata.read());
+        r_dcache_fsm        = DCACHE_IDLE;
+        m_drsp.valid          = true;
+        break;
+    }
+    ////////////////////////////
+    case DCACHE_XTN_DC_INVAL_VA:  // selective cache line invalidate with virtual address
+                                  // requires 3 cycles: access tlb, read cache, inval cache
+                               	  // we compute the physical address in this state 
+    {
+        paddr_t paddr;
+        bool    hit;
+
+        if ( r_mmu_mode.read() & DATA_TLB_MASK ) 	// dtlb activated
+        {
+
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_read++;
+#endif
+            hit = r_dtlb.translate( r_dcache_save_wdata.read(),
+                                    &paddr ); 
+        }
+        else 						// dtlb not activated
+        {
+            paddr = (paddr_t)r_dcache_save_wdata.read();
+            hit   = true;
+        }
+
+        if ( hit )		// tlb hit
+        {
+            r_dcache_save_paddr = paddr;
+            r_dcache_fsm      = DCACHE_XTN_DC_INVAL_PA;
+        }
+        else			// tlb miss
+       	{
+
+#ifdef INSTRUMENTATION
+m_cpt_dtlb_miss++;
+#endif
+            r_dcache_tlb_ins    = false;		// dtlb
+            r_dcache_tlb_vaddr  = r_dcache_save_wdata.read();
+            r_dcache_fsm        = DCACHE_TLB_MISS; 
+        } 
+  
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_XTN_DC_INVAL_VA> Compute physical address" << std::hex
+              << " / VADDR = " << r_dcache_save_wdata.read()
+              << " / PADDR = " << paddr << std::endl;
+}
+#endif
+
+        break;
+    }
+    ////////////////////////////
+    case DCACHE_XTN_DC_INVAL_PA:  // selective cache line invalidate with physical address
+                                  // requires 2 cycles: read cache / inval cache
+                                  // In this state we read dcache.
+    {
+        size_t		way;
+        size_t		set;
+        size_t		word;
+        int         state;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+#endif
+        r_dcache.read_dir( r_dcache_save_paddr.read(),
+                           &state,
+                           &way,
+                           &set,
+                           &word );
+
+        if ( state == CACHE_SLOT_STATE_VALID )	// inval to be done
+        {
+            r_dcache_xtn_way = way;
+            r_dcache_xtn_set = set;
+            r_dcache_fsm      = DCACHE_XTN_DC_INVAL_GO;
+        }
+        else		// miss : nothing to do
+        {
+            r_dcache_fsm      = DCACHE_IDLE;
+            m_drsp.valid        = true;
+        }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_XTN_DC_INVAL_PA> Test hit in dcache" << std::hex
+              << " / PADDR = " << r_dcache_save_paddr.read() << std::dec
+              << " / HIT = " << (state == CACHE_SLOT_STATE_VALID)
+              << " / SET = " << set
+              << " / WAY = " << way << std::endl;
+}
+#endif
+        break;
+    }
+    ////////////////////////////
+    case DCACHE_XTN_DC_INVAL_GO:  // In this state, we invalidate the cache line 
+        			              // Blocked if previous cleanup not completed
+                                  // Test if itlb or dtlb inval is required    
+    {
+        if ( not r_dcache_cleanup_req.read() )
+        {
+            size_t	way        = r_dcache_xtn_way.read();
+            size_t	set        = r_dcache_xtn_set.read();
+            paddr_t nline      = r_dcache_save_paddr.read() / (m_dcache_words<<2);
+   
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_write++;
+#endif
+            r_dcache.write_dir( 0,
+                                way,
+                                set,
+                                CACHE_SLOT_STATE_EMPTY );
+
+            // request cleanup
+            r_dcache_cleanup_req  = true;
+            r_dcache_cleanup_line = nline;
+            r_dcache_cleanup_way  = way;
+	    
+            // possible itlb & dtlb invalidate 
+            if ( r_dcache_in_tlb[way*m_dcache_sets+set] ) 
+            {
+                r_dcache_tlb_inval_line = nline; 
+                r_dcache_tlb_inval_set  = 0;
+                r_dcache_fsm_scan_save  = DCACHE_XTN_DC_INVAL_END;
+                r_dcache_fsm            = DCACHE_INVAL_TLB_SCAN;
+                r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+            }
+            else if ( r_dcache_contains_ptd[way*m_dcache_sets+set] ) 
+            {
+                r_itlb.reset();
+                r_dtlb.reset();
+                r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+                r_dcache_fsm = DCACHE_IDLE;
+                m_drsp.valid = true;
+            }
+            else
+            {
+                r_dcache_fsm = DCACHE_IDLE;
+                m_drsp.valid = true;
+            }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_XTN_DC_INVAL_GO> Actual dcache inval" << std::hex
+              << " / PADDR = " << r_dcache_save_paddr.read() << std::endl;
+}
+#endif
+	    }
+        break;
+    }
+    //////////////////////////////
+    case DCACHE_XTN_DC_INVAL_END:  	// send response to processor XTN request
+    {
+        r_dcache_fsm = DCACHE_IDLE;
+        m_drsp.valid = true;
+        break;
+    }
+    ////////////////////////
+    case DCACHE_MISS_SELECT:   // Try to select a slot in associative set
+                               // if previous cleanup has been sent.
+                               // Waiting in this state if no slot available
+                               // Set the r_dcache_cleanup_req flip-flop 
+                               // and the r_dcache_miss_clack flip-flop
+                               // when a cleanup is required
+    {
+        if ( m_dreq.valid) m_cost_data_miss_frz++;
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( not r_dcache_cleanup_req.read() ) 
+        {
+            bool     found;
+            bool     cleanup;
+            size_t   way;
+            size_t   set;
+            paddr_t  victim;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+#endif
+            r_dcache.read_select( r_dcache_save_paddr.read(),
+                                  &victim,
+                                  &way,
+                                  &set,
+                                  &found,
+                                  &cleanup );
+            if ( found )
+            {
+                r_dcache_miss_way = way;
+                r_dcache_miss_set = set;
+
+                if ( cleanup )
+                {
+                    r_dcache_cleanup_req  = true;
+                    r_dcache_cleanup_line = victim;
+                    r_dcache_cleanup_way  = way;
+                    r_dcache_fsm          = DCACHE_MISS_CLEAN;
+                }
+                else
+                {
+                    r_dcache_fsm          = DCACHE_MISS_WAIT;
+                }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_MISS_SELECT> Select a slot:" << std::dec
+              << " / WAY = "   << way 
+              << " / SET = "   << set;
+    if(cleanup) std::cout << " / VICTIM = " << std::hex << victim << std::endl;
+    else        std::cout << std::endl;
+}
+#endif
+            } // end found
+        }
+        break;
+    }
+    ///////////////////////
+    case DCACHE_MISS_CLEAN:		// switch the slot to ZOMBI state
+                                // and possibly request itlb or dtlb invalidate
+    {
+        if ( m_dreq.valid) m_cost_data_miss_frz++;
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        size_t  way   = r_dcache_miss_way.read();
+        size_t  set   = r_dcache_miss_set.read();
+        paddr_t nline = r_dcache_save_paddr.read() / (m_dcache_words<<2);
+        
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+#endif
+        r_dcache.write_dir( 0,
+                            way,
+                            set,
+                            CACHE_SLOT_STATE_ZOMBI );
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_MISS_INVAL> Switch to ZOMBI state" << std::dec
+              << " / way = "   << way 
+              << " / set = "   << set << std::endl; 
+}
+#endif
+        // if selective itlb & dtlb invalidate are required 
+        // the miss response is not handled before invalidate completed
+        if ( r_dcache_in_tlb[way*m_dcache_sets+set] ) 
+        {
+            r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+            r_dcache_tlb_inval_line  = nline;
+            r_dcache_tlb_inval_set   = 0;
+            r_dcache_fsm_scan_save   = DCACHE_MISS_WAIT;
+            r_dcache_fsm             = DCACHE_INVAL_TLB_SCAN;
+        }
+        else if ( r_dcache_contains_ptd[way*m_dcache_sets+set] ) 
+        {
+            r_itlb.reset();
+            r_dtlb.reset();
+            r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+            r_dcache_fsm = DCACHE_MISS_WAIT;
+        }
+        else
+        {
+            r_dcache_fsm = DCACHE_MISS_WAIT;
+        }
+        break;
+    }
+    //////////////////////
+    case DCACHE_MISS_WAIT:	// waiting the response to a miss request from VCI_RSP FSM
+                            // This state is in charge of error signaling
+                            // There is 5 types of error depending on the requester
+    {
+        if ( m_dreq.valid) m_cost_data_miss_frz++;
+
+        // coherence interrupt
+        if ( r_tgt_dcache_req ) 
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm;
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_data_error.read() ) 			// bus error
+        {
+            switch ( r_dcache_miss_type.read() )
+            {
+                case PROC_MISS:  
+                {
+                    r_mmu_detr            = MMU_READ_DATA_ILLEGAL_ACCESS; 
+                    r_mmu_dbvar           = r_dcache_save_vaddr.read();
+                    m_drsp.valid            = true;
+                    m_drsp.error            = true;
+                    r_dcache_fsm          = DCACHE_IDLE;
+                    break;
+                }
+                case PTE1_MISS:
+                {
+                    if ( r_dcache_tlb_ins.read() )
+                    {
+                        r_mmu_ietr              = MMU_READ_PT1_ILLEGAL_ACCESS;
+                        r_mmu_ibvar             = r_dcache_tlb_vaddr.read();
+                        r_icache_tlb_miss_req   = false;
+                        r_icache_tlb_rsp_error  = true;
+                    }
+                    else
+                    {
+                        r_mmu_detr              = MMU_READ_PT1_ILLEGAL_ACCESS;
+                        r_mmu_dbvar             = r_dcache_tlb_vaddr.read();
+                        m_drsp.valid              = true;
+                        m_drsp.error              = true;
+                    }
+                    r_dcache_fsm                = DCACHE_IDLE;
+                    break;
+                }
+                case PTE2_MISS: 
+                {
+                    if ( r_dcache_tlb_ins.read() )
+                    {
+                        r_mmu_ietr              = MMU_READ_PT2_ILLEGAL_ACCESS;
+                        r_mmu_ibvar             = r_dcache_tlb_vaddr.read();
+                        r_icache_tlb_miss_req   = false;
+                        r_icache_tlb_rsp_error  = true;
+                    }
+                    else
+                    {
+                        r_mmu_detr              = MMU_READ_PT2_ILLEGAL_ACCESS;
+                        r_mmu_dbvar             = r_dcache_tlb_vaddr.read();
+                        m_drsp.valid              = true;
+                        m_drsp.error              = true;
+                    }
+                    r_dcache_fsm                = DCACHE_IDLE;
+                    break;
+                }
+            } // end switch type
+            r_vci_rsp_data_error = false;
+        }
+        else if ( r_vci_rsp_fifo_dcache.rok() )		// valid response available
+        {
+            r_dcache_miss_word = 0;
+	        r_dcache_fsm       = DCACHE_MISS_DATA_UPDT;
+        }	
+        break;
+    }
+    //////////////////////////
+    case DCACHE_MISS_DATA_UPDT:	  // update the dcache (one word per cycle)
+    {
+        if ( m_dreq.valid) m_cost_data_miss_frz++;
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+        
+        if ( r_vci_rsp_fifo_dcache.rok() )	// one word available
+        {
+#ifdef INSTRUMENTATION
+m_cpt_dcache_data_write++;
+#endif
+                r_dcache.write( r_dcache_miss_way.read(),
+                                r_dcache_miss_set.read(),
+                                r_dcache_miss_word.read(),
+                                r_vci_rsp_fifo_dcache.read() );
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_MISS_DATA_UPDT> Write one word:"
+              << " / DATA = "  << r_vci_rsp_fifo_dcache.read()
+              << " / WAY = "   << std::dec << r_dcache_miss_way.read() 
+              << " / SET = "   << r_dcache_miss_set.read()
+              << " / WORD = "  << r_dcache_miss_word.read() << std::endl; 
+}
+#endif
+            vci_rsp_fifo_dcache_get = true;
+            r_dcache_miss_word = r_dcache_miss_word.read() + 1;
+               
+            if ( r_dcache_miss_word.read() == (m_dcache_words-1) ) // last word 
+            {
+                r_dcache_fsm = DCACHE_MISS_DIR_UPDT;
+            }
+        }
+        break;
+    }
+    //////////////////////////
+    case DCACHE_MISS_DIR_UPDT:  // Stalled if a victim line has been evicted
+                                // and the cleanup ack has not been received,
+                                // as indicated by the r_dcache_miss clack.
+                                // - If no matching coherence request (r_dcache_inval_miss)
+                                //   switch directory slot to VALID state.
+                                // - If matching coherence request, switch directory slot
+                                //   to ZOMBI state, and send a cleanup request.
+    { 
+        if ( m_dreq.valid) m_cost_data_miss_frz++;
+
+        // coherence interrupt
+        if ( r_tgt_dcache_req ) 
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm;
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( not r_dcache_miss_clack.read() )  // waiting cleanup acknowledge
+        {
+            if ( r_dcache_miss_inval.read() ) // switch slot to ZOMBI state, and new cleanup
+            {
+                if ( not r_icache_cleanup_req.read() )
+                {
+                    r_dcache_cleanup_req    = true;
+                    r_dcache_cleanup_line   = r_dcache_vci_paddr.read()/(m_dcache_words<<2);
+                    r_dcache_cleanup_way    = r_dcache_miss_way.read();
+                    r_dcache_miss_inval     = false;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_write++;
+#endif
+                    r_dcache.write_dir( r_dcache_vci_paddr.read(),
+                                        r_dcache_miss_way.read(),
+                                        r_dcache_miss_set.read(),
+                                        CACHE_SLOT_STATE_ZOMBI );
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_MISS_DIR_UPDT> Switch slot to ZOMBI state"
+              << " PADDR = " << std::hex << r_dcache_vci_paddr.read() 
+              << " / WAY = "   << std::dec << r_dcache_miss_way.read() 
+              << " / SET = "   << r_dcache_miss_set.read() << std::endl;
+}
+#endif
+                }
+            }
+            else                              // switch slot to VALID state
+            {
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_write++;
+#endif
+                r_dcache.write_dir( r_dcache_vci_paddr.read(),
+                                    r_dcache_miss_way.read(),
+                                    r_dcache_miss_set.read(),
+                                    CACHE_SLOT_STATE_ZOMBI );
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_MISS_DIR_UPDT> Switch slot to VALID state"
+              << " PADDR = " << std::hex << r_dcache_vci_paddr.read() 
+              << " / WAY = "   << std::dec << r_dcache_miss_way.read() 
+              << " / SET = "   << r_dcache_miss_set.read() << std::endl;
+}
+#endif
+                // reset directory extension
+                size_t way = r_dcache_miss_way.read();
+                size_t set = r_dcache_miss_set.read();
+                r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+                r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+            }
+                    
+            if      (r_dcache_miss_type.read()==PTE1_MISS) r_dcache_fsm = DCACHE_TLB_PTE1_GET; 
+            else if (r_dcache_miss_type.read()==PTE2_MISS) r_dcache_fsm = DCACHE_TLB_PTE2_GET;
+            else                                           r_dcache_fsm = DCACHE_IDLE;
+        }
+        break;
+    }
+    /////////////////////
+    case DCACHE_UNC_WAIT:  // waiting a response to an uncacheable read
+    {
+        // coherence interrupt
+        if ( r_tgt_dcache_req.read() ) 
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm;
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_data_error.read() ) 	// bus error
+        {
+            r_mmu_detr           = MMU_READ_DATA_ILLEGAL_ACCESS; 
+            r_mmu_dbvar          = m_dreq.addr;
+            r_vci_rsp_data_error = false;
+            m_drsp.error         = true;
+            m_drsp.valid         = true;
+            r_dcache_fsm         = DCACHE_IDLE;
+            break;
+        }
+	    else if ( r_vci_rsp_fifo_dcache.rok() )     // data available
+	    {
+            // consume data 
+            vci_rsp_fifo_dcache_get = true;     
+            r_dcache_fsm            = DCACHE_IDLE;
+
+            // acknowledge the processor request if it has not been modified
+            if ( m_dreq.valid and (m_dreq.addr == r_dcache_save_vaddr.read()) )
+            {
+	            m_drsp.valid        = true;
+                m_drsp.error        = false;
+	            m_drsp.rdata        = r_vci_rsp_fifo_dcache.read();
+            }
+	    }	
+        break;
+    }
+    /////////////////////
+    case DCACHE_LL_WAIT:    // waiting VCI response to a LL transaction
+    {
+        // coherence interrupt
+        if ( r_tgt_dcache_req.read() ) 
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm;
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_data_error.read() ) 	// bus error
+        {
+            r_mmu_detr           = MMU_READ_DATA_ILLEGAL_ACCESS; 
+            r_mmu_dbvar          = m_dreq.addr;
+            r_vci_rsp_data_error = false;
+            m_drsp.error         = true;
+            m_drsp.valid         = true;
+            r_dcache_fsm         = DCACHE_IDLE;
+            break;
+        }
+	    else if ( r_vci_rsp_fifo_dcache.rok() )     // data available
+	    {
+            // consume data 
+            vci_rsp_fifo_dcache_get = true;
+
+            if(r_dcache_ll_rsp_count.read() == 0) // first flit
+            {
+                // set key value in llsc reservation buffer
+                r_dcache_llsc_key     = r_vci_rsp_fifo_dcache.read();
+                r_dcache_ll_rsp_count = r_dcache_ll_rsp_count.read() + 1 ;
+            }
+            else                                  // last flit
+            {
+                // acknowledge the processor request if it has not been modified
+                if ( m_dreq.valid and (m_dreq.addr == r_dcache_save_vaddr.read()) )
+                {
+                    m_drsp.valid        = true;
+                    m_drsp.error        = false;
+                    m_drsp.rdata        = r_vci_rsp_fifo_dcache.read();
+                }
+                r_dcache_fsm = DCACHE_IDLE;
+            }
+	    }
+        break;
+    }
+    ////////////////////
+    case DCACHE_SC_WAIT:	// waiting VCI response to a SC transaction
+    {
+        // coherence interrupt
+        if ( r_tgt_dcache_req.read() ) 
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm;
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_data_error.read() ) 		// bus error
+        {
+            r_mmu_detr           = MMU_READ_DATA_ILLEGAL_ACCESS; 
+            r_mmu_dbvar          = m_dreq.addr;
+            r_vci_rsp_data_error = false;
+            m_drsp.error         = true;
+            m_drsp.valid         = true;
+            r_dcache_fsm         = DCACHE_IDLE;
+            break;
+        }
+	    else if ( r_vci_rsp_fifo_dcache.rok() ) // response available
+	    {
+            // consume response 
+            vci_rsp_fifo_dcache_get = true;
+            m_drsp.valid            = true;
+            m_drsp.rdata            = r_vci_rsp_fifo_dcache.read();
+            r_dcache_fsm            = DCACHE_IDLE;
+	    }	
+        break;
+    }
+    //////////////////////////
+    case DCACHE_DIRTY_GET_PTE:		// This sub_fsm set the PTE Dirty bit in memory 
+                                    // before handling a processor WRITE or SC request  
+                                    // Input argument is r_dcache_dirty_paddr
+                                    // In this first state, we get PTE value in dcache
+                                    // and post a CAS request to CMD FSM
+    {
+        // get PTE in dcache
+        uint32_t pte;
+        size_t   way;
+        size_t   set;
+        size_t   word;	// unused
+        int      state;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_data_read++;
+m_cpt_dcache_dir_read++;
+#endif
+        r_dcache.read( r_dcache_dirty_paddr.read(),
+                       &pte,
+                       &way,
+                       &set,
+                       &word,
+                       &state );
+
+        assert( (state == CACHE_SLOT_STATE_VALID) and 
+        "error in DCACHE_DIRTY_TLB_SET: the PTE should be in dcache" );
+
+        // request CAS transaction to CMD_FSM
+        r_dcache_dirty_way  = way; 
+        r_dcache_dirty_set  = set; 
+
+        // check llsc reservation buffer
+        if (r_dcache_llsc_paddr.read() == r_dcache_dirty_paddr.read() )
+            r_dcache_llsc_valid = false;
+
+        // request a CAS CMD and go to DCACHE_DIRTY_WAIT state
+        r_dcache_vci_cas_req = true;
+        r_dcache_vci_paddr   = r_dcache_dirty_paddr.read();
+        r_dcache_vci_cas_old = pte;
+        r_dcache_vci_cas_new = pte | PTE_D_MASK;
+        r_dcache_fsm         = DCACHE_DIRTY_WAIT;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_DIRTY_GET_PTE> CAS request" << std::hex
+              << " / PTE_PADDR = " << r_dcache_dirty_paddr.read() 
+              << " / PTE_VALUE = " << pte << std::dec 
+              << " / SET = " << set
+              << " / WAY = " << way << std::endl;
+}
+#endif
+        break;
+    }
+    ///////////////////////
+    case DCACHE_DIRTY_WAIT:         // wait completion of CAS for PTE Dirty bit,
+                                    // and return to IDLE state when response is received.
+                                    // we don't care if the CAS is a failure:
+                                    // - if the CAS is a success, the coherence mechanism
+                                    //   updates the local copy.
+                                    // - if the CAS is a failure, we just retry the write.
+    {
+        // coherence interrupt
+        if ( r_tgt_dcache_req ) 
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm;
+            r_dcache_fsm         = DCACHE_CC_CHECK;
+            break;
+        }
+
+        // cleanup ack interrupt
+        if ( r_cleanup_dcache_req.read() )
+        {
+            r_dcache_fsm_cc_save = r_dcache_fsm.read();
+            r_dcache_fsm         = DCACHE_CC_CLACK;
+            break;
+        }
+
+        if ( r_vci_rsp_data_error.read() )	// bus error
+        {
+            std::cout << "BUS ERROR in DCACHE_DIRTY_WAIT state" << std::endl;
+            std::cout << "This should not happen in this state" << std::endl;
+            exit(0);
+        }
+        else if ( r_vci_rsp_fifo_dcache.rok() )	// response available
+        {
+            vci_rsp_fifo_dcache_get = true;
+            r_dcache_fsm            = DCACHE_IDLE;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_DIRTY_WAIT> CAS completed" << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    /////////////////////
+    case DCACHE_CC_CLACK:   // This state is the entry point for the sub-FSM
+                            // handling cleanup ack requests for DCACHE.
+                            // We switch the directory slot to EMPTY state
+                            // and reset r_icache_miss_clack if the cleanup ack
+                            // is matching a pending miss.
+    {
+        if ( m_dreq.valid ) m_cost_data_miss_frz++;
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_write++;
+#endif
+        r_dcache.write_dir( 0,
+                            r_cleanup_dcache_way.read(),
+                            r_cleanup_dcache_set.read(),
+                            CACHE_SLOT_STATE_EMPTY);
+
+        if ( (r_dcache_miss_set.read() == r_cleanup_dcache_set.read()) and
+             (r_dcache_miss_way.read() == r_cleanup_dcache_way.read()) )
+              r_dcache_miss_clack = false;
+
+        r_dcache_fsm = r_dcache_fsm_cc_save.read() ;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " DCACHE_CC_CLACK> Switch slot to EMPTY state"
+              << " set = " << r_cleanup_dcache_set.read()
+              << " / way = " << r_cleanup_dcache_way.read() << std::endl;
+}
+#endif
+
+        break;
+    }
+    /////////////////////
+    case DCACHE_CC_CHECK:   // This state is the entry point for the sub-FSM
+                            // handling coherence requests for DCACHE.
+                            // If there is a matching pending miss on the modified cache 
+                            // line this is signaled in the r_dcache_miss inval flip-flop.
+                            // If the updated (or invalidated) cache line has copies in TLBs
+                            // these TLB copies are invalidated.
+                            // The return state is defined in r_dcache_fsm_cc_save
+    {
+        paddr_t  paddr = r_tgt_paddr.read();
+        paddr_t  mask = ~((m_dcache_words<<2)-1);
+
+
+        if( (r_dcache_fsm_cc_save == DCACHE_MISS_WAIT) and
+            ((r_dcache_vci_paddr.read() & mask) == (paddr & mask)) ) // matching 
+        {
+            // signaling matching
+            r_dcache_miss_inval = true;			
+
+            // coherence request completed, CC_ACK required if update
+            r_tgt_dcache_req      = false;
+            r_dcache_tgt_need_rsp = (r_tgt_cc_type.read() == CC_TYPE_UPDT_DATA);
+            r_dcache_fsm          = r_dcache_fsm_cc_save.read();
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_CHECK> Coherence request matching a pending miss:"
+              << " PADDR = " << std::hex << paddr << std::endl;
+}
+#endif
+  
+        }
+        else                                                    // no match 
+	    {
+            int        state;
+            size_t 	   way;
+            size_t 	   set;
+            size_t	   word;  
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_read++;
+#endif
+            r_dcache.read_dir( paddr,
+                               &state,
+                               &way, 
+                               &set,
+                               &word );	// unused
+
+            r_dcache_cc_way = way;
+            r_dcache_cc_set = set;
+
+            if ( state == CACHE_SLOT_STATE_VALID)            // hit  
+            {
+                if (r_tgt_cc_type.read() == CC_TYPE_UPDT_DATA)  // hit update
+                {
+                    r_dcache_fsm          = DCACHE_CC_UPDT;
+                    r_dcache_cc_word      = r_tgt_word_min.read();
+                }
+                else if (r_tgt_cc_type == CC_TYPE_INVAL_DATA)   // hit inval
+                {
+                    r_dcache_fsm          = DCACHE_CC_INVAL;
+                }
+                else if ( r_tgt_cc_type == CC_TYPE_BROADCAST)  // hit broadcast
+                {
+                    r_dcache_fsm          = DCACHE_CC_BROADCAST;
+                }
+            }
+            else                                      // miss
+            {
+                // coherence request completed, CC_ACK required if update only 
+                r_tgt_dcache_req      = false;
+                r_dcache_tgt_need_rsp = (r_tgt_cc_type.read() == CC_TYPE_UPDT_DATA);
+                r_dcache_fsm          = r_dcache_fsm_cc_save.read();
+            }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_CHECK> Coherence request received:"
+              << " PADDR = " << std::hex << paddr 
+              << " / TYPE = " << std::dec << r_tgt_cc_type.read()
+              << " / HIT = " << (state == CACHE_SLOT_STATE_VALID) << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    /////////////////////
+    case DCACHE_CC_INVAL:   	// hit inval: switch slot to EMPTY state, 
+                                // after possible invalidation of copies in TLBs
+    {
+        size_t	 way    = r_dcache_cc_way.read();
+        size_t	 set    = r_dcache_cc_set.read();
+
+        if ( r_dcache_in_tlb[way*m_dcache_sets+set] ) 			// selective TLB inval
+        {
+            r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+            r_dcache_tlb_inval_line  = r_tgt_paddr.read() / (m_dcache_words<<2);
+            r_dcache_tlb_inval_set   = 0;
+            r_dcache_fsm_scan_save   = r_dcache_fsm.read();
+            r_dcache_fsm             = DCACHE_INVAL_TLB_SCAN;
+        }
+        else 
+        {
+            if ( r_dcache_contains_ptd[way*m_dcache_sets+set] ) 	// TLB flush
+            {
+                r_itlb.reset();
+                r_dtlb.reset();
+                r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_INVAL> Flush DTLB & ITLB" << std::endl;
+}
+#endif
+            }
+ 
+            r_dcache.write_dir( 0,
+                                way, 
+                                set,
+                                CACHE_SLOT_STATE_EMPTY );
+        
+            // coherence request completed, CC_ACK required if hit inval
+            r_tgt_dcache_req      = false;
+            r_dcache_tgt_need_rsp = true;
+            r_dcache_fsm          = r_dcache_fsm_cc_save.read();
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_INVAL> Switch slot to EMPTY state:" << std::dec
+	          << " / WAY = " << way
+	          << " / SET = " << set << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    ///////////////////
+    case DCACHE_CC_UPDT:    	// hit update: write one word per cycle,  
+                                // after possible invalidation of copies in TLBs
+    {
+        size_t	 word       = r_dcache_cc_word.read();
+        size_t	 way        = r_dcache_cc_way.read();
+        size_t	 set        = r_dcache_cc_set.read();
+
+        if ( r_dcache_in_tlb[way*m_dcache_sets+set] ) 			// selective TLB inval
+        {
+            r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+            r_dcache_tlb_inval_line  = r_tgt_paddr.read() / (m_dcache_words<<2);
+            r_dcache_tlb_inval_set   = 0;
+            r_dcache_fsm_scan_save   = r_dcache_fsm.read();
+            r_dcache_fsm             = DCACHE_INVAL_TLB_SCAN;
+        }
+        else 
+        {
+            if ( r_dcache_contains_ptd[way*m_dcache_sets+set] ) 	// TLB flush
+            {
+                r_itlb.reset();
+                r_dtlb.reset();
+                r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_UPDT> Flush DTLB & ITLB" << std::endl;
+}
+#endif
+            } 
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_data_write++;
+#endif
+            r_dcache.write( way,
+                            set,
+                            word,
+                            r_tgt_buf[word],
+                            r_tgt_be[word] );
+
+            r_dcache_cc_word = word + 1;
+
+            if ( word == r_tgt_word_max.read() )	// last word
+            {
+                r_tgt_dcache_req      = false;
+                r_dcache_tgt_need_rsp = true;
+                r_dcache_fsm          = r_dcache_fsm_cc_save.read();
+            }
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_UPDT> Write one word" << std::dec
+	          << " / WAY = " << way
+	          << " / SET = " << set 
+              << " / WORD = " << word
+              << " / VALUE = " << std::hex << r_tgt_buf[word] << std::endl;
+}
+#endif
+        }
+        break;
+    }
+    /////////////////////////
+    case DCACHE_CC_BROADCAST:   // hit broadcast : switch state to ZOMBI state
+                                // and request a cleanup, after possible
+                                // invalidation of copies in TLBs
+    {
+        size_t	 way   = r_dcache_cc_way.read();
+        size_t	 set   = r_dcache_cc_set.read();
+        paddr_t  nline = r_tgt_paddr.read() / (m_dcache_words<<2);
+
+        if ( r_dcache_in_tlb[way*m_dcache_sets+set] ) 			// selective TLB inval
+        {
+            r_dcache_in_tlb[way*m_dcache_sets+set] = false;
+            r_dcache_tlb_inval_line  = nline;
+            r_dcache_tlb_inval_set   = 0;
+            r_dcache_fsm_scan_save   = r_dcache_fsm.read();
+            r_dcache_fsm             = DCACHE_INVAL_TLB_SCAN;
+        }
+        else 						
+        {
+            if ( r_dcache_contains_ptd[way*m_dcache_sets+set] ) 	// TLB flush
+            {
+                r_itlb.reset();
+                r_dtlb.reset();
+                r_dcache_contains_ptd[way*m_dcache_sets+set] = false;
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " DCACHE_CC_BROADCAST> Flush DTLB & ITLB" << std::endl;
+}
+#endif
+            } 
+
+#ifdef INSTRUMENTATION
+m_cpt_dcache_dir_write++;
+#endif
+            r_dcache.write_dir( 0,
+                                way,
+                                set,
+                                CACHE_SLOT_STATE_ZOMBI );
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm )
+{
+    std::cout << "  <PROC " << name()
+              << " DCACHE_CC_BROADCAST > Slot goes to ZOMBI state "
+              << " SET = " << set
+              << " / WAY = " << way << std::endl;
+}
+#endif
+
+            // coherence operation completed, no CC_ACK for hit broadcast
+            r_dcache_tgt_need_rsp = false;
+            r_tgt_dcache_req      = false;
+            r_dcache_cleanup_req  = true;
+            r_dcache_cleanup_line = nline;
+            r_dcache_cleanup_way  = way;
+            r_dcache_fsm          = r_dcache_fsm_cc_save.read();
+        }
+        break;
+    }
+    ///////////////////////////
+    case DCACHE_INVAL_TLB_SCAN:     	// Scan sequencially all sets for both ITLB & DTLB
+                                        // It makes assumption: m_itlb_sets == m_dtlb_sets
+                                        // All ways are handled in parallel.
+                                        // We enter this state when a DCACHE line is modified,
+                                        // and there is a copy in itlb or dtlb.
+                                        // It can be caused by: 
+                                        // - a coherence inval or updt transaction, 
+                                        // - a line inval caused by a cache miss
+                                        // - a processor XTN inval request, 
+                                        // - a WRITE hit,
+                                        // - a Dirty bit update
+                                        // Input arguments are:
+                                        // - r_dcache_tlb_inval_line
+                                        // - r_dcache_tlb_inval_set
+                                        // - r_dcache_fsm_scan_save
+    {
+        paddr_t	line = r_dcache_tlb_inval_line.read(); 
+        size_t  set  = r_dcache_tlb_inval_set.read();	
+        size_t  way;
+        bool    ok;
+
+        for ( way = 0 ; way < m_itlb_ways ; way++ )
+        {
+            ok = r_itlb.inval( line, way, set );
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm and ok )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_INVAL_TLB_SCAN> Invalidate ITLB entry:" << std::hex 
+              << " line = " << line << std::dec
+              << " / set = " << set 
+              << " / way = " << way << std::endl;
+}
+#endif
+        }
+         
+        for ( way = 0 ; way < m_dtlb_ways ; way++ )
+        {
+            ok = r_dtlb.inval( line, way, set );
+
+#if DEBUG_DCACHE
+if ( m_debug_dcache_fsm and ok )
+{
+    std::cout << "  <PROC " << name() 
+              << ".DCACHE_INVAL_TLB_SCAN> Invalidate DTLB entry:" << std::hex 
+              << " line = " << line << std::dec
+              << " / set = " << set 
+              << " / way = " << way << std::endl;
+}
+#endif
+        }
+
+        // return to the calling state when TLB inval completed
+        if ( r_dcache_tlb_inval_set.read() == (m_dtlb_sets-1) )
+        {
+            r_dcache_fsm = r_dcache_fsm_scan_save.read();
+        }
+        r_dcache_tlb_inval_set = r_dcache_tlb_inval_set.read() + 1;
+        break;
+    }   
+    } // end switch r_dcache_fsm
+
+    ///////////////// wbuf update ///////////////////////////////////////////////////////
+    r_wbuf.update();
+
+    ///////////////// llsc update ///////////////////////////////////////////////////////
+    if (r_dcache_llsc_valid.read()) r_dcache_llsc_count = r_dcache_llsc_count.read() - 1;
+    if (r_dcache_llsc_count.read() == 1) r_dcache_llsc_valid = false;
+
+    //////////////// test processor frozen //////////////////////////////////////////////
+    // The simulation exit if the number of consecutive frozen cycles
+    // is larger than the m_max_frozen_cycles (constructor parameter)
+    if ( (m_ireq.valid and not m_irsp.valid) or (m_dreq.valid and not m_drsp.valid) )       
+    {
+        m_cpt_frz_cycles++; 		// used for instrumentation
+        m_cpt_stop_simulation++;	// used for debug
+        if ( m_cpt_stop_simulation > m_max_frozen_cycles )
+        {
+            std::cout << std::dec << "ERROR in CC_VCACHE_WRAPPER " << name() << std::endl
+                      << " stop at cycle " << m_cpt_total_cycles << std::endl
+                      << " frozen since cycle " << m_cpt_total_cycles - m_max_frozen_cycles 
+                      << std::endl;
+                      r_iss.dump();
+            exit(1);
+        }
+    }
+    else
+    {
+        m_cpt_stop_simulation = 0;
+    }
+
+    /////////// execute one iss cycle /////////////////////////////////
+    {
+    uint32_t it = 0;
+    for (size_t i=0; i<(size_t)iss_t::n_irq; i++) if(p_irq[i].read()) it |= (1<<i);
+    r_iss.executeNCycles(1, m_irsp, m_drsp, it);
+    }
+
+    ////////////////////////////////////////////////////////////////////////////
+    // The VCI_CMD FSM controls the following ressources:
+    // - r_vci_cmd_fsm
+    // - r_vci_cmd_min
+    // - r_vci_cmd_max
+    // - r_vci_cmd_cpt
+    // - r_vci_cmd_imiss_prio
+    // - wbuf (reset)
+    // - r_icache_miss_req (reset)
+    // - r_icache_unc_req (reset)
+    // - r_dcache_vci_miss_req (reset)
+    // - r_dcache_vci_unc_req (reset)
+    // - r_dcache_vci_ll_req (reset)
+    // - r_dcache_vci_sc_req (reset in case of local sc fail)
+    // - r_dcache_vci_cas_req (reset)
+    //
+    // This FSM handles requests from both the DCACHE FSM & the ICACHE FSM.
+    // There are 8 request types, with the following priorities : 
+    // 1 - Data Read Miss         : r_dcache_vci_miss_req and miss in the write buffer
+    // 2 - Data Read Uncachable   : r_dcache_vci_unc_req  
+    // 3 - Instruction Miss       : r_icache_miss_req and miss in the write buffer
+    // 4 - Instruction Uncachable : r_icache_unc_req 
+    // 5 - Data Write             : r_wbuf.rok()      
+    // 6 - Data Linked Load       : r_dcache_vci_ll_req
+    // 7 - Data Store Conditionnal: r_dcache_vci_sc_req
+    // 8 - Compare And Swap       : r_dcache_vci_cas_req
+    //
+    // As we want to support several simultaneous VCI transactions, the VCI_CMD_FSM 
+    // and the VCI_RSP_FSM are fully desynchronized.
+    //
+    // VCI formats:
+    // According to the VCI advanced specification, all read requests packets 
+    // (data Uncached, Miss data, instruction Uncached, Miss instruction) 
+    // are one word packets.
+    // For write burst packets, all words are in the same cache line,
+    // and addresses must be contiguous (the BE field is 0 in case of "holes").
+    // The sc command packet implements actually a compare-and-swap mechanism
+    // and the packet contains two flits.
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_vci_cmd_fsm.read() ) 
+    {
+        //////////////
+        case CMD_IDLE:
+        {
+            // DDACHE read requests (r_dcache_vci_miss_req or r_dcache_vci_ll_req), and
+            // ICACHE read requests (r_icache_miss_req) require both a write_buffer access 
+            // to check a possible pending write on the same cache line. 
+            // As there is only one possible access per cycle to write buffer, we implement 
+            // a round-robin priority between DCACHE and ICACHE for this access, 
+            // using the r_vci_cmd_imiss_prio flip-flop.
+
+            size_t      wbuf_min;
+            size_t      wbuf_max;
+
+            bool dcache_miss_req = r_dcache_vci_miss_req.read() and
+                 ( not r_icache_miss_req.read() or not r_vci_cmd_imiss_prio.read() );
+
+           bool dcache_ll_req   = r_dcache_vci_ll_req.read() and
+                 ( not r_icache_miss_req.read() or not r_vci_cmd_imiss_prio.read() );
+
+            bool icache_miss_req = r_icache_miss_req.read() and
+                 ( not (r_dcache_vci_miss_req.read() or r_dcache_vci_ll_req.read()) 
+                       or not r_vci_cmd_imiss_prio.read() );
+
+            // 1 - Data Read Miss
+            if ( dcache_miss_req and r_wbuf.miss(r_dcache_vci_paddr.read()) )
+            {
+                r_vci_cmd_fsm         = CMD_DATA_MISS;
+                r_dcache_vci_miss_req = false;
+                r_vci_cmd_imiss_prio  = true;
+//                m_cpt_dmiss_transaction++;
+            }
+            // 2 - Data Read Uncachable
+            else if ( r_dcache_vci_unc_req.read() )
+            {
+                r_vci_cmd_fsm        = CMD_DATA_UNC;
+                r_dcache_vci_unc_req = false;
+//                m_cpt_dunc_transaction++;
+            }
+            // 3 - Instruction Miss
+            else if ( icache_miss_req and r_wbuf.miss(r_icache_vci_paddr.read()) )
+            {
+                r_vci_cmd_fsm        = CMD_INS_MISS;
+                r_icache_miss_req    = false;
+                r_vci_cmd_imiss_prio = false;
+//                m_cpt_imiss_transaction++;
+            }
+            // 4 - Instruction Uncachable
+            else if ( r_icache_unc_req.read() )
+            {
+                r_vci_cmd_fsm    = CMD_INS_UNC;
+                r_icache_unc_req = false;
+//                m_cpt_iunc_transaction++;
+            }
+            // 5 - Data Write
+            else if ( r_wbuf.rok(&wbuf_min, &wbuf_max) )
+            {
+                r_vci_cmd_fsm       = CMD_DATA_WRITE;
+                r_vci_cmd_cpt       = wbuf_min;
+                r_vci_cmd_min       = wbuf_min;
+                r_vci_cmd_max       = wbuf_max;
+//                m_cpt_write_transaction++;
+//                m_length_write_transaction += (wbuf_max-wbuf_min+1);
+            }
+            // 6 - Data Linked Load
+            else if ( dcache_ll_req and r_wbuf.miss(r_dcache_vci_paddr.read()))
+            {
+                r_dcache_vci_ll_req = false;
+                r_vci_cmd_fsm       = CMD_DATA_LL;
+//              m_cpt_ll_transaction++;
+            }
+            // 7 - Data Store Conditionnal
+            else if ( r_dcache_vci_sc_req.read() )
+            {
+                r_dcache_vci_sc_req = false;
+                r_vci_cmd_cpt  = 0;
+                r_vci_cmd_fsm  = CMD_DATA_SC;
+//              m_cpt_sc_transaction++;
+            }
+            // 8 - Compare And Swap
+            else if ( r_dcache_vci_cas_req.read() )
+            {
+                r_vci_cmd_fsm        = CMD_DATA_CAS;
+                r_dcache_vci_cas_req = false;
+                r_vci_cmd_cpt        = 0;
+//              m_cpt_cas_transaction++;
+            }
+            break;
+        }
+        ////////////////////
+        case CMD_DATA_WRITE:
+        {
+            if ( p_vci_ini_d.cmdack.read() )
+            {
+                r_vci_cmd_cpt = r_vci_cmd_cpt + 1;
+                if (r_vci_cmd_cpt == r_vci_cmd_max) // last flit sent
+                {
+                    r_vci_cmd_fsm = CMD_IDLE ;
+                    r_wbuf.sent() ;
+                }
+            }
+            break;
+        }
+        /////////////////
+        case CMD_DATA_SC:
+        case CMD_DATA_CAS:
+        {
+            // The CAS and SC VCI commands contain two flits
+            if ( p_vci_ini_d.cmdack.read() )
+            {
+               r_vci_cmd_cpt = r_vci_cmd_cpt + 1;
+               if (r_vci_cmd_cpt == 1) r_vci_cmd_fsm = CMD_IDLE ;
+            }
+            break;
+        }
+        //////////////////
+        case CMD_INS_MISS:
+        case CMD_INS_UNC:
+        case CMD_DATA_MISS:
+        case CMD_DATA_UNC:
+        case CMD_DATA_LL:
+        {
+            // all read VCI commands contain one single flit
+            if ( p_vci_ini_d.cmdack.read() )  r_vci_cmd_fsm = CMD_IDLE;
+            break;
+        }
+
+    } // end  switch r_vci_cmd_fsm
+
+    //////////////////////////////////////////////////////////////////////////
+    // The VCI_RSP FSM controls the following ressources:
+    // - r_vci_rsp_fsm:
+    // - r_vci_rsp_fifo_icache (push)
+    // - r_vci_rsp_fifo_dcache (push)
+    // - r_vci_rsp_data_error (set)
+    // - r_vci_rsp_ins_error (set)
+    // - r_vci_rsp_cpt
+    // - r_dcache_vci_sc_req (reset when SC response recieved)
+    //
+    // As the VCI_RSP and VCI_CMD are fully desynchronized to support several
+    // simultaneous VCI transactions, this FSM uses the VCI RPKTID field 
+    // to identify the transactions.
+    //
+    // VCI vormat:
+    // This component checks the response packet length and accepts only
+    // single word packets for write response packets. 
+    //
+    // Error handling:
+    // This FSM analyzes the VCI error code and signals directly the Write Bus Error. 
+    // In case of Read Data Error, the VCI_RSP FSM sets the r_vci_rsp_data_error 
+    // flip_flop and the error is signaled by the DCACHE FSM.  
+    // In case of Instruction Error, the VCI_RSP FSM sets the r_vci_rsp_ins_error 
+    // flip_flop and the error is signaled by the ICACHE FSM.  
+    // In case of Cleanup Error, the simulation stops with an error message...
+    //////////////////////////////////////////////////////////////////////////
+
+    switch ( r_vci_rsp_fsm.read() ) 
+    {
+    //////////////
+    case RSP_IDLE:
+    {
+        if ( p_vci_ini_d.rspval.read() )
+        {
+            r_vci_rsp_cpt = 0;
+
+            if      ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_READ_DATA_UNC  ) 
+            {
+                r_vci_rsp_fsm = RSP_DATA_UNC;
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_READ_DATA_MISS ) 
+            {
+                r_vci_rsp_fsm = RSP_DATA_MISS;
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_READ_INS_UNC   ) 
+            {
+                r_vci_rsp_fsm = RSP_INS_UNC;
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_READ_INS_MISS  ) 
+            {
+                r_vci_rsp_fsm = RSP_INS_MISS;
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_WRITE          )
+            {
+                r_vci_rsp_fsm = RSP_DATA_WRITE; 
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_CAS            ) 
+            {
+                r_vci_rsp_fsm = RSP_DATA_UNC;
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) ==  TYPE_LL             ) 
+            {
+                r_vci_rsp_fsm = RSP_DATA_LL;
+            }
+            else if ( (p_vci_ini_d.rpktid.read() & 0x7) == TYPE_SC             ) 
+            {
+                r_vci_rsp_fsm = RSP_DATA_UNC;
+            }
+            else
+            {
+                assert(false and "Unexpected VCI response");
+            }
+        }
+        break;
+    }
+        //////////////////
+        case RSP_INS_MISS:
+        {
+            if ( p_vci_ini_d.rspval.read() )
+            {
+                if ( (p_vci_ini_d.rerror.read()&0x1) != 0 )  // error reported
+                {
+                    r_vci_rsp_ins_error = true;
+                    if ( p_vci_ini_d.reop.read() ) r_vci_rsp_fsm = RSP_IDLE;
+                }
+                else                                        // no error reported
+                {
+                    if ( r_vci_rsp_fifo_icache.wok() )
+                    {
+                        assert( (r_vci_rsp_cpt.read() < m_icache_words) and
+                        "The VCI response packet for instruction miss is too long" );
+
+                        r_vci_rsp_cpt                 = r_vci_rsp_cpt.read() + 1;
+                        vci_rsp_fifo_icache_put       = true,
+                        vci_rsp_fifo_icache_data      = p_vci_ini_d.rdata.read();
+                        if ( p_vci_ini_d.reop.read() )
+                        {
+                            assert( (r_vci_rsp_cpt.read() == m_icache_words - 1) and
+                            "The VCI response packet for instruction miss is too short");
+
+                            r_vci_rsp_fsm    = RSP_IDLE;
+                        }
+                    }
+                }
+            }
+            break;
+        }
+        /////////////////
+        case RSP_INS_UNC:
+        {
+            if (p_vci_ini_d.rspval.read() )
+            {
+                assert( p_vci_ini_d.reop.read() and
+                "illegal VCI response packet for uncachable instruction");
+
+                if ( (p_vci_ini_d.rerror.read()&0x1) != 0 )  // error reported
+                {
+                    r_vci_rsp_ins_error = true;
+                    r_vci_rsp_fsm = RSP_IDLE;
+                }
+                else                                         // no error reported
+                {
+                    if ( r_vci_rsp_fifo_icache.wok())
+                    {
+                        vci_rsp_fifo_icache_put       = true;
+                        vci_rsp_fifo_icache_data      = p_vci_ini_d.rdata.read();
+                        r_vci_rsp_fsm = RSP_IDLE;
+                    }
+                }
+            }
+            break;
+        }
+        ///////////////////
+        case RSP_DATA_MISS:
+        {
+            if ( p_vci_ini_d.rspval.read() )
+            {
+                if ( (p_vci_ini_d.rerror.read()&0x1) != 0 )  // error reported
+                {
+                    r_vci_rsp_data_error = true;
+                    if ( p_vci_ini_d.reop.read() ) r_vci_rsp_fsm = RSP_IDLE;
+                }
+                else                                        // no error reported
+                {
+                    if ( r_vci_rsp_fifo_dcache.wok() )
+                    {
+                        assert( (r_vci_rsp_cpt.read() < m_dcache_words) and
+                        "The VCI response packet for data miss is too long");
+
+                        r_vci_rsp_cpt                 = r_vci_rsp_cpt.read() + 1;
+                        vci_rsp_fifo_dcache_put       = true,
+                        vci_rsp_fifo_dcache_data      = p_vci_ini_d.rdata.read();
+                        if ( p_vci_ini_d.reop.read() )
+                        {
+                            assert( (r_vci_rsp_cpt.read() == m_dcache_words - 1) and
+                            "The VCI response packet for data miss is too short");
+
+                            r_vci_rsp_fsm     = RSP_IDLE;
+                        }
+                    }
+                }
+            }
+            break;
+        }
+        //////////////////
+        case RSP_DATA_UNC:
+        {
+            if (p_vci_ini_d.rspval.read() )
+            {
+                assert( p_vci_ini_d.reop.read() and
+                "illegal VCI response packet for uncachable read data");
+
+                if ( (p_vci_ini_d.rerror.read()&0x1) != 0 )  // error reported
+                {
+                    r_vci_rsp_data_error = true;
+                    r_vci_rsp_fsm = RSP_IDLE;
+                }
+                else                                         // no error reported
+                {
+                    if ( r_vci_rsp_fifo_dcache.wok())
+                    {
+                        vci_rsp_fifo_dcache_put       = true;
+                        vci_rsp_fifo_dcache_data      = p_vci_ini_d.rdata.read();
+                        r_vci_rsp_fsm = RSP_IDLE;
+                    }
+                }
+            }
+            break;
+        }
+        ////////////////////
+        case RSP_DATA_LL:
+        {
+            if ( p_vci_ini_d.rspval.read() )
+            {
+                if ( (p_vci_ini_d.rerror.read()&0x1) != 0 )  // error reported
+                {
+                    r_vci_rsp_data_error = true;
+                    r_vci_rsp_fsm = RSP_IDLE;
+                }
+                if (r_vci_rsp_cpt.read() == 0) //first flit
+                {
+                    if(r_vci_rsp_fifo_dcache.wok())
+                    {
+                        assert(!p_vci_ini_d.reop.read() &&
+                            "illegal VCI response packet for LL");
+                        vci_rsp_fifo_dcache_put  = true;
+                        vci_rsp_fifo_dcache_data = p_vci_ini_d.rdata.read();
+                        r_vci_rsp_cpt            = r_vci_rsp_cpt.read() + 1;
+                    }
+                    break;
+                }
+                else // last flit
+                {
+                    if(r_vci_rsp_fifo_dcache.wok())
+                    {
+                        assert(p_vci_ini_d.reop.read() &&
+                            "illegal VCI response packet for LL");
+                        vci_rsp_fifo_dcache_put  = true;
+                        vci_rsp_fifo_dcache_data = p_vci_ini_d.rdata.read();
+                        r_vci_rsp_fsm            = RSP_IDLE;
+                    }
+                    break;
+                }
+            }
+            break;
+        }
+        ////////////////////
+        case RSP_DATA_WRITE:
+        {
+            if (p_vci_ini_d.rspval.read())
+            {
+                assert( p_vci_ini_d.reop.read() and
+                "a VCI response packet must contain one flit for a write transaction");
+
+                r_vci_rsp_fsm = RSP_IDLE;
+                uint32_t   wbuf_index = p_vci_ini_d.rtrdid.read();
+                bool       cacheable  = r_wbuf.completed(wbuf_index);
+                if ( not cacheable ) r_dcache_pending_unc_write = false;
+                if ( (p_vci_ini_d.rerror.read()&0x1) != 0 ) r_iss.setWriteBerr();
+            }
+            break;
+        }
+    } // end switch r_vci_rsp_fsm
+
+    /////////////////////////////////////////////////////////////////////////////////////
+    // The CLEANUP_CMD FSM is in charge to send the cleanup commands on the coherence 
+    // network. It has two clients (DCACHE FSM and ICACHE FSM) that are served
+    // with a round-robin priority. All cleanup commands are registered in the 
+    // r_cleanup_buffer, because we must avoid to send a Read Miss command 
+    // for line (X) if there is a pending cleanup for line (X): the r_cleanup_buffer 
+    // is tested by the ICACHE FSM and DCACHE FSM before posting a miss request.
+    // The CLEANUP FSM resets the r_*cache_cleanup request flip-flops as soon as 
+    // the request has been sent and registered in the buffer.
+    // The buffer itself is cleared when the cleanup response is received.
+    // We use an assocative registration buffer (CAM) in order to support several
+    // simultaneous cleanup transactions (up to 4 simultaneous clenups).
+    // The VCI TRDID field is used to distinguish data/instruction cleanups and to
+    // transmit the way :
+    // - if data cleanup        : TRDID = 2*way + 0
+    // - if instruction cleanup : TRDID = 2*way + 1
+    /////////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_cleanup_cmd_fsm.read() ) 
+    {
+        ///////////////////////////
+        case CLEANUP_CMD_DATA_IDLE:     // dcache has highest priority
+        {
+            if ( r_dcache_cleanup_req.read() )      // dcache request
+            {
+                r_cleanup_cmd_fsm   = CLEANUP_CMD_DATA_GO; 
+                r_cleanup_cmd_trdid = r_dcache_cleanup_way.read()<<1;
+            }
+            else if ( r_icache_cleanup_req.read() ) // icache request
+            {
+                r_cleanup_cmd_fsm   = CLEANUP_CMD_INS_GO; 
+                r_cleanup_cmd_trdid = r_icache_cleanup_way.read()<<1 + 1;
+            }
+            break;
+        }
+        //////////////////////////
+        case CLEANUP_CMD_INS_IDLE:     // icache has highest priority
+        {
+            if ( r_icache_cleanup_req.read() )      // icache request
+            {
+                r_cleanup_cmd_fsm   = CLEANUP_CMD_INS_GO;
+                r_cleanup_cmd_trdid = r_icache_cleanup_way.read()<<1 + 1;
+            }
+            else if ( r_dcache_cleanup_req.read() ) // dcache request
+            {
+                r_cleanup_cmd_fsm   = CLEANUP_CMD_DATA_GO;
+                r_cleanup_cmd_trdid = r_dcache_cleanup_way.read()<<1;
+            }
+            break;
+        }
+        /////////////////////////
+        case CLEANUP_CMD_DATA_GO:
+        {
+            if ( p_vci_ini_c.cmdack.read() )
+            {
+                r_cleanup_cmd_fsm    = CLEANUP_CMD_INS_IDLE;
+                r_dcache_cleanup_req = false;
+
+#if DEBUG_CLEANUP
+if ( m_debug_cleanup_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " CLEANUP_DATA_GO> Cleanup request for icache:" << std::hex
+              << " PADDR = " << (r_dcache_cleanup_line.read()*m_dcache_words*4)
+              << " / TRDID = " << std::dec << r_cleanup_cmd_trdid.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        ////////////////////////
+        case CLEANUP_CMD_INS_GO:
+        {
+            if ( p_vci_ini_c.cmdack.read() )
+            {
+                r_cleanup_cmd_fsm    = CLEANUP_CMD_DATA_IDLE;
+                r_icache_cleanup_req = false;
+
+#if DEBUG_CLEANUP
+if ( m_debug_cleanup_fsm )
+{
+    std::cout << "  <PROC " << name() 
+              << " CLEANUP_INS_GO> Cleanup request for dcache:" << std::hex
+              << " PADDR = " << (r_icache_cleanup_line.read()*m_icache_words*4)
+              << " / TRDID = " << std::dec << r_cleanup_cmd_trdid.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+    } // end switch CLEANUP FSM
+
+    /////////////////////////////////////////////////////////////////////////////////////
+    // The CLEANUP_RSP FSM is in charge to dispatch the cleanup responses to the
+    // ICACHE and DCACHE FSMs. The response arguments (set and way) are writen
+    // in dedicated buffers for ICACHE FSM and DCACHE FSM.
+    // These buffers are protected by two SET/RESET flip-flops, that are set 
+    // by the CLEANUP_RSP FSM, and reset by the selected FSM when the response 
+    // has been processed.
+    /////////////////////////////////////////////////////////////////////////////////////
+
+    switch( r_cleanup_rsp_fsm.read() )
+    {
+        //////////////////////
+        case CLEANUP_RSP_IDLE:
+        {
+            if ( p_vci_ini_c.rspval.read() )   
+            {
+                if((p_vci_ini_c.rtrdid.read() & 0x1) == 0x1)  // ICACHE
+                {
+                    r_cleanup_rsp_fsm = CLEANUP_RSP_INS;
+                }
+                else                                          // DCACHE
+                {
+                    r_cleanup_rsp_fsm = CLEANUP_RSP_DATA;
+                }
+            }
+            break;
+        }
+        /////////////////////
+        case CLEANUP_RSP_INS:
+        {
+            if ( not r_cleanup_icache_req.read() )    // buffer empty
+            {
+                r_cleanup_icache_req = true;
+                r_cleanup_icache_way   = p_vci_ini_c.rtrdid.read() >> 1;
+                r_cleanup_icache_set   = p_vci_ini_c.rdata.read() & (m_icache_sets-1);
+                r_cleanup_rsp_fsm      = CLEANUP_RSP_IDLE;
+            }
+            break;
+        }
+        //////////////////////
+        case CLEANUP_RSP_DATA:
+        {
+            if ( not r_cleanup_dcache_req.read() )    // buffer empty
+            {
+                r_cleanup_dcache_req = true;
+                r_cleanup_dcache_way   = p_vci_ini_c.rtrdid.read() >> 1;
+                r_cleanup_dcache_set   = p_vci_ini_c.rdata.read() & (m_dcache_sets-1);
+                r_cleanup_rsp_fsm      = CLEANUP_RSP_IDLE;
+            }
+            break;
+        }
+    } // end switch CLEANUP_RSP
+
+
+    ///////////////// Response FIFOs update  //////////////////////
+    r_vci_rsp_fifo_icache.update(vci_rsp_fifo_icache_get,
+                                 vci_rsp_fifo_icache_put,
+                                 vci_rsp_fifo_icache_data);
+
+    r_vci_rsp_fifo_dcache.update(vci_rsp_fifo_dcache_get,
+                                 vci_rsp_fifo_dcache_put,
+                                 vci_rsp_fifo_dcache_data);
+
+} // end transition()
+
+///////////////////////
+tmpl(void)::genMoore()
+///////////////////////
+{
+    // VCI initiator command on the coherence network (cleanup)
+    // it depends on the CLEANUP_CMD FSM state
+
+    paddr_t  cleanup_nline;
+    paddr_t  address;
+
+    if ( r_cleanup_cmd_fsm.read() == CLEANUP_CMD_DATA_GO )
+    {
+        cleanup_nline = r_dcache_cleanup_line.read();
+        address       = (m_x_width + m_y_width) ? (cleanup_nline * m_dcache_words * 4    ) >>
+                                                  (vci_param::N  - m_x_width - m_y_width ) : 0;
+    }
+    else if ( r_cleanup_cmd_fsm.read() == CLEANUP_CMD_INS_GO )
+    {
+        cleanup_nline = r_icache_cleanup_line.read();
+        address       = (m_x_width + m_y_width) ? (cleanup_nline * m_icache_words * 4    ) >>
+                                                  (vci_param::N  - m_x_width - m_y_width ) : 0;
+    }
+    else
+    {
+        cleanup_nline = 0;
+        address       = 0;
+    }
+
+    address           <<= vci_param::S - m_x_width - m_y_width;
+    address            |= m_memory_cache_local_id;
+    address           <<= vci_param::N - vci_param::S;
+
+    p_vci_ini_c.cmdval  = ( (r_cleanup_cmd_fsm.read() == CLEANUP_CMD_DATA_GO) or
+                            (r_cleanup_cmd_fsm.read() == CLEANUP_CMD_INS_GO) );
+    p_vci_ini_c.address = address;
+    p_vci_ini_c.wdata   = (uint32_t) cleanup_nline;
+    p_vci_ini_c.be      = (cleanup_nline >> 32) & 0x3;
+    p_vci_ini_c.plen    = 4;
+    p_vci_ini_c.cmd     = vci_param::CMD_WRITE;
+    p_vci_ini_c.trdid   = r_cleanup_cmd_trdid.read();
+    p_vci_ini_c.pktid   = 0;
+    p_vci_ini_c.srcid   = m_srcid_c;
+    p_vci_ini_c.cons    = false;
+    p_vci_ini_c.wrap    = false;
+    p_vci_ini_c.contig  = false;
+    p_vci_ini_c.clen    = 0;
+    p_vci_ini_c.cfixed  = false;
+    p_vci_ini_c.eop     = true;
+
+    // VCI initiator response on the coherence network (cleanup)
+    // it depends on the CLEANUP_RSP FSM
+
+    if ( r_cleanup_rsp_fsm.read() == CLEANUP_RSP_IDLE )
+    {
+        p_vci_ini_c.rspack  = true;
+    }
+    else if ( r_cleanup_rsp_fsm.read() == CLEANUP_RSP_DATA )
+    {
+        p_vci_ini_c.rspack  = not r_cleanup_dcache_req.read();
+    }
+    else if ( r_cleanup_rsp_fsm.read() == CLEANUP_RSP_INS )
+    {
+        p_vci_ini_c.rspack  = not r_cleanup_icache_req.read();
+    }
+
+    // VCI initiator command on the direct network
+    // it depends on the CMD FSM state
+
+    p_vci_ini_d.pktid  = 0;
+    p_vci_ini_d.srcid  = m_srcid_d;
+    p_vci_ini_d.cons   = (r_vci_cmd_fsm.read() == CMD_DATA_CAS);
+    p_vci_ini_d.contig = not (r_vci_cmd_fsm.read() == CMD_DATA_CAS);
+    p_vci_ini_d.wrap   = false;
+    p_vci_ini_d.clen   = 0;
+    p_vci_ini_d.cfixed = false;
+
+    switch ( r_vci_cmd_fsm.read() ) {
+
+    case CMD_IDLE:
+        p_vci_ini_d.cmdval  = false;
+        p_vci_ini_d.address = 0;
+        p_vci_ini_d.wdata   = 0;
+        p_vci_ini_d.be      = 0;
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = 0;
+        p_vci_ini_d.plen    = 0;
+        p_vci_ini_d.cmd     = vci_param::CMD_NOP;
+        p_vci_ini_d.eop     = false;
+        break;
+
+    case CMD_INS_MISS:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_icache_vci_paddr.read() & m_icache_yzmask;
+        p_vci_ini_d.wdata   = 0;
+        p_vci_ini_d.be      = 0xF;
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = TYPE_READ_INS_MISS;
+        p_vci_ini_d.plen    = m_icache_words<<2;
+        p_vci_ini_d.cmd     = vci_param::CMD_READ;
+        p_vci_ini_d.eop     = true;
+        break;
+
+    case CMD_INS_UNC:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_icache_vci_paddr.read() & ~0x3;
+        p_vci_ini_d.wdata   = 0;
+        p_vci_ini_d.be      = 0xF;
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = TYPE_READ_INS_UNC;
+        p_vci_ini_d.plen    = 4;
+        p_vci_ini_d.cmd     = vci_param::CMD_READ;
+        p_vci_ini_d.eop     = true;
+        break;
+
+    case CMD_DATA_MISS:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_dcache_vci_paddr.read() & m_dcache_yzmask;
+        p_vci_ini_d.wdata   = 0;
+        p_vci_ini_d.be      = 0xF;
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = TYPE_READ_DATA_MISS;
+        p_vci_ini_d.plen    = m_dcache_words << 2;
+        p_vci_ini_d.cmd     = vci_param::CMD_READ;
+        p_vci_ini_d.eop     = true;
+        break;
+
+    case CMD_DATA_UNC:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_dcache_vci_paddr.read() & ~0x3;
+        p_vci_ini_d.wdata   = 0;
+        p_vci_ini_d.be      = r_dcache_vci_unc_be.read();
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = TYPE_READ_DATA_UNC;
+        p_vci_ini_d.plen    = 4;
+        p_vci_ini_d.cmd     = vci_param::CMD_READ;
+        p_vci_ini_d.eop     = true;
+        break;
+
+    case CMD_DATA_WRITE:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_wbuf.getAddress(r_vci_cmd_cpt.read()) & ~0x3;
+        p_vci_ini_d.wdata   = r_wbuf.getData(r_vci_cmd_cpt.read());
+        p_vci_ini_d.be      = r_wbuf.getBe(r_vci_cmd_cpt.read());
+        p_vci_ini_d.trdid   = r_wbuf.getIndex();
+        p_vci_ini_d.pktid   = TYPE_WRITE;
+        p_vci_ini_d.plen    = (r_vci_cmd_max.read() - r_vci_cmd_min.read() + 1) << 2;
+        p_vci_ini_d.cmd     = vci_param::CMD_WRITE;
+        p_vci_ini_d.eop     = (r_vci_cmd_cpt.read() == r_vci_cmd_max.read());
+        break;
+
+    case CMD_DATA_LL:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_dcache_vci_paddr.read() & ~0x3;
+        p_vci_ini_d.wdata   = 0;
+        p_vci_ini_d.be      = 0xF;
+        p_vci_ini_d.trdid   = 0;    //TODO local table index
+        p_vci_ini_d.pktid   = TYPE_LL;
+        p_vci_ini_d.plen    = 8;
+        p_vci_ini_d.cmd     = vci_param::CMD_LOCKED_READ;
+        p_vci_ini_d.eop     = true;
+        break;
+
+    case CMD_DATA_SC:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_dcache_vci_paddr.read() & ~0x3;
+        if ( r_vci_cmd_cpt.read() == 0 ) p_vci_ini_d.wdata = r_dcache_llsc_key.read();
+        else                             p_vci_ini_d.wdata = r_dcache_vci_sc_data.read();
+        p_vci_ini_d.be      = 0xF;
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = TYPE_SC;
+        p_vci_ini_d.plen    = 8;
+        p_vci_ini_d.cmd     = vci_param::CMD_NOP;
+        p_vci_ini_d.eop     = (r_vci_cmd_cpt.read() == 1);
+        break;      
+
+    case CMD_DATA_CAS:
+        p_vci_ini_d.cmdval  = true;
+        p_vci_ini_d.address = r_dcache_vci_paddr.read() & ~0x3;
+        if ( r_vci_cmd_cpt.read() == 0 ) p_vci_ini_d.wdata = r_dcache_vci_cas_old.read();
+        else                             p_vci_ini_d.wdata = r_dcache_vci_cas_new.read();
+        p_vci_ini_d.be      = 0xF;
+        p_vci_ini_d.trdid   = 0;
+        p_vci_ini_d.pktid   = TYPE_CAS;
+        p_vci_ini_d.plen    = 8;
+        p_vci_ini_d.cmd     = vci_param::CMD_NOP;
+        p_vci_ini_d.eop     = (r_vci_cmd_cpt.read() == 1);
+        break;      
+    } // end switch r_vci_cmd_fsm
+
+    // VCI initiator response on the direct network
+    // it depends on the VCI RSP state
+
+    switch (r_vci_rsp_fsm.read() )
+    {
+        case RSP_DATA_WRITE : p_vci_ini_d.rspack = true; break;
+        case RSP_INS_MISS   : p_vci_ini_d.rspack = r_vci_rsp_fifo_icache.wok(); break;
+        case RSP_INS_UNC    : p_vci_ini_d.rspack = r_vci_rsp_fifo_icache.wok(); break;
+        case RSP_DATA_MISS  : p_vci_ini_d.rspack = r_vci_rsp_fifo_dcache.wok(); break;
+        case RSP_DATA_UNC   : p_vci_ini_d.rspack = r_vci_rsp_fifo_dcache.wok(); break;
+        case RSP_DATA_LL    : p_vci_ini_d.rspack = r_vci_rsp_fifo_dcache.wok(); break;
+        case RSP_IDLE       : p_vci_ini_d.rspack = false; break;
+    } // end switch r_vci_rsp_fsm
+
+    // VCI target command and response on the coherence network
+    switch ( r_tgt_fsm.read() ) 
+    {
+    case TGT_IDLE:
+    case TGT_UPDT_WORD:
+    case TGT_UPDT_DATA:
+        p_vci_tgt_c.cmdack  = true;
+        p_vci_tgt_c.rspval  = false;
+        break;
+
+    case TGT_RSP_ICACHE:
+        p_vci_tgt_c.cmdack  = false;
+        p_vci_tgt_c.rspval  = not r_tgt_icache_req.read() and r_icache_tgt_need_rsp.read();
+        p_vci_tgt_c.rsrcid  = r_tgt_srcid.read();
+        p_vci_tgt_c.rpktid  = r_tgt_pktid.read();
+        p_vci_tgt_c.rtrdid  = r_tgt_trdid.read();
+        p_vci_tgt_c.rdata   = 0;
+        p_vci_tgt_c.rerror  = 0;
+        p_vci_tgt_c.reop    = true;
+        break;
+
+    case TGT_RSP_DCACHE:
+        p_vci_tgt_c.cmdack  = false;
+        p_vci_tgt_c.rspval  = not r_tgt_dcache_req.read() and r_dcache_tgt_need_rsp.read();
+        p_vci_tgt_c.rsrcid  = r_tgt_srcid.read();
+        p_vci_tgt_c.rpktid  = r_tgt_pktid.read();
+        p_vci_tgt_c.rtrdid  = r_tgt_trdid.read();
+        p_vci_tgt_c.rdata   = 0;
+        p_vci_tgt_c.rerror  = 0;
+        p_vci_tgt_c.reop    = true;
+        break;
+
+    case TGT_RSP_BROADCAST:     // no response for broadcast...
+    case TGT_REQ_BROADCAST:
+    case TGT_REQ_ICACHE:
+    case TGT_REQ_DCACHE:
+        p_vci_tgt_c.cmdack  = false;
+        p_vci_tgt_c.rspval  = false;
+        break;
+
+    } // end switch TGT_FSM
+} // end genMoore
+
+}}
+
+// Local Variables:
+// tab-width: 4
+// c-basic-offset: 4
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=4:tabstop=4:softtabstop=4
Index: /branches/v5/modules/vci_mem_cache/caba/metadata/vci_mem_cache.sd
===================================================================
--- /branches/v5/modules/vci_mem_cache/caba/metadata/vci_mem_cache.sd	(revision 300)
+++ /branches/v5/modules/vci_mem_cache/caba/metadata/vci_mem_cache.sd	(revision 300)
@@ -0,0 +1,60 @@
+
+# -*- python -*-
+
+__id__ = "$Id$"
+__version__ = "$Revision$"
+
+Module('caba:vci_mem_cache',
+        classname = 'soclib::caba::VciMemCache',
+
+        tmpl_parameters = [ parameter.Module('vci_param', default = 'caba:vci_param') ],
+
+        header_files = [
+            '../source/include/vci_mem_cache.h',
+            '../source/include/xram_transaction.h',
+            '../source/include/mem_cache_directory.h',
+            '../source/include/update_tab.h'
+        ],
+
+        implementation_files = [ '../source/src/vci_mem_cache.cpp' ],
+
+        uses = [
+            Uses('caba:base_module'),
+            Uses('common:loader'),
+            Uses('common:mapping_table'),
+            Uses('caba:generic_fifo'),
+            Uses('caba:generic_llsc_global_table'),
+        ],
+
+        ports = [
+            Port( 'caba:vci_target'   , 'p_vci_tgt' ),
+            Port( 'caba:vci_target'   , 'p_vci_tgt_cleanup' ),
+            Port( 'caba:vci_initiator', 'p_vci_ini' ),
+            Port( 'caba:vci_initiator', 'p_vci_ixr' ),
+            Port( 'caba:bit_in'       , 'p_resetn'  , auto = 'resetn' ),
+            Port( 'caba:clock_in'     , 'p_clk'     , auto = 'clock'  ),
+        ],
+
+        instance_parameters = [
+            parameter.Module( 'mtp', 'common:mapping_table' ),
+            parameter.Module( 'mtc', 'common:mapping_table' ),
+            parameter.Module( 'mtx', 'common:mapping_table' ),
+            parameter.IntTab( 'vci_ixr_index' ),
+            parameter.IntTab( 'vci_ini_index' ),
+            parameter.IntTab( 'vci_tgt_index' ),
+            parameter.IntTab( 'vci_tgt_index_cleanup '),
+            parameter.Int   ( 'nways' ),
+            parameter.Int   ( 'nsets' ),
+            parameter.Int   ( 'nwords' ),
+            parameter.Int   ( 'heap_size' ),
+        ],
+
+        extensions = [
+            'dsx:get_ident='
+            'vci_ini_index:p_vci_ini:mtc,'
+            'vci_tgt_index_cleanup:p_vci_tgt_cleanup:mtc,'
+            'vci_tgt_index:p_vci_tgt:mtp,'
+            'vci_ixr_index:p_vci_ixr:mtx',
+            'dsx:addressable=vci_tgt_index,vci_tgt_index_cleanup',
+        ],
+)
Index: /branches/v5/modules/vci_mem_cache/caba/source/include/mem_cache_directory.h
===================================================================
--- /branches/v5/modules/vci_mem_cache/caba/source/include/mem_cache_directory.h	(revision 300)
+++ /branches/v5/modules/vci_mem_cache/caba/source/include/mem_cache_directory.h	(revision 300)
@@ -0,0 +1,727 @@
+#ifndef SOCLIB_CABA_MEM_CACHE_DIRECTORY_H
+#define SOCLIB_CABA_MEM_CACHE_DIRECTORY_H 
+
+#include <inttypes.h>
+#include <systemc>
+#include <cassert>
+#include "arithmetics.h"
+
+// !!!
+// The L1_MULTI_CACHE mechanism does no longer work with the new pktid encoding
+// of TSAR. Turning the define below to a non null value will cause the memcache
+// to behave in an unpredicted way.
+// TODO Either remove the mechanism from the mem cache or update its behaviour.
+#define L1_MULTI_CACHE 0
+
+//#define RANDOM_EVICTION
+
+namespace soclib { namespace caba {
+
+  using namespace sc_core;
+
+  ////////////////////////////////////////////////////////////////////////
+  //                    A LRU entry 
+  ////////////////////////////////////////////////////////////////////////
+  class LruEntry {
+
+    public:
+
+      bool recent;            
+
+      void init()
+      {
+        recent=false;
+      }
+
+  }; // end class LruEntry
+
+  ////////////////////////////////////////////////////////////////////////
+  //                    An Owner
+  ////////////////////////////////////////////////////////////////////////
+  class Owner{
+    typedef uint32_t size_t;
+    
+    public:
+    // Fields
+      bool      inst;       // Is the owner an ICache ?
+      size_t    srcid;      // The SRCID of the owner
+#if L1_MULTI_CACHE
+      size_t    cache_id;   // In multi_cache configuration
+#endif
+
+    ////////////////////////
+    // Constructors
+    ////////////////////////
+      Owner(bool   i_inst
+            ,size_t i_srcid
+#if L1_MULTI_CACHE
+            ,size_t i_cache_id
+#endif
+            ){
+        inst    = i_inst;
+        srcid   = i_srcid;
+#if L1_MULTI_CACHE
+        cache_id= i_cache_id;
+#endif
+      }
+
+      Owner(const Owner &a){
+        inst    = a.inst;
+        srcid   = a.srcid;
+#if L1_MULTI_CACHE
+        cache_id= a.cache_id;
+#endif
+      }
+
+      Owner(){
+        inst    = false;
+        srcid   = 0;
+#if L1_MULTI_CACHE
+        cache_id= 0;
+#endif
+      }
+      // end constructors
+
+  }; // end class Owner
+
+
+  ////////////////////////////////////////////////////////////////////////
+  //                    A directory entry                               
+  ////////////////////////////////////////////////////////////////////////
+  class DirectoryEntry {
+
+    typedef uint32_t tag_t;
+    typedef uint32_t size_t;
+
+    public:
+
+    bool    valid;                  // entry valid
+    bool    is_cnt;                 // directory entry is in counter mode
+    bool    dirty;                  // entry dirty
+    bool    lock;                   // entry locked
+    tag_t   tag;                    // tag of the entry
+    size_t  count;                  // number of copies
+    Owner   owner;                  // an owner of the line 
+    size_t  ptr;                    // pointer to the next owner
+
+    DirectoryEntry()
+    {
+      valid         = false;
+      is_cnt        = false;
+      dirty         = false;
+      lock          = false;
+      tag           = 0;
+      count         = 0;
+      owner.inst    = 0;
+      owner.srcid   = 0;
+#if L1_MULTI_CACHE
+      owner.cache_id= 0;
+#endif
+      ptr           = 0;
+    }
+
+    DirectoryEntry(const DirectoryEntry &source)
+    {
+      valid         = source.valid;
+      is_cnt        = source.is_cnt;
+      dirty         = source.dirty;
+      lock          = source.lock;
+      tag           = source.tag;
+      count         = source.count;
+      owner         = source.owner;
+      ptr           = source.ptr;
+    }          
+
+    /////////////////////////////////////////////////////////////////////
+    // The init() function initializes the entry 
+    /////////////////////////////////////////////////////////////////////
+    void init()
+    {
+      valid     = false;
+      is_cnt    = false;
+      dirty     = false;
+      lock      = false;
+      count     = 0;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The copy() function copies an existing source entry to a target 
+    /////////////////////////////////////////////////////////////////////
+    void copy(const DirectoryEntry &source)
+    {
+      valid	    = source.valid;
+      is_cnt    = source.is_cnt;
+      dirty	    = source.dirty;
+      lock	    = source.lock;
+      tag	    = source.tag;
+      count     = source.count;
+      owner     = source.owner;
+      ptr       = source.ptr;
+    }
+
+    ////////////////////////////////////////////////////////////////////
+    // The print() function prints the entry 
+    ////////////////////////////////////////////////////////////////////
+    void print()
+    {
+      std::cout << "Valid = " << valid << " ; IS COUNT = " << is_cnt << " ; Dirty = " << dirty << " ; Lock = " 
+                << lock 
+                << " ; Tag = " << std::hex << tag << std::dec 
+                << " ; Count = " << count 
+                << " ; Owner = " << owner.srcid 
+#if L1_MULTI_CACHE
+                << "." << owner.cache_id 
+#endif
+                << " " << owner.inst 
+                << " ; Pointer = " << ptr << std::endl;
+    }
+
+  }; // end class DirectoryEntry
+
+  ////////////////////////////////////////////////////////////////////////
+  //                       The directory  
+  ////////////////////////////////////////////////////////////////////////
+  class CacheDirectory {
+
+    typedef sc_dt::sc_uint<40> addr_t;
+    typedef uint32_t data_t;
+    typedef uint32_t tag_t;
+    typedef uint32_t size_t;
+
+    private:
+
+    // Directory constants
+    size_t					m_ways;
+    size_t					m_sets;
+    size_t					m_words;
+    size_t					m_width;
+    uint32_t                lfsr;
+
+    // the directory & lru tables
+    DirectoryEntry 				**m_dir_tab;
+    LruEntry	 				**m_lru_tab;
+
+    public:
+
+    ////////////////////////
+    // Constructor
+    ////////////////////////
+    CacheDirectory( size_t ways, size_t sets, size_t words, size_t address_width)	 
+    {
+      m_ways  = ways; 
+      m_sets  = sets;
+      m_words = words;
+      m_width = address_width;
+      lfsr = -1;
+
+      m_dir_tab = new DirectoryEntry*[sets];
+      for ( size_t i=0; i<sets; i++ ) {
+        m_dir_tab[i] = new DirectoryEntry[ways];
+        for ( size_t j=0 ; j<ways ; j++) m_dir_tab[i][j].init();
+      }
+      m_lru_tab = new LruEntry*[sets];
+      for ( size_t i=0; i<sets; i++ ) {
+        m_lru_tab[i] = new LruEntry[ways];
+        for ( size_t j=0 ; j<ways ; j++) m_lru_tab[i][j].init();
+      }
+    } // end constructor
+
+    /////////////////
+    // Destructor
+    /////////////////
+    ~CacheDirectory()
+    {
+      for(size_t i=0 ; i<m_sets ; i++){
+        delete [] m_dir_tab[i];
+        delete [] m_lru_tab[i];
+      }
+      delete [] m_dir_tab;
+      delete [] m_lru_tab;
+    } // end destructor
+
+    /////////////////////////////////////////////////////////////////////
+    // The read() function reads a directory entry. In case of hit, the
+    // LRU is updated.
+    // Arguments :
+    // - address : the address of the entry 
+    // - way : (return argument) the way of the entry in case of hit
+    // The function returns a copy of a (valid or invalid) entry  
+    /////////////////////////////////////////////////////////////////////
+    DirectoryEntry read(const addr_t &address,size_t &way)
+    {
+
+#define L2 soclib::common::uint32_log2
+      const size_t set = (size_t)(address >> (L2(m_words) + 2)) & (m_sets - 1);
+      const tag_t  tag = (tag_t)(address >> (L2(m_sets) + L2(m_words) + 2));
+#undef L2
+
+      bool hit       = false;
+      for ( size_t i=0 ; i<m_ways ; i++ ) {
+        bool equal = ( m_dir_tab[set][i].tag == tag );
+        bool valid = m_dir_tab[set][i].valid;
+        hit = equal && valid;
+        if ( hit ) {			
+          way = i;
+          break;
+        } 
+      }
+      if ( hit ) {
+        m_lru_tab[set][way].recent = true;
+        return DirectoryEntry(m_dir_tab[set][way]);
+      } else {
+        return DirectoryEntry();
+      }
+    } // end read()
+
+    /////////////////////////////////////////////////////////////////////
+    // The read_neutral() function reads a directory entry, without
+    // changing the LRU
+    // Arguments :
+    // - address : the address of the entry 
+    // The function returns a copy of a (valid or invalid) entry  
+    /////////////////////////////////////////////////////////////////////
+    DirectoryEntry read_neutral(const addr_t &address)
+    {
+
+#define L2 soclib::common::uint32_log2
+      const size_t set = (size_t)(address >> (L2(m_words) + 2)) & (m_sets - 1);
+      const tag_t  tag = (tag_t)(address >> (L2(m_sets) + L2(m_words) + 2));
+#undef L2
+
+      bool hit       = false;
+      for ( size_t i=0 ; i<m_ways ; i++ ) {
+        bool equal = ( m_dir_tab[set][i].tag == tag );
+        bool valid = m_dir_tab[set][i].valid;
+        hit = equal && valid;
+        if ( hit ) {			
+          return DirectoryEntry(m_dir_tab[set][i]);
+        } 
+      }
+      return DirectoryEntry();
+    } // end read_neutral()
+
+    /////////////////////////////////////////////////////////////////////
+    // The write function writes a new entry, 
+    // and updates the LRU bits if necessary.
+    // Arguments :
+    // - set : the set of the entry
+    // - way : the way of the entry
+    // - entry : the entry value
+    /////////////////////////////////////////////////////////////////////
+    void write(const size_t &set, const size_t &way, const DirectoryEntry &entry)
+    {
+      assert( (set<m_sets) 
+          && "Cache Directory write : The set index is invalid");
+      assert( (way<m_ways) 
+          && "Cache Directory write : The way index is invalid");
+
+      // update Directory
+      m_dir_tab[set][way].copy(entry);
+
+      // update LRU bits
+      bool all_recent = true;
+      for ( size_t i=0 ; i<m_ways ; i++ ) {
+        if ( i != way ) all_recent = m_lru_tab[set][i].recent && all_recent;
+      }
+      if ( all_recent ) {
+        for( size_t i=0 ; i<m_ways ; i++ ) m_lru_tab[set][i].recent = false;
+      } else {
+        m_lru_tab[set][way].recent = true;
+      }
+    } // end write()
+
+    /////////////////////////////////////////////////////////////////////
+    // The print() function prints a selected directory entry
+    // Arguments :
+    // - set : the set of the entry to print
+    // - way : the way of the entry to print
+    /////////////////////////////////////////////////////////////////////
+    void print(const size_t &set, const size_t &way)
+    {
+      std::cout << std::dec << " set : " << set << " ; way : " << way << " ; " ;
+      m_dir_tab[set][way].print();
+    } // end print()
+
+    /////////////////////////////////////////////////////////////////////
+    // The select() function selects a directory entry to evince.
+    // Arguments :
+    // - set   : (input argument) the set to modify
+    // - way   : (return argument) the way to evince
+    /////////////////////////////////////////////////////////////////////
+    DirectoryEntry select(const size_t &set, size_t &way)
+    {
+      assert( (set < m_sets) 
+          && "Cache Directory : (select) The set index is invalid");
+
+      for(size_t i=0; i<m_ways; i++){
+        if(!m_dir_tab[set][i].valid){
+          way=i;
+          return DirectoryEntry(m_dir_tab[set][way]);
+        }
+      }
+
+#ifdef RANDOM_EVICTION
+      lfsr = (lfsr >> 1) ^ ((-(lfsr & 1)) & 0xd0000001);
+      way = lfsr % m_ways;
+      return DirectoryEntry(m_dir_tab[set][way]);
+#endif
+
+      for(size_t i=0; i<m_ways; i++){
+        if(!(m_lru_tab[set][i].recent) && !(m_dir_tab[set][i].lock)){
+          way=i;
+          return DirectoryEntry(m_dir_tab[set][way]);
+        }
+      }
+      for(size_t i=0; i<m_ways; i++){
+        if( !(m_lru_tab[set][i].recent) && (m_dir_tab[set][i].lock)){
+          way=i;
+          return DirectoryEntry(m_dir_tab[set][way]);
+        }
+      }
+      for(size_t i=0; i<m_ways; i++){
+        if( (m_lru_tab[set][i].recent) && !(m_dir_tab[set][i].lock)){
+          way=i;
+          return DirectoryEntry(m_dir_tab[set][way]);
+        }
+      }
+      way = 0;
+      return DirectoryEntry(m_dir_tab[set][0]);
+    } // end select()
+
+    /////////////////////////////////////////////////////////////////////
+    // 		Global initialisation function
+    /////////////////////////////////////////////////////////////////////
+    void init()
+    {
+      for ( size_t set=0 ; set<m_sets ; set++ ) {
+        for ( size_t way=0 ; way<m_ways ; way++ ) {
+          m_dir_tab[set][way].init();
+          m_lru_tab[set][way].init();
+        }
+      }
+    } // end init()
+
+  }; // end class CacheDirectory
+
+  ///////////////////////////////////////////////////////////////////////
+  //                    A Heap Entry
+  ///////////////////////////////////////////////////////////////////////
+  class HeapEntry{
+    typedef uint32_t size_t;
+
+    public:
+    // Fields of the entry
+      Owner     owner;
+      size_t    next;
+
+    ////////////////////////
+    // Constructor
+    ////////////////////////
+      HeapEntry()
+      :owner(false,0
+#if L1_MULTI_CACHE
+             ,0
+#endif
+             )
+      {
+        next = 0;
+      } // end constructor
+
+    ////////////////////////
+    // Constructor
+    ////////////////////////
+      HeapEntry(const HeapEntry &entry){
+        owner.inst  = entry.owner.inst;
+        owner.srcid = entry.owner.srcid;
+#if L1_MULTI_CACHE
+        owner.cache_id = entry.owner.cache_id;
+#endif        
+        next           = entry.next;
+      } // end constructor
+
+    /////////////////////////////////////////////////////////////////////
+    // The copy() function copies an existing source entry to a target 
+    /////////////////////////////////////////////////////////////////////
+      void copy(const HeapEntry &entry){
+        owner.inst     = entry.owner.inst;
+        owner.srcid    = entry.owner.srcid;
+#if L1_MULTI_CACHE
+        owner.cache_id = entry.owner.cache_id;
+#endif
+        next           = entry.next;
+      } // end copy()
+
+    ////////////////////////////////////////////////////////////////////
+    // The print() function prints the entry 
+    ////////////////////////////////////////////////////////////////////
+      void print(){
+        std::cout 
+        << " -- owner.inst     : " << std::dec << owner.inst << std::endl
+        << " -- owner.srcid    : " << std::dec << owner.srcid << std::endl
+#if L1_MULTI_CACHE
+        << " -- owner.cache_id : " << std::dec << owner.cache_id << std::endl
+#endif
+        << " -- next           : " << std::dec << next << std::endl;
+
+      } // end print()
+
+  }; // end class HeapEntry
+
+  ////////////////////////////////////////////////////////////////////////
+  //                        The Heap 
+  ////////////////////////////////////////////////////////////////////////
+  class HeapDirectory{
+    typedef uint32_t size_t;
+    
+    private:
+    // Registers and the heap
+      size_t    ptr_free;
+      bool      full;
+      HeapEntry *m_heap_tab;
+
+    // Constants for debugging purpose
+      size_t    tab_size;
+
+    public:
+    ////////////////////////
+    // Constructor
+    ////////////////////////
+      HeapDirectory(uint32_t size){
+        assert(size>0 && "Memory Cache, HeapDirectory constructor : invalid size");
+        ptr_free    = 0;
+        full        = false;
+        m_heap_tab  = new HeapEntry[size];
+        tab_size    = size;
+      } // end constructor
+
+    /////////////////
+    // Destructor
+    /////////////////
+      ~HeapDirectory(){
+        delete [] m_heap_tab;
+      } // end destructor
+
+    /////////////////////////////////////////////////////////////////////
+    // 		Global initialisation function
+    /////////////////////////////////////////////////////////////////////
+      void init(){
+        ptr_free=0;
+        full=false;
+        for(size_t i=0; i< tab_size-1;i++){
+          m_heap_tab[i].next = i+1;
+        }
+        m_heap_tab[tab_size-1].next = tab_size-1;
+        return;
+      }
+
+    /////////////////////////////////////////////////////////////////////
+    // The print() function prints a selected directory entry
+    // Arguments :
+    // - ptr : the pointer to the entry to print
+    /////////////////////////////////////////////////////////////////////
+      void print(const size_t &ptr){
+        std::cout << "Heap, printing the entry : " << std::dec << ptr << std::endl;
+        m_heap_tab[ptr].print();
+      } // end print()
+
+    /////////////////////////////////////////////////////////////////////
+    // The print_list() function prints a list from selected directory entry
+    // Arguments :
+    // - ptr : the pointer to the first entry to print
+    /////////////////////////////////////////////////////////////////////
+      void print_list(const size_t &ptr){
+        bool end = false;
+        size_t ptr_temp = ptr;
+        std::cout << "Heap, printing the list from : " << std::dec << ptr << std::endl;
+        while(!end){
+            m_heap_tab[ptr_temp].print();
+            if(ptr_temp == m_heap_tab[ptr_temp].next) end = true;
+            ptr_temp = m_heap_tab[ptr_temp].next;
+        } 
+      } // end print_list()
+
+    /////////////////////////////////////////////////////////////////////
+    // The is_full() function return true if the heap is full.
+    /////////////////////////////////////////////////////////////////////
+      bool is_full(){
+        return full;
+      } // end is_full()
+
+    /////////////////////////////////////////////////////////////////////
+    // The next_free_ptr() function returns the pointer 
+    // to the next free entry.
+    /////////////////////////////////////////////////////////////////////
+      size_t next_free_ptr(){
+        return ptr_free;
+      } // end next_free_ptr()
+
+    /////////////////////////////////////////////////////////////////////
+    // The next_free_entry() function returns 
+    // a copy of the next free entry.
+    /////////////////////////////////////////////////////////////////////
+      HeapEntry next_free_entry(){
+        return HeapEntry(m_heap_tab[ptr_free]);
+      } // end next_free_entry()
+   
+    /////////////////////////////////////////////////////////////////////
+    // The write_free_entry() function modify the next free entry.
+    // Arguments :
+    // - entry : the entry to write
+    /////////////////////////////////////////////////////////////////////
+      void write_free_entry(const HeapEntry &entry){
+        m_heap_tab[ptr_free].copy(entry);
+      } // end write_free_entry()
+
+    /////////////////////////////////////////////////////////////////////
+    // The write_free_ptr() function writes the pointer
+    // to the next free entry
+    /////////////////////////////////////////////////////////////////////
+      void write_free_ptr(const size_t &ptr){
+        assert( (ptr<tab_size) && "HeapDirectory error : try to write a wrong free pointer");
+        ptr_free = ptr;
+      } // end write_free_ptr()
+
+    /////////////////////////////////////////////////////////////////////
+    // The set_full() function sets the full bit (to true).
+    /////////////////////////////////////////////////////////////////////
+      void set_full(){
+        full = true;
+      } // end set_full()
+
+    /////////////////////////////////////////////////////////////////////
+    // The unset_full() function unsets the full bit (to false).
+    /////////////////////////////////////////////////////////////////////
+      void unset_full(){
+        full = false;
+      } // end unset_full()
+
+    /////////////////////////////////////////////////////////////////////
+    // The read() function returns a copy of
+    // the entry pointed by the argument
+    // Arguments :
+    //  - ptr : the pointer to the entry to read
+    /////////////////////////////////////////////////////////////////////
+      HeapEntry read(const size_t &ptr){
+        assert( (ptr<tab_size) && "HeapDirectory error : try to write a wrong free pointer");
+        return HeapEntry(m_heap_tab[ptr]);
+      } // end read()
+
+    /////////////////////////////////////////////////////////////////////
+    // The write() function writes an entry in the heap
+    // Arguments :
+    //  - ptr : the pointer to the entry to replace
+    //  - entry : the entry to write
+    /////////////////////////////////////////////////////////////////////
+      void write(const size_t &ptr, const HeapEntry &entry){
+        assert( (ptr<tab_size) && "HeapDirectory error : try to write a wrong free pointer");
+        m_heap_tab[ptr].copy(entry);
+      } // end write()
+
+  }; // end class HeapDirectory
+
+  ////////////////////////////////////////////////////////////////////////
+  //                        Cache Data 
+  ////////////////////////////////////////////////////////////////////////
+  class CacheData {
+    private:
+      const uint32_t m_sets;
+      const uint32_t m_ways;
+      const uint32_t m_words;
+
+      uint32_t *** m_cache_data;
+
+    public:
+
+      CacheData(uint32_t ways, uint32_t sets, uint32_t words)
+        : m_sets(sets), m_ways(ways), m_words(words) {
+
+          m_cache_data = new uint32_t ** [ways];
+          for ( size_t i=0 ; i < ways ; i++ ) {
+            m_cache_data[i] = new uint32_t * [sets];
+          }
+          for ( size_t i=0; i<ways; i++ ) {
+            for ( size_t j=0; j<sets; j++ ) {
+              m_cache_data[i][j] = new uint32_t [words];
+            }
+          }
+        }
+
+      ~CacheData() {
+          for(size_t i=0; i<m_ways ; i++){
+              for(size_t j=0; j<m_sets ; j++){
+                  delete [] m_cache_data[i][j];
+              }
+          }
+          for(size_t i=0; i<m_ways ; i++){
+              delete [] m_cache_data[i];
+          }
+          delete [] m_cache_data;
+      }
+
+      uint32_t read (
+          const uint32_t &way,
+          const uint32_t &set,
+          const uint32_t &word) const {
+
+        assert((set  < m_sets ) && "Cache data error: Trying to read a wrong set" );
+        assert((way  < m_ways ) && "Cache data error: Trying to read a wrong way" );
+        assert((word < m_words) && "Cache data error: Trying to read a wrong word");
+
+        return m_cache_data[way][set][word];
+      }
+
+      void read_line(
+          const uint32_t &way,
+          const uint32_t &set,
+          sc_core::sc_signal<uint32_t> * cache_line)
+      {
+        assert((set < m_sets ) && "Cache data error: Trying to read a wrong set" );
+        assert((way < m_ways ) && "Cache data error: Trying to read a wrong way" );
+      
+        for (uint32_t word=0; word<m_words; word++)
+          cache_line[word].write(m_cache_data[way][set][word]);
+      }
+
+      void write (
+          const uint32_t &way,
+          const uint32_t &set,
+          const uint32_t &word,
+          const uint32_t &data,
+          const uint32_t &be = 0xF) {
+
+        assert((set  < m_sets ) && "Cache data error: Trying to write a wrong set" );
+        assert((way  < m_ways ) && "Cache data error: Trying to write a wrong way" );
+        assert((word < m_words) && "Cache data error: Trying to write a wrong word");
+        assert((be  <= 0xF    ) && "Cache data error: Trying to write a wrong word cell");
+
+        if (be == 0x0) return;
+
+        if (be == 0xF) {
+            m_cache_data[way][set][word] = data; 
+            return;
+        }
+
+        uint32_t mask = 0;
+        if  (be & 0x1) mask = mask | 0x000000FF;
+        if  (be & 0x2) mask = mask | 0x0000FF00;
+        if  (be & 0x4) mask = mask | 0x00FF0000;
+        if  (be & 0x8) mask = mask | 0xFF000000;
+
+        m_cache_data[way][set][word] = 
+          (data & mask) | (m_cache_data[way][set][word] & ~mask);
+      }
+  }; // end class CacheData
+
+}} // end namespaces
+
+#endif
+
+// Local Variables:
+// tab-width: 4
+// c-basic-offset: 4
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=4:tabstop=4:softtabstop=4
+
Index: /branches/v5/modules/vci_mem_cache/caba/source/include/update_tab.h
===================================================================
--- /branches/v5/modules/vci_mem_cache/caba/source/include/update_tab.h	(revision 300)
+++ /branches/v5/modules/vci_mem_cache/caba/source/include/update_tab.h	(revision 300)
@@ -0,0 +1,415 @@
+#ifndef UPDATE_TAB_H_
+#define UPDATE_TAB_H_
+
+#include <inttypes.h>
+#include <systemc>
+#include <cassert>
+#include "arithmetics.h"
+
+////////////////////////////////////////////////////////////////////////
+//                  An update tab entry    
+////////////////////////////////////////////////////////////////////////
+class UpdateTabEntry {
+  typedef uint32_t size_t;
+  typedef sc_dt::sc_uint<40> addr_t;
+
+  public:
+  bool 	    valid;      // It is a valid pending transaction
+  bool	    update;     // It is an update transaction
+  bool      brdcast;    // It is a broadcast invalidate
+  bool      rsp;        // It needs a response to the initiator
+  size_t 	srcid;      // The srcid of the initiator which wrote the data
+  size_t 	trdid;      // The trdid of the initiator which wrote the data
+  size_t 	pktid;      // The pktid of the initiator which wrote the data
+  addr_t	nline;	    // The identifier of the cache line
+  size_t 	count;      // The number of acknowledge responses to receive
+
+  UpdateTabEntry(){
+    valid	= false;
+    update  = false;
+    brdcast = false;
+    rsp     = false;
+    srcid	= 0;
+    trdid	= 0;
+    pktid	= 0;
+    nline	= 0;
+    count	= 0;
+  }
+
+  UpdateTabEntry(bool   i_valid, 
+      bool   i_update,
+      bool   i_brdcast,
+      bool   i_rsp,
+      size_t i_srcid, 
+      size_t i_trdid, 
+      size_t i_pktid, 
+      addr_t i_nline,
+      size_t i_count) 
+  {
+    valid	= i_valid;
+    update	= i_update;
+    brdcast = i_brdcast;
+    rsp     = i_rsp;
+    srcid	= i_srcid;
+    trdid	= i_trdid;
+    pktid	= i_pktid;
+    nline	= i_nline;
+    count	= i_count;
+  }
+
+  UpdateTabEntry(const UpdateTabEntry &source)
+  {
+    valid   = source.valid;
+    update  = source.update;
+    brdcast = source.brdcast;
+    rsp     = source.rsp;
+    srcid   = source.srcid;
+    trdid   = source.trdid;
+    pktid   = source.pktid;
+    nline   = source.nline;
+    count   = source.count;
+  }
+
+  ////////////////////////////////////////////////////
+  // The init() function initializes the entry 
+  ///////////////////////////////////////////////////
+  void init()
+  {
+    valid  = false;
+    update = false;
+    brdcast= false;
+    rsp    = false;
+    srcid  = 0;
+    trdid  = 0;
+    pktid  = 0;
+    nline  = 0;
+    count  = 0;
+  }
+
+  ////////////////////////////////////////////////////////////////////
+  // The copy() function copies an existing entry
+  // Its arguments are :
+  // - source : the update tab entry to copy
+  ////////////////////////////////////////////////////////////////////
+  void copy(const UpdateTabEntry &source)
+  {
+    valid  = source.valid;
+    update = source.update;
+    brdcast= source.brdcast;
+    rsp    = source.rsp;
+    srcid  = source.srcid;
+    trdid  = source.trdid;
+    pktid  = source.pktid;
+    nline  = source.nline;
+    count  = source.count;
+  }
+
+  ////////////////////////////////////////////////////////////////////
+  // The print() function prints the entry  
+  ////////////////////////////////////////////////////////////////////
+  void print(){
+    std::cout << std::dec << "valid  = " << valid  << std::endl;
+    std::cout << "update = " << update << std::endl;
+    std::cout << "brdcast= " << brdcast<< std::endl;
+    std::cout << "rsp    = " << rsp    << std::endl;
+    std::cout << "srcid  = " << srcid  << std::endl; 
+    std::cout << "trdid  = " << trdid  << std::endl; 
+    std::cout << "pktid  = " << pktid  << std::endl; 
+    std::cout << std::hex << "nline  = " << nline  << std::endl;
+    std::cout << std::dec << "count  = " << count  << std::endl;
+  }
+};
+
+////////////////////////////////////////////////////////////////////////
+//                        The update tab             
+////////////////////////////////////////////////////////////////////////
+class UpdateTab{
+
+  typedef uint32_t size_t;
+  typedef sc_dt::sc_uint<40> addr_t;
+
+  private:
+  size_t size_tab;
+  std::vector<UpdateTabEntry> tab;
+
+  public:
+
+  UpdateTab()
+    : tab(0)
+  {
+    size_tab=0;
+  }
+
+  UpdateTab(size_t size_tab_i)
+    : tab(size_tab_i)
+  {
+    size_tab=size_tab_i;
+  }
+
+  ////////////////////////////////////////////////////////////////////
+  // The size() function returns the size of the tab  
+  ////////////////////////////////////////////////////////////////////
+  const size_t size(){
+    return size_tab;
+  }
+
+
+  ////////////////////////////////////////////////////////////////////
+  // The print() function diplays the tab content 
+  ////////////////////////////////////////////////////////////////////
+  void print(){
+    for(size_t i=0; i<size_tab; i++) {
+      std::cout << "UPDATE TAB ENTRY " << std::dec << i << "--------" << std::endl;
+      tab[i].print();
+    }
+    return;
+  }
+
+
+  /////////////////////////////////////////////////////////////////////
+  // The init() function initializes the tab 
+  /////////////////////////////////////////////////////////////////////
+  void init(){
+    for ( size_t i=0; i<size_tab; i++) {
+      tab[i].init();
+    }
+  }
+
+
+  /////////////////////////////////////////////////////////////////////
+  // The reads() function reads an entry 
+  // Arguments :
+  // - entry : the entry to read
+  // This function returns a copy of the entry.
+  /////////////////////////////////////////////////////////////////////
+  UpdateTabEntry read (size_t entry)
+  {
+    assert(entry<size_tab && "Bad Update Tab Entry");
+    return UpdateTabEntry(tab[entry]);
+  }
+
+  ///////////////////////////////////////////////////////////////////////////
+  // The set() function writes an entry in the Update Table
+  // Arguments :
+  // - update : transaction type (bool)
+  // - srcid : srcid of the initiator
+  // - trdid : trdid of the initiator
+  // - pktid : pktid of the initiator
+  // - count : number of expected responses
+  // - index : (return argument) index of the selected entry
+  // This function returns true if the write successed (an entry was empty).
+  ///////////////////////////////////////////////////////////////////////////
+  bool set(const bool	update,
+      const bool   brdcast,
+      const bool   rsp,
+      const size_t srcid,
+      const size_t trdid,
+      const size_t pktid,
+      const addr_t nline,
+      const size_t count,
+      size_t &index)
+  {
+    for ( size_t i=0 ; i<size_tab ; i++ ) {
+      if( !tab[i].valid ) {
+        tab[i].valid		= true;
+        tab[i].update		= update;
+        tab[i].brdcast      = brdcast;
+        tab[i].rsp          = rsp;
+        tab[i].srcid		= (size_t) srcid;
+        tab[i].trdid		= (size_t) trdid;
+        tab[i].pktid		= (size_t) pktid;
+        tab[i].nline		= (addr_t) nline;
+        tab[i].count		= (size_t) count;
+        index			    = i;
+        return true;
+      }
+    }
+    return false;
+  } // end set()
+
+  /////////////////////////////////////////////////////////////////////
+  // The decrement() function decrements the counter for a given entry.
+  // Arguments :
+  // - index   : the index of the entry
+  // - counter : (return argument) value of the counter after decrement
+  // This function returns true if the entry is valid.
+  /////////////////////////////////////////////////////////////////////
+  bool decrement( const size_t index,
+      size_t &counter ) 
+  {
+    assert((index<size_tab) && "Bad Update Tab Entry");
+    if ( tab[index].valid ) {
+      tab[index].count--;
+      counter = tab[index].count;
+      return true;
+    } else {
+      return false;
+    }
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The is_full() function returns true if the table is full
+  /////////////////////////////////////////////////////////////////////
+  bool is_full()
+  {
+    for(size_t i = 0 ; i < size_tab ; i++){
+      if(!tab[i].valid){
+        return false;
+      }
+    }
+    return true;
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The is_not_empty() function returns true if the table is not empty
+  /////////////////////////////////////////////////////////////////////
+  bool is_not_empty()
+  {
+    for(size_t i = 0 ; i < size_tab ; i++){
+      if(tab[i].valid){
+        return true;
+      }
+    }
+    return false;
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The need_rsp() function returns the need of a response
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  bool need_rsp(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].rsp;	
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The is_update() function returns the transaction type
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  bool is_brdcast(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].brdcast;	
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The is_update() function returns the transaction type
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  bool is_update(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].update;	
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The srcid() function returns the srcid value
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  size_t srcid(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].srcid;	
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The trdid() function returns the trdid value
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  size_t trdid(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].trdid;	
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The pktid() function returns the pktid value
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  size_t pktid(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].pktid;	
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The nline() function returns the nline value
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////
+  addr_t nline(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    return tab[index].nline;
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The search_inval() function returns the index of the entry in UPT
+  // Arguments :
+  // - nline : the line number of the entry in the directory
+  /////////////////////////////////////////////////////////////////////
+  bool search_inval(const addr_t nline,size_t &index)
+  {
+    size_t i ;
+
+    for (i = 0 ; i < size_tab ; i++){
+      if((tab[i].nline == nline) && tab[i].valid){
+        if(!tab[i].update){
+          index = i ;
+          return true;
+        }
+      }
+    }
+    return false;
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The read_nline() function returns the index of the entry in UPT
+  // Arguments :
+  // - nline : the line number of the entry in the directory
+  /////////////////////////////////////////////////////////////////////
+  bool read_nline(const addr_t nline,size_t &index) 
+  {
+    size_t i ;
+
+    for (i = 0 ; i < size_tab ; i++){
+      if((tab[i].nline == nline) && tab[i].valid){
+        index = i ;
+        return true;
+      }
+    }
+    return false;
+  }
+
+  /////////////////////////////////////////////////////////////////////
+  // The clear() function erases an entry of the tab
+  // Arguments :
+  // - index : the index of the entry
+  /////////////////////////////////////////////////////////////////////       
+  void clear(const size_t index)
+  {
+    assert(index<size_tab && "Bad Update Tab Entry");
+    tab[index].valid=false;
+    return;	
+  }
+
+};
+
+#endif
+
+// Local Variables:
+// tab-width: 4
+// c-basic-offset: 4
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=4:tabstop=4:softtabstop=4
+
Index: /branches/v5/modules/vci_mem_cache/caba/source/include/vci_mem_cache.h
===================================================================
--- /branches/v5/modules/vci_mem_cache/caba/source/include/vci_mem_cache.h	(revision 300)
+++ /branches/v5/modules/vci_mem_cache/caba/source/include/vci_mem_cache.h	(revision 300)
@@ -0,0 +1,820 @@
+/* -*- c++ -*-
+ * File         : vci_mem_cache.h
+ * Date         : 26/10/2008
+ * Copyright    : UPMC / LIP6
+ * Authors      : Alain Greiner / Eric Guthmuller
+ *
+ * SOCLIB_LGPL_HEADER_BEGIN
+ *
+ * This file is part of SoCLib, GNU LGPLv2.1.
+ *
+ * SoCLib 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; version 2.1 of the License.
+ *
+ * SoCLib 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 SoCLib; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301 USA
+ *
+ * SOCLIB_LGPL_HEADER_END
+ *
+ * Maintainers: alain eric.guthmuller@polytechnique.edu
+ *              cesar.fuguet-tortolero@lip6.fr
+ *              alexandre.joannou@lip6.fr
+ *
+ * Modifications done by Christophe Choichillon on the 7/04/2009:
+ * - Adding new states in the CLEANUP FSM : CLEANUP_UPT_LOCK and CLEANUP_UPT_WRITE
+ * - Adding a new VCI target port for the CLEANUP network
+ * - Adding new state in the ALLOC_UPT_FSM : ALLOC_UPT_CLEANUP
+ *
+ * Modifications to do :
+ * - Adding new variables used by the CLEANUP FSM
+ *
+ */
+
+#ifndef SOCLIB_CABA_MEM_CACHE_H
+#define SOCLIB_CABA_MEM_CACHE_H
+
+#include <inttypes.h>
+#include <systemc>
+#include <list>
+#include <cassert>
+#include "arithmetics.h"
+#include "alloc_elems.h"
+#include "caba_base_module.h"
+#include "vci_target.h"
+#include "vci_initiator.h"
+#include "generic_fifo.h"
+#include "mapping_table.h"
+#include "int_tab.h"
+#include "generic_llsc_global_table.h"
+#include "mem_cache_directory.h"
+#include "xram_transaction.h"
+#include "update_tab.h"
+
+#define TRANSACTION_TAB_LINES 4 // Number of lines in the transaction tab
+#define UPDATE_TAB_LINES      4 // Number of lines in the update tab
+
+namespace soclib {  namespace caba {
+  using namespace sc_core;
+
+  template<typename vci_param>
+    class VciMemCache
+    : public soclib::caba::BaseModule
+    {
+      typedef sc_dt::sc_uint<40> addr_t;
+      typedef typename vci_param::fast_addr_t vci_addr_t;
+      typedef uint32_t data_t;
+      typedef uint32_t tag_t;
+      typedef uint32_t size_t;
+      typedef uint32_t be_t;
+      typedef uint32_t copy_t;
+
+      /* States of the TGT_CMD fsm */
+      enum tgt_cmd_fsm_state_e{
+        TGT_CMD_IDLE,
+        TGT_CMD_READ,
+        TGT_CMD_WRITE,
+        TGT_CMD_CAS
+      };
+
+      /* States of the TGT_RSP fsm */
+      enum tgt_rsp_fsm_state_e{
+        TGT_RSP_READ_IDLE,
+        TGT_RSP_WRITE_IDLE,
+        TGT_RSP_CAS_IDLE,
+        TGT_RSP_XRAM_IDLE,
+        TGT_RSP_INIT_IDLE,
+        TGT_RSP_CLEANUP_IDLE,
+        TGT_RSP_READ,
+        TGT_RSP_WRITE,
+        TGT_RSP_CAS,
+        TGT_RSP_XRAM,
+        TGT_RSP_INIT,
+        TGT_RSP_CLEANUP
+      };
+
+      /* States of the INIT_CMD fsm */
+      enum init_cmd_fsm_state_e{
+        INIT_CMD_INVAL_IDLE,
+        INIT_CMD_INVAL_NLINE,
+        INIT_CMD_XRAM_BRDCAST,
+        INIT_CMD_UPDT_IDLE,
+        INIT_CMD_WRITE_BRDCAST,
+        INIT_CMD_UPDT_NLINE,
+        INIT_CMD_UPDT_INDEX,
+        INIT_CMD_UPDT_DATA,
+        INIT_CMD_CAS_UPDT_IDLE,
+        INIT_CMD_CAS_BRDCAST,
+        INIT_CMD_CAS_UPDT_NLINE,
+        INIT_CMD_CAS_UPDT_INDEX,
+        INIT_CMD_CAS_UPDT_DATA,
+        INIT_CMD_CAS_UPDT_DATA_HIGH
+      };
+
+      /* States of the INIT_RSP fsm */
+      enum init_rsp_fsm_state_e{
+        INIT_RSP_IDLE,
+        INIT_RSP_UPT_LOCK,
+        INIT_RSP_UPT_CLEAR,
+        INIT_RSP_END
+      };
+
+      /* States of the READ fsm */
+      enum read_fsm_state_e{
+        READ_IDLE,
+        READ_DIR_REQ,
+        READ_DIR_LOCK,
+        READ_DIR_HIT,
+        READ_HEAP_REQ,
+        READ_HEAP_LOCK,
+        READ_HEAP_WRITE,
+        READ_HEAP_ERASE,
+        READ_HEAP_LAST,
+        READ_RSP,
+        READ_TRT_LOCK,
+        READ_TRT_SET,
+        READ_TRT_REQ
+      };
+
+      /* States of the WRITE fsm */
+      enum write_fsm_state_e{
+        WRITE_IDLE,
+        WRITE_NEXT,
+        WRITE_DIR_REQ,
+        WRITE_DIR_LOCK,
+        WRITE_DIR_READ,
+        WRITE_DIR_HIT,
+        WRITE_UPT_LOCK,
+        WRITE_UPT_HEAP_LOCK,
+        WRITE_UPT_REQ,
+        WRITE_UPT_NEXT,
+        WRITE_UPT_DEC,
+        WRITE_RSP,
+        WRITE_MISS_TRT_LOCK,
+        WRITE_MISS_TRT_DATA,
+        WRITE_MISS_TRT_SET,
+        WRITE_MISS_XRAM_REQ,
+        WRITE_BC_TRT_LOCK,
+        WRITE_BC_UPT_LOCK,
+        WRITE_BC_DIR_INVAL,
+        WRITE_BC_CC_SEND,
+        WRITE_BC_XRAM_REQ,
+        WRITE_WAIT
+      };
+
+      /* States of the IXR_RSP fsm */
+      enum ixr_rsp_fsm_state_e{
+        IXR_RSP_IDLE,
+        IXR_RSP_ACK,
+        IXR_RSP_TRT_ERASE,
+        IXR_RSP_TRT_READ
+      };
+
+      /* States of the XRAM_RSP fsm */
+      enum xram_rsp_fsm_state_e{
+        XRAM_RSP_IDLE,
+        XRAM_RSP_TRT_COPY,
+        XRAM_RSP_TRT_DIRTY,
+        XRAM_RSP_DIR_LOCK,
+        XRAM_RSP_DIR_UPDT,
+        XRAM_RSP_DIR_RSP,
+        XRAM_RSP_INVAL_LOCK,
+        XRAM_RSP_INVAL_WAIT,
+        XRAM_RSP_INVAL,
+        XRAM_RSP_WRITE_DIRTY,
+        XRAM_RSP_HEAP_REQ,
+        XRAM_RSP_HEAP_ERASE,
+        XRAM_RSP_HEAP_LAST,
+        XRAM_RSP_ERROR_ERASE,
+        XRAM_RSP_ERROR_RSP
+      };
+
+      /* States of the IXR_CMD fsm */
+      enum ixr_cmd_fsm_state_e{
+        IXR_CMD_READ_IDLE,
+        IXR_CMD_WRITE_IDLE,
+        IXR_CMD_CAS_IDLE,
+        IXR_CMD_XRAM_IDLE,
+        IXR_CMD_READ_NLINE,
+        IXR_CMD_WRITE_NLINE,
+        IXR_CMD_CAS_NLINE,
+        IXR_CMD_XRAM_DATA
+      };
+
+      /* States of the CAS fsm */
+      enum cas_fsm_state_e{
+        CAS_IDLE,
+        CAS_DIR_REQ,
+        CAS_DIR_LOCK,
+        CAS_DIR_HIT_READ,
+        CAS_DIR_HIT_WRITE,
+        CAS_UPT_LOCK,
+        CAS_UPT_HEAP_LOCK,
+        CAS_UPT_REQ,
+        CAS_UPT_NEXT,
+        CAS_BC_TRT_LOCK,
+        CAS_BC_UPT_LOCK,
+        CAS_BC_DIR_INVAL,
+        CAS_BC_CC_SEND,
+        CAS_BC_XRAM_REQ,
+        CAS_RSP_FAIL,
+        CAS_RSP_SUCCESS,
+        CAS_MISS_TRT_LOCK,
+        CAS_MISS_TRT_SET,
+        CAS_MISS_XRAM_REQ,
+        CAS_WAIT
+      };
+
+      /* States of the CLEANUP fsm */
+      enum cleanup_fsm_state_e{
+        CLEANUP_IDLE,
+        CLEANUP_DIR_REQ,
+        CLEANUP_DIR_LOCK,
+        CLEANUP_DIR_WRITE,
+        CLEANUP_HEAP_REQ,
+        CLEANUP_HEAP_LOCK,
+        CLEANUP_HEAP_SEARCH,
+        CLEANUP_HEAP_CLEAN,
+        CLEANUP_HEAP_FREE,
+        CLEANUP_UPT_LOCK,
+        CLEANUP_UPT_WRITE,
+        CLEANUP_WRITE_RSP,
+        CLEANUP_RSP
+      };
+
+      /* States of the ALLOC_DIR fsm */
+      enum alloc_dir_fsm_state_e{
+        ALLOC_DIR_RESET,
+        ALLOC_DIR_READ,
+        ALLOC_DIR_WRITE,
+        ALLOC_DIR_CAS,
+        ALLOC_DIR_CLEANUP,
+        ALLOC_DIR_XRAM_RSP
+      };
+
+      /* States of the ALLOC_TRT fsm */
+      enum alloc_trt_fsm_state_e{
+        ALLOC_TRT_READ,
+        ALLOC_TRT_WRITE,
+        ALLOC_TRT_CAS,
+        ALLOC_TRT_XRAM_RSP,
+        ALLOC_TRT_IXR_RSP
+      };
+
+      /* States of the ALLOC_UPT fsm */
+      enum alloc_upt_fsm_state_e{
+        ALLOC_UPT_WRITE,
+        ALLOC_UPT_XRAM_RSP,
+        ALLOC_UPT_INIT_RSP,
+        ALLOC_UPT_CLEANUP,
+        ALLOC_UPT_CAS
+      };
+
+      /* States of the ALLOC_HEAP fsm */
+      enum alloc_heap_fsm_state_e{
+        ALLOC_HEAP_RESET,
+        ALLOC_HEAP_READ,
+        ALLOC_HEAP_WRITE,
+        ALLOC_HEAP_CAS,
+        ALLOC_HEAP_CLEANUP,
+        ALLOC_HEAP_XRAM_RSP
+      };
+
+      /* transaction type, pktid field */
+      enum transaction_type_e
+      {
+          // b3 unused
+          // b2 READ / NOT READ
+          // Si READ
+          //  b1 DATA / INS
+          //  b0 UNC / MISS
+          // Si NOT READ
+          //  b1 accÃšs table llsc type SW / other
+          //  b2 WRITE/CAS/LL/SC
+          TYPE_READ_DATA_UNC          = 0x0,
+          TYPE_READ_DATA_MISS         = 0x1,
+          TYPE_READ_INS_UNC           = 0x2,
+          TYPE_READ_INS_MISS          = 0x3,
+          TYPE_WRITE                  = 0x4,
+          TYPE_CAS                    = 0x5,
+          TYPE_LL                     = 0x6,
+          TYPE_SC                     = 0x7
+      };
+
+      /* SC return values */
+      enum sc_status_type_e
+      {
+          SC_SUCCESS  =   0x00000000,
+          SC_FAIL     =   0x00000001
+      };
+
+      // debug variables (for each FSM)
+      size_t       m_debug_start_cycle;
+      bool         m_debug_ok;
+      bool         m_debug_global;
+      bool         m_debug_tgt_cmd_fsm;
+      bool         m_debug_tgt_rsp_fsm;
+      bool         m_debug_init_cmd_fsm;
+      bool         m_debug_init_rsp_fsm;
+      bool         m_debug_read_fsm;
+      bool         m_debug_write_fsm;
+      bool         m_debug_cas_fsm;
+      bool         m_debug_cleanup_fsm;
+      bool         m_debug_ixr_cmd_fsm;
+      bool         m_debug_ixr_rsp_fsm;
+      bool         m_debug_xram_rsp_fsm;
+      bool         m_debug_previous_hit;
+      size_t       m_debug_previous_count;
+
+      bool         m_monitor_ok;
+      vci_addr_t   m_monitor_base;
+      vci_addr_t   m_monitor_length;
+
+      // instrumentation counters
+      uint32_t     m_cpt_cycles;        // Counter of cycles
+      uint32_t     m_cpt_read;          // Number of READ transactions
+      uint32_t     m_cpt_read_miss;     // Number of MISS READ
+      uint32_t     m_cpt_write;         // Number of WRITE transactions
+      uint32_t     m_cpt_write_miss;    // Number of MISS WRITE
+      uint32_t     m_cpt_write_cells;   // Cumulated length for WRITE transactions
+      uint32_t     m_cpt_write_dirty;   // Cumulated length for WRITE transactions
+      uint32_t     m_cpt_update;        // Number of UPDATE transactions
+      uint32_t     m_cpt_trt_rb;        // Read blocked by a hit in trt
+      uint32_t     m_cpt_trt_full;      // Transaction blocked due to a full trt
+      uint32_t     m_cpt_update_mult;   // Number of targets for UPDATE
+      uint32_t     m_cpt_inval;         // Number of INVAL  transactions
+      uint32_t     m_cpt_inval_mult;    // Number of targets for INVAL
+      uint32_t     m_cpt_inval_brdcast; // Number of BROADCAST INVAL
+      uint32_t     m_cpt_cleanup;       // Number of CLEANUP transactions
+      uint32_t     m_cpt_ll;            // Number of LL transactions
+      uint32_t     m_cpt_sc;            // Number of SC transactions
+      uint32_t     m_cpt_cas;           // Number of CAS transactions
+
+      size_t       m_prev_count;
+
+      protected:
+
+      SC_HAS_PROCESS(VciMemCache);
+
+      public:
+      sc_in<bool>                           p_clk;
+      sc_in<bool>                           p_resetn;
+      soclib::caba::VciTarget<vci_param>    p_vci_tgt;
+      soclib::caba::VciTarget<vci_param>    p_vci_tgt_cleanup;
+      soclib::caba::VciInitiator<vci_param> p_vci_ini;
+      soclib::caba::VciInitiator<vci_param> p_vci_ixr;
+
+      VciMemCache(
+          sc_module_name name,                                // Instance Name
+          const soclib::common::MappingTable &mtp,            // Mapping table for primary requets
+          const soclib::common::MappingTable &mtc,            // Mapping table for coherence requets
+          const soclib::common::MappingTable &mtx,            // Mapping table for XRAM
+          const soclib::common::IntTab &vci_ixr_index,        // VCI port to XRAM (initiator)
+          const soclib::common::IntTab &vci_ini_index,        // VCI port to PROC (initiator)
+          const soclib::common::IntTab &vci_tgt_index,        // VCI port to PROC (target)
+          const soclib::common::IntTab &vci_tgt_index_cleanup,// VCI port to PROC (target) for cleanup
+          size_t nways,                                       // Number of ways per set
+          size_t nsets,                                       // Number of sets
+          size_t nwords,                                      // Number of words per line
+          size_t heap_size=1024,                              // Size of the heap
+          size_t transaction_tab_lines=TRANSACTION_TAB_LINES, // Size of the TRT
+          size_t update_tab_lines=UPDATE_TAB_LINES,           // Size of the UPT
+          size_t debug_start_cycle=0,
+          bool   debug_ok=false);
+
+      ~VciMemCache();
+
+      void print_stats();
+      void print_trace();
+      void copies_monitor(vci_addr_t addr);
+      void start_monitor(vci_addr_t addr, vci_addr_t length);
+      void stop_monitor();
+
+      private:
+
+      void transition();
+      void genMoore();
+      void check_monitor( const char *buf, vci_addr_t addr, data_t data);
+
+      // Component attributes
+      std::list<soclib::common::Segment> m_seglist;  // memory cached into the cache
+      std::list<soclib::common::Segment> m_cseglist; // coherence segment for the cache
+
+      const size_t    m_initiators; // Number of initiators
+      const size_t    m_heap_size;  // Size of the heap
+      const size_t    m_ways;       // Number of ways in a set
+      const size_t    m_sets;       // Number of cache sets
+      const size_t    m_words;      // Number of words in a line
+      const size_t    m_srcid_ixr;  // Srcid for requests to XRAM
+      const size_t    m_srcid_ini;  // Srcid for requests to processors
+
+      uint32_t        m_transaction_tab_lines;
+      TransactionTab  m_transaction_tab;  // xram transaction table
+      uint32_t        m_update_tab_lines;
+      UpdateTab       m_update_tab;       // pending update & invalidate
+      CacheDirectory  m_cache_directory;  // data cache directory
+      CacheData       m_cache_data;       // data array[set][way][word]
+      HeapDirectory   m_heap;             // heap for copies
+      GenericLLSCGlobalTable
+      <
+        32  ,   // desired number of slots
+        4096,   // number of processors in the system
+        8000,   // registratioÃ§n life span (in # of LL operations)
+        typename vci_param::fast_addr_t // address type
+      >
+      m_llsc_table;       // ll/sc global registration table
+
+      // adress masks
+      const soclib::common::AddressMaskingTable<vci_addr_t> m_x;
+      const soclib::common::AddressMaskingTable<vci_addr_t> m_y;
+      const soclib::common::AddressMaskingTable<vci_addr_t> m_z;
+      const soclib::common::AddressMaskingTable<vci_addr_t> m_nline;
+
+      // broadcast address
+      vci_addr_t m_broadcast_address;
+
+      //////////////////////////////////////////////////
+      // Others registers
+      //////////////////////////////////////////////////
+      sc_signal<size_t> r_copies_limit; // Limit of the number of copies for one line
+      sc_signal<size_t> xxx_count;
+
+      //////////////////////////////////////////////////
+      // Registers controlled by the TGT_CMD fsm
+      //////////////////////////////////////////////////
+
+      // Fifo between TGT_CMD fsm and READ fsm
+      GenericFifo<uint64_t>  m_cmd_read_addr_fifo;
+      GenericFifo<size_t>    m_cmd_read_length_fifo;
+      GenericFifo<size_t>    m_cmd_read_srcid_fifo;
+      GenericFifo<size_t>    m_cmd_read_trdid_fifo;
+      GenericFifo<size_t>    m_cmd_read_pktid_fifo;
+
+      // Fifo between TGT_CMD fsm and WRITE fsm
+      GenericFifo<uint64_t>  m_cmd_write_addr_fifo;
+      GenericFifo<bool>      m_cmd_write_eop_fifo;
+      GenericFifo<size_t>    m_cmd_write_srcid_fifo;
+      GenericFifo<size_t>    m_cmd_write_trdid_fifo;
+      GenericFifo<size_t>    m_cmd_write_pktid_fifo;
+      GenericFifo<data_t>    m_cmd_write_data_fifo;
+      GenericFifo<be_t>      m_cmd_write_be_fifo;
+
+      // Fifo between TGT_CMD fsm and CAS fsm
+      GenericFifo<uint64_t>  m_cmd_cas_addr_fifo;
+      GenericFifo<bool>      m_cmd_cas_eop_fifo;
+      GenericFifo<size_t>    m_cmd_cas_srcid_fifo;
+      GenericFifo<size_t>    m_cmd_cas_trdid_fifo;
+      GenericFifo<size_t>    m_cmd_cas_pktid_fifo;
+      GenericFifo<data_t>    m_cmd_cas_wdata_fifo;
+
+      sc_signal<int>         r_tgt_cmd_fsm;
+
+      size_t                   m_nseg;
+      size_t                   m_ncseg;
+      soclib::common::Segment  **m_seg;
+      soclib::common::Segment  **m_cseg;
+      ///////////////////////////////////////////////////////
+      // Registers controlled by the READ fsm
+      ///////////////////////////////////////////////////////
+
+      sc_signal<int>      r_read_fsm;        // FSM state
+      sc_signal<size_t>   r_read_copy;       // Srcid of the first copy
+      sc_signal<size_t>   r_read_copy_cache; // Srcid of the first copy
+      sc_signal<bool>     r_read_copy_inst;  // Type of the first copy
+      sc_signal<tag_t>    r_read_tag;        // cache line tag (in directory)
+      sc_signal<bool>     r_read_is_cnt;     // is_cnt bit (in directory)
+      sc_signal<bool>     r_read_lock;       // lock bit (in directory)
+      sc_signal<bool>     r_read_dirty;      // dirty bit (in directory)
+      sc_signal<size_t>   r_read_count;      // number of copies
+      sc_signal<size_t>   r_read_ptr;        // pointer to the heap
+      sc_signal<data_t> * r_read_data;       // data (one cache line)
+      sc_signal<size_t>   r_read_way;        // associative way (in cache)
+      sc_signal<size_t>   r_read_trt_index;  // Transaction Table index
+      sc_signal<size_t>   r_read_next_ptr;   // Next entry to point to
+      sc_signal<bool>     r_read_last_free;  // Last free entry
+      sc_signal<typename vci_param::fast_addr_t>
+                          r_read_ll_key;     // LL key returned by the llsc_global_table
+
+      // Buffer between READ fsm and IXR_CMD fsm (ask a missing cache line to XRAM)
+      sc_signal<bool>     r_read_to_ixr_cmd_req;    // valid request
+      sc_signal<addr_t>   r_read_to_ixr_cmd_nline;  // cache line index
+      sc_signal<size_t>   r_read_to_ixr_cmd_trdid;  // index in Transaction Table
+
+      // Buffer between READ fsm and TGT_RSP fsm (send a hit read response to L1 cache)
+      sc_signal<bool>     r_read_to_tgt_rsp_req;    // valid request
+      sc_signal<size_t>   r_read_to_tgt_rsp_srcid;  // Transaction srcid
+      sc_signal<size_t>   r_read_to_tgt_rsp_trdid;  // Transaction trdid
+      sc_signal<size_t>   r_read_to_tgt_rsp_pktid;  // Transaction pktid
+      sc_signal<data_t> * r_read_to_tgt_rsp_data;   // data (one cache line)
+      sc_signal<size_t>   r_read_to_tgt_rsp_word;   // first word of the response
+      sc_signal<size_t>   r_read_to_tgt_rsp_length; // length of the response
+      sc_signal<typename vci_param::fast_addr_t>
+                          r_read_to_tgt_rsp_ll_key; // LL key returned by the llsc_global_table
+
+      ///////////////////////////////////////////////////////////////
+      // Registers controlled by the WRITE fsm
+      ///////////////////////////////////////////////////////////////
+
+      sc_signal<int>      r_write_fsm;        // FSM state
+      sc_signal<addr_t>   r_write_address;    // first word address
+      sc_signal<size_t>   r_write_word_index; // first word index in line
+      sc_signal<size_t>   r_write_word_count; // number of words in line
+      sc_signal<size_t>   r_write_srcid;      // transaction srcid
+      sc_signal<size_t>   r_write_trdid;      // transaction trdid
+      sc_signal<size_t>   r_write_pktid;      // transaction pktid
+      sc_signal<data_t> * r_write_data;       // data (one cache line)
+      sc_signal<be_t>   * r_write_be;         // one byte enable per word
+      sc_signal<bool>     r_write_byte;       // (BE != 0X0) and (BE != 0xF)
+      sc_signal<bool>     r_write_is_cnt;     // is_cnt bit (in directory)
+      sc_signal<bool>     r_write_lock;       // lock bit (in directory)
+      sc_signal<tag_t>    r_write_tag;        // cache line tag (in directory)
+      sc_signal<size_t>   r_write_copy;       // first owner of the line
+      sc_signal<size_t>   r_write_copy_cache; // first owner of the line
+      sc_signal<bool>     r_write_copy_inst;  // is this owner a ICache ?
+      sc_signal<size_t>   r_write_count;      // number of copies
+      sc_signal<size_t>   r_write_ptr;        // pointer to the heap
+      sc_signal<size_t>   r_write_next_ptr;   // next pointer to the heap
+      sc_signal<bool>     r_write_to_dec;     // need to decrement update counter
+      sc_signal<size_t>   r_write_way;        // way of the line
+      sc_signal<size_t>   r_write_trt_index;  // index in Transaction Table
+      sc_signal<size_t>   r_write_upt_index;  // index in Update Table
+      sc_signal<bool>     r_write_sc_fail;    // sc command failed
+      sc_signal<bool>     r_write_pending_sc; // sc command pending in WRITE fsm
+
+      // Buffer between WRITE fsm and TGT_RSP fsm (acknowledge a write command from L1)
+      sc_signal<bool>     r_write_to_tgt_rsp_req;     // valid request
+      sc_signal<size_t>   r_write_to_tgt_rsp_srcid;   // transaction srcid
+      sc_signal<size_t>   r_write_to_tgt_rsp_trdid;   // transaction trdid
+      sc_signal<size_t>   r_write_to_tgt_rsp_pktid;   // transaction pktid
+      sc_signal<bool>     r_write_to_tgt_rsp_sc_fail; // sc command failed
+
+      // Buffer between WRITE fsm and IXR_CMD fsm (ask a missing cache line to XRAM)
+      sc_signal<bool>     r_write_to_ixr_cmd_req;   // valid request
+      sc_signal<bool>     r_write_to_ixr_cmd_write; // write request
+      sc_signal<addr_t>   r_write_to_ixr_cmd_nline; // cache line index
+      sc_signal<data_t> * r_write_to_ixr_cmd_data;  // cache line data
+      sc_signal<size_t>   r_write_to_ixr_cmd_trdid; // index in Transaction Table
+
+      // Buffer between WRITE fsm and INIT_CMD fsm (Update/Invalidate L1 caches)
+      sc_signal<bool>     r_write_to_init_cmd_multi_req;     // valid multicast request
+      sc_signal<bool>     r_write_to_init_cmd_brdcast_req;   // valid brdcast request
+      sc_signal<addr_t>   r_write_to_init_cmd_nline;         // cache line index
+      sc_signal<size_t>   r_write_to_init_cmd_trdid;         // index in Update Table
+      sc_signal<data_t> * r_write_to_init_cmd_data;          // data (one cache line)
+      sc_signal<be_t>   * r_write_to_init_cmd_be;            // word enable
+      sc_signal<size_t>   r_write_to_init_cmd_count;         // number of words in line
+      sc_signal<size_t>   r_write_to_init_cmd_index;         // index of first word in line
+      GenericFifo<bool>   m_write_to_init_cmd_inst_fifo;     // fifo for the L1 type
+      GenericFifo<size_t> m_write_to_init_cmd_srcid_fifo;    // fifo for srcids
+#if L1_MULTI_CACHE
+      GenericFifo<size_t> m_write_to_init_cmd_cache_id_fifo; // fifo for srcids
+#endif
+
+      // Buffer between WRITE fsm and INIT_RSP fsm (Decrement UPT entry)
+      sc_signal<bool>     r_write_to_init_rsp_req;       // valid request
+      sc_signal<size_t>   r_write_to_init_rsp_upt_index; // index in update table
+
+      /////////////////////////////////////////////////////////
+      // Registers controlled by INIT_RSP fsm
+      //////////////////////////////////////////////////////////
+
+      sc_signal<int>      r_init_rsp_fsm;       // FSM state
+      sc_signal<size_t>   r_init_rsp_upt_index; // index in the Update Table
+      sc_signal<size_t>   r_init_rsp_srcid;     // pending write srcid
+      sc_signal<size_t>   r_init_rsp_trdid;     // pending write trdid
+      sc_signal<size_t>   r_init_rsp_pktid;     // pending write pktid
+      sc_signal<addr_t>   r_init_rsp_nline;     // pending write nline
+
+      // Buffer between INIT_RSP fsm and TGT_RSP fsm (complete write/update transaction)
+      sc_signal<bool>     r_init_rsp_to_tgt_rsp_req;   // valid request
+      sc_signal<size_t>   r_init_rsp_to_tgt_rsp_srcid; // Transaction srcid
+      sc_signal<size_t>   r_init_rsp_to_tgt_rsp_trdid; // Transaction trdid
+      sc_signal<size_t>   r_init_rsp_to_tgt_rsp_pktid; // Transaction pktid
+
+      ///////////////////////////////////////////////////////
+      // Registers controlled by CLEANUP fsm
+      ///////////////////////////////////////////////////////
+
+      sc_signal<int>      r_cleanup_fsm;           // FSM state
+      sc_signal<size_t>   r_cleanup_srcid;         // transaction srcid
+      sc_signal<size_t>   r_cleanup_trdid;         // transaction trdid
+      sc_signal<size_t>   r_cleanup_pktid;         // transaction pktid
+      sc_signal<addr_t>   r_cleanup_nline;         // cache line index
+
+      sc_signal<copy_t>   r_cleanup_copy;          // first copy
+      sc_signal<copy_t>   r_cleanup_copy_cache;    // first copy
+      sc_signal<size_t>   r_cleanup_copy_inst;     // type of the first copy
+      sc_signal<copy_t>   r_cleanup_count;         // number of copies
+      sc_signal<size_t>   r_cleanup_ptr;           // pointer to the heap
+      sc_signal<size_t>   r_cleanup_prev_ptr;      // previous pointer to the heap
+      sc_signal<size_t>   r_cleanup_prev_srcid;    // srcid of previous heap entry
+      sc_signal<size_t>   r_cleanup_prev_cache_id; // srcid of previous heap entry
+      sc_signal<bool>     r_cleanup_prev_inst;     // inst bit of previous heap entry
+      sc_signal<size_t>   r_cleanup_next_ptr;      // next pointer to the heap
+      sc_signal<tag_t>    r_cleanup_tag;           // cache line tag (in directory)
+      sc_signal<bool>     r_cleanup_is_cnt;        // inst bit (in directory)
+      sc_signal<bool>     r_cleanup_lock;          // lock bit (in directory)
+      sc_signal<bool>     r_cleanup_dirty;         // dirty bit (in directory)
+      sc_signal<size_t>   r_cleanup_way;           // associative way (in cache)
+
+      sc_signal<size_t>   r_cleanup_write_srcid;   // srcid of write response
+      sc_signal<size_t>   r_cleanup_write_trdid;   // trdid of write rsp
+      sc_signal<size_t>   r_cleanup_write_pktid;   // pktid of write rsp
+      sc_signal<bool>     r_cleanup_need_rsp;      // needs a write rsp
+
+      sc_signal<size_t>   r_cleanup_index;         // index of the INVAL line (in the UPT)
+
+      // Buffer between CLEANUP fsm and TGT_RSP fsm (acknowledge a write command from L1)
+      sc_signal<bool>     r_cleanup_to_tgt_rsp_req;   // valid request
+      sc_signal<size_t>   r_cleanup_to_tgt_rsp_srcid; // transaction srcid
+      sc_signal<size_t>   r_cleanup_to_tgt_rsp_trdid; // transaction trdid
+      sc_signal<size_t>   r_cleanup_to_tgt_rsp_pktid; // transaction pktid
+
+      ///////////////////////////////////////////////////////
+      // Registers controlled by CAS fsm
+      ///////////////////////////////////////////////////////
+
+      sc_signal<int>      r_cas_fsm;        // FSM state
+      sc_signal<data_t>   r_cas_wdata;      // write data word
+      sc_signal<data_t> * r_cas_rdata;      // read data word
+      sc_signal<uint32_t> r_cas_lfsr;       // lfsr for random introducing
+      sc_signal<size_t>   r_cas_cpt;        // size of command
+      sc_signal<copy_t>   r_cas_copy;       // Srcid of the first copy
+      sc_signal<copy_t>   r_cas_copy_cache; // Srcid of the first copy
+      sc_signal<bool>     r_cas_copy_inst;  // Type of the first copy
+      sc_signal<size_t>   r_cas_count;      // number of copies
+      sc_signal<size_t>   r_cas_ptr;        // pointer to the heap
+      sc_signal<size_t>   r_cas_next_ptr;   // next pointer to the heap
+      sc_signal<bool>     r_cas_is_cnt;     // is_cnt bit (in directory)
+      sc_signal<bool>     r_cas_dirty;      // dirty bit (in directory)
+      sc_signal<size_t>   r_cas_way;        // way in directory
+      sc_signal<size_t>   r_cas_set;        // set in directory
+      sc_signal<data_t>   r_cas_tag;        // cache line tag (in directory)
+      sc_signal<size_t>   r_cas_trt_index;  // Transaction Table index
+      sc_signal<size_t>   r_cas_upt_index;  // Update Table index
+
+      // Buffer between CAS fsm and INIT_CMD fsm (XRAM read)
+      sc_signal<bool>     r_cas_to_ixr_cmd_req;   // valid request
+      sc_signal<addr_t>   r_cas_to_ixr_cmd_nline; // cache line index
+      sc_signal<size_t>   r_cas_to_ixr_cmd_trdid; // index in Transaction Table
+      sc_signal<bool>     r_cas_to_ixr_cmd_write; // write request
+      sc_signal<data_t> * r_cas_to_ixr_cmd_data;  // cache line data
+
+
+      // Buffer between CAS fsm and TGT_RSP fsm
+      sc_signal<bool>     r_cas_to_tgt_rsp_req;   // valid request
+      sc_signal<data_t>   r_cas_to_tgt_rsp_data;  // read data word
+      sc_signal<size_t>   r_cas_to_tgt_rsp_srcid; // Transaction srcid
+      sc_signal<size_t>   r_cas_to_tgt_rsp_trdid; // Transaction trdid
+      sc_signal<size_t>   r_cas_to_tgt_rsp_pktid; // Transaction pktid
+
+      // Buffer between CAS fsm and INIT_CMD fsm (Update/Invalidate L1 caches)
+      sc_signal<bool>     r_cas_to_init_cmd_multi_req;     // valid request
+      sc_signal<bool>     r_cas_to_init_cmd_brdcast_req;   // brdcast request
+      sc_signal<addr_t>   r_cas_to_init_cmd_nline;         // cache line index
+      sc_signal<size_t>   r_cas_to_init_cmd_trdid;         // index in Update Table
+      sc_signal<data_t>   r_cas_to_init_cmd_wdata;         // data (one word)
+      sc_signal<bool>     r_cas_to_init_cmd_is_long;       // it is a 64 bits CAS
+      sc_signal<data_t>   r_cas_to_init_cmd_wdata_high;    // data high (one word)
+      sc_signal<size_t>   r_cas_to_init_cmd_index;         // index of the word in line
+      GenericFifo<bool>   m_cas_to_init_cmd_inst_fifo;     // fifo for the L1 type
+      GenericFifo<size_t> m_cas_to_init_cmd_srcid_fifo;    // fifo for srcids
+#if L1_MULTI_CACHE
+      GenericFifo<size_t> m_cas_to_init_cmd_cache_id_fifo; // fifo for srcids
+#endif
+
+      // Buffer between CAS fsm and INIT_RSP fsm (Decrement UPT entry)
+      sc_signal<bool>     r_cas_to_init_rsp_req;       // valid request
+      sc_signal<size_t>   r_cas_to_init_rsp_upt_index; // index in update table
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by the IXR_RSP fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_ixr_rsp_fsm;       // FSM state
+      sc_signal<size_t>   r_ixr_rsp_trt_index; // TRT entry index
+      sc_signal<size_t>   r_ixr_rsp_cpt;       // word counter
+
+      // Buffer between IXR_RSP fsm and XRAM_RSP fsm  (response from the XRAM)
+      sc_signal<bool>   * r_ixr_rsp_to_xram_rsp_rok; // A xram response is ready
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by the XRAM_RSP fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_xram_rsp_fsm;               // FSM state
+      sc_signal<size_t>   r_xram_rsp_trt_index;         // TRT entry index
+      TransactionTabEntry r_xram_rsp_trt_buf;           // TRT entry local buffer
+      sc_signal<bool>     r_xram_rsp_victim_inval;      // victim line invalidate
+      sc_signal<bool>     r_xram_rsp_victim_is_cnt;     // victim line inst bit
+      sc_signal<bool>     r_xram_rsp_victim_dirty;      // victim line dirty bit
+      sc_signal<size_t>   r_xram_rsp_victim_way;        // victim line way
+      sc_signal<size_t>   r_xram_rsp_victim_set;        // victim line set
+      sc_signal<addr_t>   r_xram_rsp_victim_nline;      // victim line index
+      sc_signal<copy_t>   r_xram_rsp_victim_copy;       // victim line first copy
+      sc_signal<copy_t>   r_xram_rsp_victim_copy_cache; // victim line first copy
+      sc_signal<bool>     r_xram_rsp_victim_copy_inst;  // victim line type of first copy
+      sc_signal<size_t>   r_xram_rsp_victim_count;      // victim line number of copies
+      sc_signal<size_t>   r_xram_rsp_victim_ptr;        // victim line pointer to the heap
+      sc_signal<data_t> * r_xram_rsp_victim_data;       // victim line data
+      sc_signal<size_t>   r_xram_rsp_upt_index;         // UPT entry index
+      sc_signal<size_t>   r_xram_rsp_next_ptr;          // Next pointer to the heap
+
+      // Buffer between XRAM_RSP fsm and TGT_RSP fsm  (response to L1 cache)
+      sc_signal<bool>     r_xram_rsp_to_tgt_rsp_req;    // Valid request
+      sc_signal<size_t>   r_xram_rsp_to_tgt_rsp_srcid;  // Transaction srcid
+      sc_signal<size_t>   r_xram_rsp_to_tgt_rsp_trdid;  // Transaction trdid
+      sc_signal<size_t>   r_xram_rsp_to_tgt_rsp_pktid;  // Transaction pktid
+      sc_signal<data_t> * r_xram_rsp_to_tgt_rsp_data;   // data (one cache line)
+      sc_signal<size_t>   r_xram_rsp_to_tgt_rsp_word;   // first word index
+      sc_signal<size_t>   r_xram_rsp_to_tgt_rsp_length; // length of the response
+      sc_signal<bool>     r_xram_rsp_to_tgt_rsp_rerror; // send error to requester
+      sc_signal<typename vci_param::fast_addr_t>
+                          r_xram_rsp_to_tgt_rsp_ll_key; // LL key returned by the llsc_global_table
+
+      // Buffer between XRAM_RSP fsm and INIT_CMD fsm (Inval L1 Caches)
+      sc_signal<bool>     r_xram_rsp_to_init_cmd_multi_req;     // Valid request
+      sc_signal<bool>     r_xram_rsp_to_init_cmd_brdcast_req;   // Broadcast request
+      sc_signal<addr_t>   r_xram_rsp_to_init_cmd_nline;         // cache line index;
+      sc_signal<size_t>   r_xram_rsp_to_init_cmd_trdid;         // index of UPT entry
+      GenericFifo<bool>   m_xram_rsp_to_init_cmd_inst_fifo;     // fifo for the L1 type
+      GenericFifo<size_t> m_xram_rsp_to_init_cmd_srcid_fifo;    // fifo for srcids
+#if L1_MULTI_CACHE
+      GenericFifo<size_t> m_xram_rsp_to_init_cmd_cache_id_fifo; // fifo for srcids
+#endif
+
+      // Buffer between XRAM_RSP fsm and IXR_CMD fsm (XRAM write)
+      sc_signal<bool>     r_xram_rsp_to_ixr_cmd_req;   // Valid request
+      sc_signal<addr_t>   r_xram_rsp_to_ixr_cmd_nline; // cache line index
+      sc_signal<data_t> * r_xram_rsp_to_ixr_cmd_data;  // cache line data
+      sc_signal<size_t>   r_xram_rsp_to_ixr_cmd_trdid; // index in transaction table
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by the IXR_CMD fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_ixr_cmd_fsm;
+      sc_signal<size_t>   r_ixr_cmd_cpt;
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by TGT_RSP fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_tgt_rsp_fsm;
+      sc_signal<size_t>   r_tgt_rsp_cpt;
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by INIT_CMD fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_init_cmd_fsm;
+      sc_signal<size_t>   r_init_cmd_cpt;
+      sc_signal<bool>     r_init_cmd_inst;
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by ALLOC_DIR fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_alloc_dir_fsm;
+      sc_signal<unsigned> r_alloc_dir_reset_cpt;
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by ALLOC_TRT fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_alloc_trt_fsm;
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by ALLOC_UPT fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_alloc_upt_fsm;
+
+      ////////////////////////////////////////////////////
+      // Registers controlled by ALLOC_HEAP fsm
+      ////////////////////////////////////////////////////
+
+      sc_signal<int>      r_alloc_heap_fsm;
+      sc_signal<unsigned> r_alloc_heap_reset_cpt;
+    }; // end class VciMemCache
+
+}}
+
+#endif
+
+// Local Variables:
+// tab-width: 2
+// c-basic-offset: 2
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=2:tabstop=2:softtabstop=2
+
Index: /branches/v5/modules/vci_mem_cache/caba/source/include/xram_transaction.h
===================================================================
--- /branches/v5/modules/vci_mem_cache/caba/source/include/xram_transaction.h	(revision 300)
+++ /branches/v5/modules/vci_mem_cache/caba/source/include/xram_transaction.h	(revision 300)
@@ -0,0 +1,421 @@
+#ifndef XRAM_TRANSACTION_H_
+#define XRAM_TRANSACTION_H_
+
+#include <inttypes.h>
+#include <systemc>
+#include <cassert>
+#include "arithmetics.h"
+
+#define DEBUG_XRAM_TRANSACTION 0
+
+////////////////////////////////////////////////////////////////////////
+//                  A transaction tab entry         
+////////////////////////////////////////////////////////////////////////
+
+class TransactionTabEntry {
+    typedef uint32_t              size_t;
+    typedef uint32_t              data_t;
+    typedef sc_dt::sc_uint<40>    addr_t;
+    typedef uint32_t              be_t;
+
+    public:
+    bool 		        valid;     	    // entry valid 
+    bool 		        xram_read; 	    // read request to XRAM
+    addr_t   	        nline;    	    // index (zy) of the requested line
+    size_t 	            srcid;     	    // processor requesting the transaction
+    size_t 	            trdid;     	    // processor requesting the transaction
+    size_t 	            pktid;     	    // processor requesting the transaction
+    bool 		        proc_read;	    // read request from processor
+    size_t 	            read_length;    // length of the read (for the response)
+    size_t 	            word_index;    	// index of the first read word (for the response)
+    std::vector<data_t> wdata;          // write buffer (one cache line)
+    std::vector<be_t>   wdata_be;    	// be for each data in the write buffer
+    bool                rerror;         // error returned by xram
+    data_t              ll_key;         // LL key returned by the llsc_global_table
+
+    /////////////////////////////////////////////////////////////////////
+    // The init() function initializes the entry 
+    /////////////////////////////////////////////////////////////////////
+    void init()
+    {
+        valid		= false;
+        rerror      = false;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The alloc() function initializes the vectors of an entry
+    // Its arguments are :
+    // - n_words : number of words per line in the cache
+    /////////////////////////////////////////////////////////////////////
+    void alloc(size_t n_words)
+    {
+        wdata_be.reserve( (int)n_words );
+        wdata.reserve( (int)n_words );
+        for(size_t i=0; i<n_words; i++)
+        {
+            wdata_be.push_back(0);
+            wdata.push_back(0);
+        }
+    }
+
+    ////////////////////////////////////////////////////////////////////
+    // The copy() function copies an existing entry
+    // Its arguments are :
+    // - source : the transaction tab entry to copy
+    ////////////////////////////////////////////////////////////////////
+    void copy(const TransactionTabEntry &source)
+    {
+        valid	    = source.valid;
+        xram_read 	= source.xram_read;
+        nline	    = source.nline;
+        srcid	    = source.srcid;
+        trdid	    = source.trdid;
+        pktid	    = source.pktid;
+        proc_read 	= source.proc_read;
+        read_length = source.read_length;
+        word_index	= source.word_index;
+        wdata_be.assign(source.wdata_be.begin(),source.wdata_be.end());
+        wdata.assign(source.wdata.begin(),source.wdata.end());
+        rerror      = source.rerror;
+    }
+
+    ////////////////////////////////////////////////////////////////////
+    // The print() function prints the entry 
+    ////////////////////////////////////////////////////////////////////
+    void print(){
+        std::cout << "valid       = " << valid        << std::endl;
+        std::cout << "xram_read   = " << xram_read    << std::endl;
+        std::cout << "nline       = " << std::hex << nline << std::endl;
+        std::cout << "srcid       = " << srcid        << std::endl;
+        std::cout << "trdid       = " << trdid        << std::endl;
+        std::cout << "pktid       = " << pktid        << std::endl;
+        std::cout << "proc_read   = " << proc_read    << std::endl;
+        std::cout << "read_length = " << read_length  << std::endl;
+        std::cout << "word_index  = " << word_index   << std::endl; 
+        for(size_t i=0; i<wdata_be.size() ; i++){
+            std::cout << "wdata_be [" << i <<"] = " << wdata_be[i] << std::endl;
+        }
+        for(size_t i=0; i<wdata.size() ; i++){
+            std::cout << "wdata [" << i <<"] = " << wdata[i] << std::endl;
+        }
+        std::cout << std::endl;
+        std::cout << "rerror      = " << rerror       << std::endl;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // 		Constructors
+    /////////////////////////////////////////////////////////////////////
+
+    TransactionTabEntry()
+    {
+        wdata_be.clear();
+        wdata.clear();
+        valid=false;
+        rerror=false;
+    }
+
+    TransactionTabEntry(const TransactionTabEntry &source){
+        valid	    = source.valid;
+        xram_read	= source.xram_read;
+        nline	    = source.nline;
+        srcid	    = source.srcid;
+        trdid	    = source.trdid;
+        pktid	    = source.pktid;
+        proc_read	= source.proc_read;
+        read_length = source.read_length;
+        word_index	= source.word_index;
+        wdata_be.assign(source.wdata_be.begin(),source.wdata_be.end());
+        wdata.assign(source.wdata.begin(),source.wdata.end());	
+        rerror      = source.rerror;
+        ll_key      = source.ll_key;
+    }
+
+}; // end class TransactionTabEntry
+
+////////////////////////////////////////////////////////////////////////
+//                  The transaction tab                              
+////////////////////////////////////////////////////////////////////////
+class TransactionTab{
+    typedef uint32_t size_t;
+    typedef uint32_t data_t;
+    typedef sc_dt::sc_uint<40> addr_t;
+    typedef uint32_t be_t;
+
+    private:
+    size_t size_tab;                // The size of the tab
+
+    data_t be_to_mask(be_t be)
+    {
+        data_t ret = 0;
+        if ( be&0x1 ) {
+            ret = ret | 0x000000FF;
+        }
+        if ( be&0x2 ) {
+            ret = ret | 0x0000FF00;
+        }
+        if ( be&0x4 ) {
+            ret = ret | 0x00FF0000;
+        }
+        if ( be&0x8 ) {
+            ret = ret | 0xFF000000;
+        }
+        return ret;
+    }
+
+    public:
+    TransactionTabEntry *tab;       // The transaction tab
+
+    ////////////////////////////////////////////////////////////////////
+    //		Constructors
+    ////////////////////////////////////////////////////////////////////
+    TransactionTab()
+    {
+        size_tab=0;
+        tab=NULL;
+    }
+
+    TransactionTab(size_t n_entries, size_t n_words)
+    {
+        size_tab = n_entries;
+        tab = new TransactionTabEntry[size_tab];
+        for ( size_t i=0; i<size_tab; i++) {
+            tab[i].alloc(n_words);
+        }
+    }
+
+    ~TransactionTab()
+    {
+        delete [] tab;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The size() function returns the size of the tab
+    /////////////////////////////////////////////////////////////////////
+    size_t size()
+    {
+        return size_tab;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The init() function initializes the transaction tab entries
+    /////////////////////////////////////////////////////////////////////
+    void init()
+    {
+        for ( size_t i=0; i<size_tab; i++) {
+            tab[i].init();
+        }
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The print() function prints a transaction tab entry
+    // Arguments :
+    // - index : the index of the entry to print
+    /////////////////////////////////////////////////////////////////////
+    void print(const size_t index)
+    {
+        assert( (index < size_tab) 
+                && "Invalid Transaction Tab Entry");
+        tab[index].print();
+        return;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The read() function returns a transaction tab entry.
+    // Arguments :
+    // - index : the index of the entry to read
+    /////////////////////////////////////////////////////////////////////
+    TransactionTabEntry read(const size_t index)
+    {
+        assert( (index < size_tab) 
+                && "Invalid Transaction Tab Entry");
+        return tab[index];
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The full() function returns the state of the transaction tab
+    // Arguments :
+    // - index : (return argument) the index of an empty entry 
+    // The function returns true if the transaction tab is full
+    /////////////////////////////////////////////////////////////////////
+    bool full(size_t &index)
+    {
+        for(size_t i=0; i<size_tab; i++){
+            if(!tab[i].valid){
+                index=i;
+                return false;	
+            }
+        }
+        return true;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The hit_read() function checks if an XRAM read transaction exists 
+    // for a given cache line.
+    // Arguments :
+    // - index : (return argument) the index of the hit entry, if there is 
+    // - nline : the index (zy) of the requested line
+    // The function returns true if a read request has already been sent
+    //////////////////////////////////////////////////////////////////////
+    bool hit_read(const addr_t nline,size_t &index)
+    {
+        for(size_t i=0; i<size_tab; i++){
+            if((tab[i].valid && (nline==tab[i].nline)) && (tab[i].xram_read)) {
+                index=i;
+                return true;	
+            }
+        }
+        return false;
+    }
+
+    ///////////////////////////////////////////////////////////////////////
+    // The hit_write() function looks if an XRAM write transaction exists 
+    // for a given line.
+    // Arguments :
+    // - nline : the index (zy) of the requested line
+    // The function returns true if a write request has already been sent
+    ///////////////////////////////////////////////////////////////////////
+    bool hit_write(const addr_t nline)
+    {
+        for(size_t i=0; i<size_tab; i++){
+            if(tab[i].valid && (nline==tab[i].nline) && !(tab[i].xram_read)) {
+                return true;	
+            }
+        }
+        return false;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The write_data_mask() function writes a vector of data (a line).
+    // The data is written only if the corresponding bits are set
+    // in the be vector. 
+    // Arguments :
+    // - index : the index of the request in the transaction tab
+    // - be   : vector of be 
+    // - data : vector of data
+    /////////////////////////////////////////////////////////////////////
+    void write_data_mask(const size_t index, 
+            const std::vector<be_t> &be, 
+            const std::vector<data_t> &data) 
+    {
+        assert( (index < size_tab) 
+                && "Invalid Transaction Tab Entry");
+        assert(be.size()==tab[index].wdata_be.size() 
+                && "Bad data mask in write_data_mask in TransactionTab");
+        assert(data.size()==tab[index].wdata.size() 
+                && "Bad data in write_data_mask in TransactionTab");
+
+        for(size_t i=0; i<tab[index].wdata_be.size() ; i++) {
+            tab[index].wdata_be[i] = tab[index].wdata_be[i] | be[i];
+            data_t mask = be_to_mask(be[i]);
+            tab[index].wdata[i] = (tab[index].wdata[i] & ~mask) | (data[i] & mask);
+        }
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The set() function registers a transaction (read or write)
+    // to the XRAM in the transaction tab.
+    // Arguments :
+    // - index : index in the transaction tab
+    // - xram_read : transaction type (read or write a cache line)
+    // - nline : the index (zy) of the cache line
+    // - srcid : srcid of the initiator that caused the transaction
+    // - trdid : trdid of the initiator that caused the transaction
+    // - pktid : pktid of the initiator that caused the transaction
+    // - proc_read : does the initiator want a copy
+    // - read_length : length of read (in case of processor read)
+    // - word_index : index in the line (in case of single word read)
+    // - data : the data to write (in case of write)
+    // - data_be : the mask of the data to write (in case of write)
+    // - ll_key  : the ll key (if any) returned by the llsc_global_table
+    /////////////////////////////////////////////////////////////////////
+    void set(const size_t index,
+            const bool xram_read,
+            const addr_t nline,
+            const size_t srcid,
+            const size_t trdid,
+            const size_t pktid,
+            const bool proc_read,
+            const size_t read_length,
+            const size_t word_index,
+            const std::vector<be_t> &data_be,
+            const std::vector<data_t> &data, 
+            const data_t ll_key = 0) 
+    {
+        assert( (index < size_tab) 
+                && "The selected entry is out of range in set() Transaction Tab");
+        assert(data_be.size()==tab[index].wdata_be.size() 
+                && "Bad data_be argument in set() TransactionTab");
+        assert(data.size()==tab[index].wdata.size() 
+                && "Bad data argument in set() TransactionTab");
+
+        tab[index].valid	        = true;
+        tab[index].xram_read        = xram_read;
+        tab[index].nline	        = nline;
+        tab[index].srcid	        = srcid;
+        tab[index].trdid	        = trdid;
+        tab[index].pktid	        = pktid;
+        tab[index].proc_read	    = proc_read;
+        tab[index].read_length	    = read_length;
+        tab[index].word_index	    = word_index;
+        tab[index].ll_key   	    = ll_key;
+        for(size_t i=0; i<tab[index].wdata.size(); i++) 
+        {
+            tab[index].wdata_be[i]    = data_be[i];
+            tab[index].wdata[i]       = data[i];
+        }
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The write_rsp() function writes a word of the response to an 
+    // XRAM read transaction.
+    // The BE field in TRT is taken into account.
+    // Arguments :
+    // - index : the index of the transaction in the transaction tab
+    // - word_index : the index of the data in the line
+    // - data : the data to write
+    // - error : invalid data
+    /////////////////////////////////////////////////////////////////////
+    void write_rsp(const size_t index,
+            const size_t word,
+            const data_t data,
+            const bool   rerror)
+    {
+        assert( (index < size_tab) 
+                && "Selected entry  out of range in write_rsp() Transaction Tab");
+        assert( (word <= tab[index].wdata_be.size()) 
+                && "Bad word_index in write_rsp() in TransactionTab");
+        assert( tab[index].valid 
+                && "Transaction Tab Entry invalid in write_rsp()");
+        assert( tab[index].xram_read 
+                && "Selected entry is not an XRAM read transaction in write_rsp()");
+
+        data_t mask = be_to_mask(tab[index].wdata_be[word]);
+        tab[index].wdata[word] = (tab[index].wdata[word] & mask) | (data & ~mask);
+        tab[index].rerror |= rerror;
+    }
+
+    /////////////////////////////////////////////////////////////////////
+    // The erase() function erases an entry in the transaction tab.
+    // Arguments :
+    // - index : the index of the request in the transaction tab
+    /////////////////////////////////////////////////////////////////////
+    void erase(const size_t index)
+    {
+        assert( (index < size_tab) 
+                && "The selected entry is out of range in erase() Transaction Tab");
+        tab[index].valid	= false;
+        tab[index].rerror   = false;
+    }
+}; // end class TransactionTab
+
+#endif
+
+// Local Variables:
+// tab-width: 4
+// c-basic-offset: 4
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=4:tabstop=4:softtabstop=4
+
Index: /branches/v5/modules/vci_mem_cache/caba/source/src/vci_mem_cache.cpp
===================================================================
--- /branches/v5/modules/vci_mem_cache/caba/source/src/vci_mem_cache.cpp	(revision 300)
+++ /branches/v5/modules/vci_mem_cache/caba/source/src/vci_mem_cache.cpp	(revision 300)
@@ -0,0 +1,6827 @@
+ /* -*- c++ -*-
+ * File       : vci_mem_cache.cpp
+ * Date       : 30/10/2008
+ * Copyright  : UPMC / LIP6
+ * Authors    : Alain Greiner / Eric Guthmuller
+ *
+ * SOCLIB_LGPL_HEADER_BEGIN
+ *
+ * This file is part of SoCLib, GNU LGPLv2.1.
+ *
+ * SoCLib 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; version 2.1 of the License.
+ *
+ * SoCLib 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 SoCLib; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301 USA
+ *
+ * SOCLIB_LGPL_HEADER_END
+ *
+ * Maintainers: alain eric.guthmuller@polytechnique.edu
+ *              cesar.fuguet-tortolero@lip6.fr
+ *              alexandre.joannou@lip6.fr
+ */
+
+#include "../include/vci_mem_cache.h"
+
+//////   debug services   ///////////////////////////////////////////////////////
+// All debug messages are conditionned by two variables:
+// - compile time   : DEBUG_MEMC_*** : defined below
+// - execution time : m_debug_***    : defined by constructor arguments
+//    m_debug_* = (m_debug_ok) and (m_cpt_cycle > m_debug_start_cycle)
+/////////////////////////////////////////////////////////////////////////////////
+
+#define DEBUG_MEMC_GLOBAL   0 // synthetic trace of all FSMs
+#define DEBUG_MEMC_READ     1 // detailed trace of READ FSM
+#define DEBUG_MEMC_WRITE    1 // detailed trace of WRITE FSM
+#define DEBUG_MEMC_CAS      1 // detailed trace of CAS FSM
+#define DEBUG_MEMC_IXR_CMD  1 // detailed trace of IXR_RSP FSM
+#define DEBUG_MEMC_IXR_RSP  1 // detailed trace of IXR_RSP FSM
+#define DEBUG_MEMC_XRAM_RSP 1 // detailed trace of XRAM_RSP FSM
+#define DEBUG_MEMC_INIT_CMD 1 // detailed trace of INIT_CMD FSM
+#define DEBUG_MEMC_INIT_RSP 1 // detailed trace of INIT_RSP FSM
+#define DEBUG_MEMC_TGT_CMD  1 // detailed trace of TGT_CMD FSM
+#define DEBUG_MEMC_TGT_RSP  1 // detailed trace of TGT_RSP FSM
+#define DEBUG_MEMC_CLEANUP  1 // detailed trace of CLEANUP FSM
+
+#define RANDOMIZE_CAS       1
+
+namespace soclib { namespace caba {
+
+  const char *tgt_cmd_fsm_str[] = {
+    "TGT_CMD_IDLE",
+    "TGT_CMD_READ",
+    "TGT_CMD_WRITE",
+    "TGT_CMD_CAS"
+  };
+  const char *tgt_rsp_fsm_str[] = {
+    "TGT_RSP_READ_IDLE",
+    "TGT_RSP_WRITE_IDLE",
+    "TGT_RSP_CAS_IDLE",
+    "TGT_RSP_XRAM_IDLE",
+    "TGT_RSP_INIT_IDLE",
+    "TGT_RSP_CLEANUP_IDLE",
+    "TGT_RSP_READ",
+    "TGT_RSP_WRITE",
+    "TGT_RSP_CAS",
+    "TGT_RSP_XRAM",
+    "TGT_RSP_INIT",
+    "TGT_RSP_CLEANUP"
+  };
+  const char *init_cmd_fsm_str[] = {
+    "INIT_CMD_INVAL_IDLE",
+    "INIT_CMD_INVAL_NLINE",
+    "INIT_CMD_XRAM_BRDCAST",
+    "INIT_CMD_UPDT_IDLE",
+    "INIT_CMD_WRITE_BRDCAST",
+    "INIT_CMD_UPDT_NLINE",
+    "INIT_CMD_UPDT_INDEX",
+    "INIT_CMD_UPDT_DATA",
+    "INIT_CMD_CAS_UPDT_IDLE",
+    "INIT_CMD_CAS_BRDCAST",
+    "INIT_CMD_CAS_UPDT_NLINE",
+    "INIT_CMD_CAS_UPDT_INDEX",
+    "INIT_CMD_CAS_UPDT_DATA",
+    "INIT_CMD_CAS_UPDT_DATA_HIGH"
+  };
+  const char *init_rsp_fsm_str[] = {
+    "INIT_RSP_IDLE",
+    "INIT_RSP_UPT_LOCK",
+    "INIT_RSP_UPT_CLEAR",
+    "INIT_RSP_END"
+  };
+  const char *read_fsm_str[] = {
+    "READ_IDLE",
+    "READ_DIR_REQ",
+    "READ_DIR_LOCK",
+    "READ_DIR_HIT",
+    "READ_HEAP_REQ",
+    "READ_HEAP_LOCK",
+    "READ_HEAP_WRITE",
+    "READ_HEAP_ERASE",
+    "READ_HEAP_LAST",
+    "READ_RSP",
+    "READ_TRT_LOCK",
+    "READ_TRT_SET",
+    "READ_TRT_REQ"
+  };
+  const char *write_fsm_str[] = {
+    "WRITE_IDLE",
+    "WRITE_NEXT",
+    "WRITE_DIR_REQ",
+    "WRITE_DIR_LOCK",
+    "WRITE_DIR_READ",
+    "WRITE_DIR_HIT",
+    "WRITE_UPT_LOCK",
+    "WRITE_UPT_HEAP_LOCK",
+    "WRITE_UPT_REQ",
+    "WRITE_UPT_NEXT",
+    "WRITE_UPT_DEC",
+    "WRITE_RSP",
+    "WRITE_MISS_TRT_LOCK",
+    "WRITE_MISS_TRT_DATA",
+    "WRITE_MISS_TRT_SET",
+    "WRITE_MISS_XRAM_REQ",
+    "WRITE_BC_TRT_LOCK",
+    "WRITE_BC_UPT_LOCK",
+    "WRITE_BC_DIR_INVAL",
+    "WRITE_BC_CC_SEND",
+    "WRITE_BC_XRAM_REQ",
+    "WRITE_WAIT"
+  };
+  const char *ixr_rsp_fsm_str[] = {
+    "IXR_RSP_IDLE",
+    "IXR_RSP_ACK",
+    "IXR_RSP_TRT_ERASE",
+    "IXR_RSP_TRT_READ"
+  };
+  const char *xram_rsp_fsm_str[] = {
+    "XRAM_RSP_IDLE",
+    "XRAM_RSP_TRT_COPY",
+    "XRAM_RSP_TRT_DIRTY",
+    "XRAM_RSP_DIR_LOCK",
+    "XRAM_RSP_DIR_UPDT",
+    "XRAM_RSP_DIR_RSP",
+    "XRAM_RSP_INVAL_LOCK",
+    "XRAM_RSP_INVAL_WAIT",
+    "XRAM_RSP_INVAL",
+    "XRAM_RSP_WRITE_DIRTY",
+    "XRAM_RSP_HEAP_REQ",
+    "XRAM_RSP_HEAP_ERASE",
+    "XRAM_RSP_HEAP_LAST",
+    "XRAM_RSP_ERROR_ERASE",
+    "XRAM_RSP_ERROR_RSP"
+  };
+  const char *ixr_cmd_fsm_str[] = {
+    "IXR_CMD_READ_IDLE",
+    "IXR_CMD_WRITE_IDLE",
+    "IXR_CMD_CAS_IDLE",
+    "IXR_CMD_XRAM_IDLE",
+    "IXR_CMD_READ_NLINE",
+    "IXR_CMD_WRITE_NLINE",
+    "IXR_CMD_CAS_NLINE",
+    "IXR_CMD_XRAM_DATA"
+  };
+  const char *cas_fsm_str[] = {
+    "CAS_IDLE",
+    "CAS_DIR_REQ",
+    "CAS_DIR_LOCK",
+    "CAS_DIR_HIT_READ",
+    "CAS_DIR_HIT_WRITE",
+    "CAS_UPT_LOCK",
+    "CAS_UPT_HEAP_LOCK",
+    "CAS_UPT_REQ",
+    "CAS_UPT_NEXT",
+    "CAS_BC_TRT_LOCK",
+    "CAS_BC_UPT_LOCK",
+    "CAS_BC_DIR_INVAL",
+    "CAS_BC_CC_SEND",
+    "CAS_BC_XRAM_REQ",
+    "CAS_RSP_FAIL",
+    "CAS_RSP_SUCCESS",
+    "CAS_MISS_TRT_LOCK",
+    "CAS_MISS_TRT_SET",
+    "CAS_MISS_XRAM_REQ",
+    "CAS_WAIT"
+  };
+  const char *cleanup_fsm_str[] = {
+    "CLEANUP_IDLE",
+    "CLEANUP_DIR_REQ",
+    "CLEANUP_DIR_LOCK",
+    "CLEANUP_DIR_WRITE",
+    "CLEANUP_HEAP_REQ",
+    "CLEANUP_HEAP_LOCK",
+    "CLEANUP_HEAP_SEARCH",
+    "CLEANUP_HEAP_CLEAN",
+    "CLEANUP_HEAP_FREE",
+    "CLEANUP_UPT_LOCK",
+    "CLEANUP_UPT_WRITE",
+    "CLEANUP_WRITE_RSP",
+    "CLEANUP_RSP"
+  };
+  const char *alloc_dir_fsm_str[] = {
+    "ALLOC_DIR_RESET",
+    "ALLOC_DIR_READ",
+    "ALLOC_DIR_WRITE",
+    "ALLOC_DIR_CAS",
+    "ALLOC_DIR_CLEANUP",
+    "ALLOC_DIR_XRAM_RSP"
+  };
+  const char *alloc_trt_fsm_str[] = {
+    "ALLOC_TRT_READ",
+    "ALLOC_TRT_WRITE",
+    "ALLOC_TRT_CAS",
+    "ALLOC_TRT_XRAM_RSP",
+    "ALLOC_TRT_IXR_RSP"
+  };
+  const char *alloc_upt_fsm_str[] = {
+    "ALLOC_UPT_WRITE",
+    "ALLOC_UPT_XRAM_RSP",
+    "ALLOC_UPT_INIT_RSP",
+    "ALLOC_UPT_CLEANUP",
+    "ALLOC_UPT_CAS"
+  };
+  const char *alloc_heap_fsm_str[] = {
+    "ALLOC_HEAP_RESET",
+    "ALLOC_HEAP_READ",
+    "ALLOC_HEAP_WRITE",
+    "ALLOC_HEAP_CAS",
+    "ALLOC_HEAP_CLEANUP",
+    "ALLOC_HEAP_XRAM_RSP"
+  };
+
+#define tmpl(x) template<typename vci_param> x VciMemCache<vci_param>
+
+  using soclib::common::uint32_log2;
+
+  ////////////////////////////////
+  //  Constructor
+  ////////////////////////////////
+
+  tmpl(/**/)::VciMemCache(
+      sc_module_name name,
+      const soclib::common::MappingTable &mtp,
+      const soclib::common::MappingTable &mtc,
+      const soclib::common::MappingTable &mtx,
+      const soclib::common::IntTab &vci_ixr_index,
+      const soclib::common::IntTab &vci_ini_index,
+      const soclib::common::IntTab &vci_tgt_index,
+      const soclib::common::IntTab &vci_tgt_index_cleanup,
+      size_t nways,                 // number of ways per set
+      size_t nsets,                 // number of cache sets
+      size_t nwords,                // number of words in cache line
+      size_t heap_size,             // number of heap entries
+      size_t transaction_tab_lines, // number of TRT entries
+      size_t update_tab_lines,      // number of UPT entries
+      size_t debug_start_cycle,
+      bool   debug_ok)
+
+    : soclib::caba::BaseModule(name),
+
+    m_debug_start_cycle( debug_start_cycle),
+    m_debug_ok ( debug_ok ),
+
+    p_clk("clk"),
+    p_resetn("resetn"),
+    p_vci_tgt("vci_tgt"),
+    p_vci_tgt_cleanup("vci_tgt_cleanup"),
+    p_vci_ini("vci_ini"),
+    p_vci_ixr("vci_ixr"),
+
+    m_seglist(mtp.getSegmentList(vci_tgt_index)),
+    m_cseglist(mtc.getSegmentList(vci_tgt_index_cleanup)),
+
+    m_initiators( 1 << vci_param::S ),
+    m_heap_size( heap_size ),
+    m_ways( nways ),
+    m_sets( nsets ),
+    m_words( nwords ),
+    m_srcid_ixr( mtx.indexForId(vci_ixr_index) ),
+    m_srcid_ini( mtc.indexForId(vci_ini_index) ),
+    m_transaction_tab_lines(transaction_tab_lines),
+    m_transaction_tab( transaction_tab_lines, nwords ),
+    m_update_tab_lines( update_tab_lines),
+    m_update_tab( update_tab_lines ),
+    m_cache_directory( nways, nsets, nwords, vci_param::N ),
+    m_cache_data( nways, nsets, nwords ),
+    m_heap( m_heap_size ),
+    m_llsc_table(),
+
+#define L2 soclib::common::uint32_log2
+    m_x( L2(m_words), 2),
+    m_y( L2(m_sets), L2(m_words) + 2),
+    m_z( vci_param::N - L2(m_sets) - L2(m_words) - 2, L2(m_sets) + L2(m_words) + 2),
+    m_nline( vci_param::N - L2(m_words) - 2, L2(m_words) + 2),
+#undef L2
+
+    //  FIFOs
+
+    m_cmd_read_addr_fifo("m_cmd_read_addr_fifo", 4),
+    m_cmd_read_length_fifo("m_cmd_read_length_fifo", 4),
+    m_cmd_read_srcid_fifo("m_cmd_read_srcid_fifo", 4),
+    m_cmd_read_trdid_fifo("m_cmd_read_trdid_fifo", 4),
+    m_cmd_read_pktid_fifo("m_cmd_read_pktid_fifo", 4),
+
+    m_cmd_write_addr_fifo("m_cmd_write_addr_fifo",8),
+    m_cmd_write_eop_fifo("m_cmd_write_eop_fifo",8),
+    m_cmd_write_srcid_fifo("m_cmd_write_srcid_fifo",8),
+    m_cmd_write_trdid_fifo("m_cmd_write_trdid_fifo",8),
+    m_cmd_write_pktid_fifo("m_cmd_write_pktid_fifo",8),
+    m_cmd_write_data_fifo("m_cmd_write_data_fifo",8),
+    m_cmd_write_be_fifo("m_cmd_write_be_fifo",8),
+
+    m_cmd_cas_addr_fifo("m_cmd_cas_addr_fifo",4),
+    m_cmd_cas_eop_fifo("m_cmd_cas_eop_fifo",4),
+    m_cmd_cas_srcid_fifo("m_cmd_cas_srcid_fifo",4),
+    m_cmd_cas_trdid_fifo("m_cmd_cas_trdid_fifo",4),
+    m_cmd_cas_pktid_fifo("m_cmd_cas_pktid_fifo",4),
+    m_cmd_cas_wdata_fifo("m_cmd_cas_wdata_fifo",4),
+
+    r_tgt_cmd_fsm("r_tgt_cmd_fsm"),
+
+    m_nseg(0),
+    m_ncseg(0),
+
+    r_read_fsm("r_read_fsm"),
+
+    r_write_fsm("r_write_fsm"),
+
+    m_write_to_init_cmd_inst_fifo("m_write_to_init_cmd_inst_fifo",8),
+    m_write_to_init_cmd_srcid_fifo("m_write_to_init_cmd_srcid_fifo",8),
+#if L1_MULTI_CACHE
+    m_write_to_init_cmd_cache_id_fifo("m_write_to_init_cmd_cache_id_fifo",8),
+#endif
+
+    r_init_rsp_fsm("r_init_rsp_fsm"),
+    r_cleanup_fsm("r_cleanup_fsm"),
+
+    r_cas_fsm("r_cas_fsm"),
+
+    m_cas_to_init_cmd_inst_fifo("m_cas_to_init_cmd_inst_fifo",8),
+    m_cas_to_init_cmd_srcid_fifo("m_cas_to_init_cmd_srcid_fifo",8),
+#if L1_MULTI_CACHE
+    m_cas_to_init_cmd_cache_id_fifo("m_cas_to_init_cmd_cache_id_fifo",8),
+#endif
+
+    r_ixr_rsp_fsm("r_ixr_rsp_fsm"),
+    r_xram_rsp_fsm("r_xram_rsp_fsm"),
+
+    m_xram_rsp_to_init_cmd_inst_fifo("m_xram_rsp_to_init_cmd_inst_fifo",8),
+    m_xram_rsp_to_init_cmd_srcid_fifo("m_xram_rsp_to_init_cmd_srcid_fifo",8),
+#if L1_MULTI_CACHE
+    m_xram_rsp_to_init_cmd_cache_id_fifo("m_xram_rsp_to_init_cmd_cache_id_fifo",8),
+#endif
+
+    r_ixr_cmd_fsm("r_ixr_cmd_fsm"),
+
+    r_tgt_rsp_fsm("r_tgt_rsp_fsm"),
+
+    r_init_cmd_fsm("r_init_cmd_fsm"),
+
+    r_alloc_dir_fsm("r_alloc_dir_fsm"),
+    r_alloc_dir_reset_cpt("r_alloc_dir_reset_cpt"),
+    r_alloc_trt_fsm("r_alloc_trt_fsm"),
+    r_alloc_upt_fsm("r_alloc_upt_fsm"),
+    r_alloc_heap_fsm("r_alloc_heap_fsm"),
+    r_alloc_heap_reset_cpt("r_alloc_heap_reset_cpt")
+    {
+      assert(IS_POW_OF_2(nsets));
+      assert(IS_POW_OF_2(nwords));
+      assert(IS_POW_OF_2(nways));
+      assert(nsets);
+      assert(nwords);
+      assert(nways);
+
+      // check Transaction table size
+      assert( (uint32_log2(transaction_tab_lines) <= vci_param::T) and
+             "Need more bits for VCI TRDID field");
+
+      // Set the broadcast address with Xmin,Xmax,Ymin,Ymax set to maximum
+      m_broadcast_address = 0x3 | (0x7C1F << (vci_param::N-20));
+
+      // Get the segments associated to the MemCache
+      std::list<soclib::common::Segment>::iterator seg;
+      size_t i;
+
+      for(seg = m_seglist.begin(); seg != m_seglist.end() ; seg++) {
+        m_nseg++;
+      }
+      for(seg = m_cseglist.begin(); seg != m_cseglist.end() ; seg++) {
+        m_ncseg++;
+      }
+
+      m_seg = new soclib::common::Segment*[m_nseg];
+
+      i = 0;
+      for ( seg = m_seglist.begin() ; seg != m_seglist.end() ; seg++ ) {
+        m_seg[i] = &(*seg);
+        i++;
+      }
+
+      m_cseg = new soclib::common::Segment*[m_ncseg];
+
+      i = 0;
+      for ( seg = m_cseglist.begin() ; seg != m_cseglist.end() ; seg++ ) {
+          m_cseg[i] = &(*seg);
+          i++;
+      }
+
+      // Allocation for IXR_RSP FSM
+      r_ixr_rsp_to_xram_rsp_rok   = new sc_signal<bool>[m_transaction_tab_lines];
+
+      // Allocation for XRAM_RSP FSM
+      r_xram_rsp_victim_data      = new sc_signal<data_t>[nwords];
+      r_xram_rsp_to_tgt_rsp_data  = new sc_signal<data_t>[nwords];
+      r_xram_rsp_to_ixr_cmd_data  = new sc_signal<data_t>[nwords];
+
+      // Allocation for READ FSM
+      r_read_data                 = new sc_signal<data_t>[nwords];
+      r_read_to_tgt_rsp_data      = new sc_signal<data_t>[nwords];
+
+      // Allocation for WRITE FSM
+      r_write_data                = new sc_signal<data_t>[nwords];
+      r_write_be                  = new sc_signal<be_t>[nwords];
+      r_write_to_init_cmd_data    = new sc_signal<data_t>[nwords];
+      r_write_to_init_cmd_be      = new sc_signal<be_t>[nwords];
+      r_write_to_ixr_cmd_data     = new sc_signal<data_t>[nwords];
+
+      // Allocation for CAS FSM
+      r_cas_to_ixr_cmd_data        = new sc_signal<data_t>[nwords];
+      r_cas_rdata                  = new sc_signal<data_t>[2];
+
+
+      // Simulation
+
+      SC_METHOD(transition);
+      dont_initialize();
+      sensitive << p_clk.pos();
+
+      SC_METHOD(genMoore);
+      dont_initialize();
+      sensitive << p_clk.neg();
+
+    } // end constructor
+
+///////////////////////////////////////////////////////////////////////
+tmpl(void)::start_monitor( vci_addr_t addr, vci_addr_t length )
+///////////////////////////////////////////////////////////////////////
+{
+    m_monitor_ok        = true;
+    m_monitor_base      = addr;
+    m_monitor_length    = length;
+}
+
+///////////////////////////////////////////////////////////////////////
+tmpl(void)::stop_monitor()
+///////////////////////////////////////////////////////////////////////
+{
+    m_monitor_ok        = false;
+}
+
+///////////////////////////////////////////////////////////////////////
+tmpl(void)::check_monitor( const char *buf, vci_addr_t addr, data_t data )
+///////////////////////////////////////////////////////////////////////
+{
+    if ( (addr >= m_monitor_base) and
+         (addr < m_monitor_base + m_monitor_length) )
+    {
+        std::cout << " MEMC Write Monitor : " << buf << " Address = " << std::hex << addr
+                  << " / Data = " << data << std::endl;
+    }
+}
+
+/////////////////////////////////////////////////////
+tmpl(void)::copies_monitor( vci_addr_t addr )
+/////////////////////////////////////////////////////
+{
+    DirectoryEntry entry = m_cache_directory.read_neutral(addr);
+    if ( (entry.count != m_debug_previous_count) or
+         (entry.valid != m_debug_previous_hit) )
+    {
+    std::cout << " MEMC " << name()
+              << " cache change at cycle " << std::dec << m_cpt_cycles
+              << " for address " << std::hex << addr
+              << " / HIT = " << entry.valid
+              << " / COUNT = " << std::dec << entry.count << std::endl;
+    }
+    m_debug_previous_count = entry.count;
+    m_debug_previous_hit = entry.valid;
+}
+
+//////////////////////////////////////////////////
+tmpl(void)::print_trace()
+//////////////////////////////////////////////////
+{
+    std::cout << "MEMC " << name() << std::endl;
+    std::cout << "  "  << tgt_cmd_fsm_str[r_tgt_cmd_fsm]
+              << " | " << tgt_rsp_fsm_str[r_tgt_rsp_fsm]
+              << " | " << read_fsm_str[r_read_fsm]
+              << " | " << write_fsm_str[r_write_fsm]
+              << " | " << cas_fsm_str[r_cas_fsm]
+              << " | " << cleanup_fsm_str[r_cleanup_fsm] << std::endl;
+    std::cout << "  "  << init_cmd_fsm_str[r_init_cmd_fsm]
+              << " | " << init_rsp_fsm_str[r_init_rsp_fsm]
+              << " | " << ixr_cmd_fsm_str[r_ixr_cmd_fsm]
+              << " | " << ixr_rsp_fsm_str[r_ixr_rsp_fsm]
+              << " | " << xram_rsp_fsm_str[r_xram_rsp_fsm] << std::endl;
+
+              //m_llsc_table.print_trace();
+
+}
+
+/////////////////////////////////////////
+tmpl(void)::print_stats()
+/////////////////////////////////////////
+{
+  std::cout << "----------------------------------" << std::dec << std::endl;
+  std::cout
+    << "MEM_CACHE " << m_srcid_ini << " / Time = " << m_cpt_cycles << std::endl
+    << "- READ RATE            = " << (double) m_cpt_read/m_cpt_cycles << std::endl
+    << "- READ TOTAL           = " << m_cpt_read << std::endl
+    << "- READ MISS RATE       = " << (double) m_cpt_read_miss/m_cpt_read << std::endl
+    << "- WRITE RATE           = " << (double) m_cpt_write/m_cpt_cycles << std::endl
+    << "- WRITE TOTAL          = " << m_cpt_write << std::endl
+    << "- WRITE MISS RATE      = " << (double) m_cpt_write_miss/m_cpt_write << std::endl
+    << "- WRITE BURST LENGTH   = " << (double) m_cpt_write_cells/m_cpt_write << std::endl
+    << "- WRITE BURST TOTAL    = " << m_cpt_write_cells << std::endl
+    << "- REQUESTS TRT FULL    = " << m_cpt_trt_full << std::endl
+    << "- READ TRT BLOKED HIT  = " << m_cpt_trt_rb << std::endl
+    << "- UPDATE RATE          = " << (double) m_cpt_update/m_cpt_cycles << std::endl
+    << "- UPDATE ARITY         = " << (double) m_cpt_update_mult/m_cpt_update << std::endl
+    << "- INVAL MULTICAST RATE = " << (double) (m_cpt_inval-m_cpt_inval_brdcast)/m_cpt_cycles << std::endl
+    << "- INVAL MULTICAST ARITY= " << (double) m_cpt_inval_mult/(m_cpt_inval-m_cpt_inval_brdcast) << std::endl
+    << "- INVAL BROADCAST RATE = " << (double) m_cpt_inval_brdcast/m_cpt_cycles << std::endl
+    << "- SAVE DIRTY RATE      = " << (double) m_cpt_write_dirty/m_cpt_cycles << std::endl
+    << "- CLEANUP RATE         = " << (double) m_cpt_cleanup/m_cpt_cycles << std::endl
+    << "- LL RATE              = " << (double) m_cpt_ll/m_cpt_cycles << std::endl
+    << "- SC RATE              = " << (double) m_cpt_sc/m_cpt_cycles << std::endl
+    << "- CAS RATE             = " << (double) m_cpt_cas/m_cpt_cycles << std::endl;
+}
+
+  /////////////////////////////////
+  tmpl(/**/)::~VciMemCache()
+    /////////////////////////////////
+  {
+    delete [] r_ixr_rsp_to_xram_rsp_rok;
+
+    delete [] r_xram_rsp_victim_data;
+    delete [] r_xram_rsp_to_tgt_rsp_data;
+    delete [] r_xram_rsp_to_ixr_cmd_data;
+
+    delete [] r_read_data;
+    delete [] r_read_to_tgt_rsp_data;
+
+    delete [] r_write_data;
+    delete [] r_write_be;
+    delete [] r_write_to_init_cmd_data;
+  }
+
+//////////////////////////////////
+tmpl(void)::transition()
+//////////////////////////////////
+{
+  using soclib::common::uint32_log2;
+
+  // RESET
+  if ( ! p_resetn.read() ) {
+
+    // Initializing FSMs
+    r_tgt_cmd_fsm    = TGT_CMD_IDLE;
+    r_tgt_rsp_fsm    = TGT_RSP_READ_IDLE;
+    r_init_cmd_fsm   = INIT_CMD_INVAL_IDLE;
+    r_init_rsp_fsm   = INIT_RSP_IDLE;
+    r_read_fsm       = READ_IDLE;
+    r_write_fsm      = WRITE_IDLE;
+    r_cas_fsm        = CAS_IDLE;
+    r_cleanup_fsm    = CLEANUP_IDLE;
+    r_alloc_dir_fsm  = ALLOC_DIR_RESET;
+    r_alloc_heap_fsm = ALLOC_HEAP_RESET;
+    r_alloc_trt_fsm  = ALLOC_TRT_READ;
+    r_alloc_upt_fsm  = ALLOC_UPT_WRITE;
+    r_ixr_rsp_fsm    = IXR_RSP_IDLE;
+    r_xram_rsp_fsm   = XRAM_RSP_IDLE;
+    r_ixr_cmd_fsm    = IXR_CMD_READ_IDLE;
+
+    m_debug_global         = false;
+    m_debug_tgt_cmd_fsm    = false;
+    m_debug_tgt_rsp_fsm    = false;
+    m_debug_init_cmd_fsm   = false;
+    m_debug_init_rsp_fsm   = false;
+    m_debug_read_fsm       = false;
+    m_debug_write_fsm      = false;
+    m_debug_cas_fsm        = false;
+    m_debug_cleanup_fsm    = false;
+    m_debug_ixr_cmd_fsm    = false;
+    m_debug_ixr_rsp_fsm    = false;
+    m_debug_xram_rsp_fsm   = false;
+    m_debug_previous_hit   = false;
+    m_debug_previous_count = 0;
+
+    //  Initializing Tables
+    m_transaction_tab.init();
+    m_update_tab.init();
+
+    // initializing FIFOs and communication Buffers
+
+    m_cmd_read_addr_fifo.init();
+    m_cmd_read_length_fifo.init();
+    m_cmd_read_srcid_fifo.init();
+    m_cmd_read_trdid_fifo.init();
+    m_cmd_read_pktid_fifo.init();
+
+    m_cmd_write_addr_fifo.init();
+    m_cmd_write_eop_fifo.init();
+    m_cmd_write_srcid_fifo.init();
+    m_cmd_write_trdid_fifo.init();
+    m_cmd_write_pktid_fifo.init();
+    m_cmd_write_data_fifo.init();
+
+    m_cmd_cas_addr_fifo.init()  ;
+    m_cmd_cas_srcid_fifo.init() ;
+    m_cmd_cas_trdid_fifo.init() ;
+    m_cmd_cas_pktid_fifo.init() ;
+    m_cmd_cas_wdata_fifo.init() ;
+    m_cmd_cas_eop_fifo.init()   ;
+
+    r_read_to_tgt_rsp_req = false;
+    r_read_to_ixr_cmd_req = false;
+
+    r_write_to_tgt_rsp_req          = false;
+    r_write_to_ixr_cmd_req          = false;
+    r_write_to_init_cmd_multi_req   = false;
+    r_write_to_init_cmd_brdcast_req = false;
+    r_write_to_init_rsp_req         = false;
+
+    m_write_to_init_cmd_inst_fifo.init();
+    m_write_to_init_cmd_srcid_fifo.init();
+#if L1_MULTI_CACHE
+    m_write_to_init_cmd_cache_id_fifo.init();
+#endif
+
+    r_cleanup_to_tgt_rsp_req      = false;
+
+    r_init_rsp_to_tgt_rsp_req     = false;
+
+    r_cas_to_tgt_rsp_req          = false;
+    r_cas_cpt                     = 0    ;
+    r_cas_lfsr                    = -1   ;
+    r_cas_to_ixr_cmd_req          = false;
+    r_cas_to_init_cmd_multi_req   = false;
+    r_cas_to_init_cmd_brdcast_req = false;
+
+    m_cas_to_init_cmd_inst_fifo.init();
+    m_cas_to_init_cmd_srcid_fifo.init();
+#if L1_MULTI_CACHE
+    m_cas_to_init_cmd_cache_id_fifo.init();
+#endif
+
+    for(size_t i=0; i<m_transaction_tab_lines ; i++){
+      r_ixr_rsp_to_xram_rsp_rok[i] = false;
+    }
+
+    r_xram_rsp_to_tgt_rsp_req          = false;
+    r_xram_rsp_to_init_cmd_multi_req   = false;
+    r_xram_rsp_to_init_cmd_brdcast_req = false;
+    r_xram_rsp_to_ixr_cmd_req          = false;
+    r_xram_rsp_trt_index               = 0;
+
+    m_xram_rsp_to_init_cmd_inst_fifo.init();
+    m_xram_rsp_to_init_cmd_srcid_fifo.init();
+#if L1_MULTI_CACHE
+    m_xram_rsp_to_init_cmd_cache_id_fifo.init();
+#endif
+
+    r_ixr_cmd_cpt          = 0;
+    r_alloc_dir_reset_cpt  = 0;
+    r_alloc_heap_reset_cpt = 0;
+
+    r_copies_limit         = 3;
+
+    // Activity counters
+    m_cpt_cycles        = 0;
+    m_cpt_read          = 0;
+    m_cpt_read_miss     = 0;
+    m_cpt_write         = 0;
+    m_cpt_write_miss    = 0;
+    m_cpt_write_cells   = 0;
+    m_cpt_write_dirty   = 0;
+    m_cpt_update        = 0;
+    m_cpt_update_mult   = 0;
+    m_cpt_inval_brdcast = 0;
+    m_cpt_inval         = 0;
+    m_cpt_inval_mult    = 0;
+    m_cpt_cleanup       = 0;
+    m_cpt_ll            = 0;
+    m_cpt_sc            = 0;
+    m_cpt_cas           = 0;
+    m_cpt_trt_full      = 0;
+    m_cpt_trt_rb        = 0;
+
+    return;
+  }
+
+  bool    cmd_read_fifo_put = false;
+  bool    cmd_read_fifo_get = false;
+
+  bool    cmd_write_fifo_put = false;
+  bool    cmd_write_fifo_get = false;
+
+  bool    cmd_cas_fifo_put = false;
+  bool    cmd_cas_fifo_get = false;
+
+  bool    write_to_init_cmd_fifo_put   = false;
+  bool    write_to_init_cmd_fifo_get   = false;
+  bool    write_to_init_cmd_fifo_inst  = false;
+  size_t  write_to_init_cmd_fifo_srcid = 0;
+
+#if L1_MULTI_CACHE
+  size_t  write_to_init_cmd_fifo_cache_id = 0;
+#endif
+
+  bool    xram_rsp_to_init_cmd_fifo_put   = false;
+  bool    xram_rsp_to_init_cmd_fifo_get   = false;
+  bool    xram_rsp_to_init_cmd_fifo_inst  = false;
+  size_t  xram_rsp_to_init_cmd_fifo_srcid = 0;
+
+#if L1_MULTI_CACHE
+  size_t  xram_rsp_to_init_cmd_fifo_cache_id = 0;
+#endif
+
+  bool    cas_to_init_cmd_fifo_put   = false;
+  bool    cas_to_init_cmd_fifo_get   = false;
+  bool    cas_to_init_cmd_fifo_inst  = false;
+  size_t  cas_to_init_cmd_fifo_srcid = 0;
+
+#if L1_MULTI_CACHE
+  size_t  cas_to_init_cmd_fifo_cache_id = 0;
+#endif
+
+  m_debug_global       = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_tgt_cmd_fsm  = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_tgt_rsp_fsm  = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_init_cmd_fsm = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_init_rsp_fsm = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_read_fsm     = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_write_fsm    = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_cas_fsm      = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_cleanup_fsm  = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_ixr_cmd_fsm  = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_ixr_rsp_fsm  = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+  m_debug_xram_rsp_fsm = (m_cpt_cycles > m_debug_start_cycle) and m_debug_ok;
+
+#if DEBUG_MEMC_GLOBAL
+  if( m_debug_global )
+  {
+    std::cout
+      << "---------------------------------------------" << std::dec << std::endl
+      << "MEM_CACHE " << m_srcid_ini << " ; Time = " << m_cpt_cycles << std::endl
+      << " - TGT_CMD FSM    = " << tgt_cmd_fsm_str[r_tgt_cmd_fsm] << std::endl
+      << " - TGT_RSP FSM    = " << tgt_rsp_fsm_str[r_tgt_rsp_fsm] << std::endl
+      << " - INIT_CMD FSM   = " << init_cmd_fsm_str[r_init_cmd_fsm] << std::endl
+      << " - INIT_RSP FSM   = " << init_rsp_fsm_str[r_init_rsp_fsm] << std::endl
+      << " - READ FSM       = " << read_fsm_str[r_read_fsm] << std::endl
+      << " - WRITE FSM      = " << write_fsm_str[r_write_fsm] << std::endl
+      << " - CAS FSM        = " << cas_fsm_str[r_cas_fsm] << std::endl
+      << " - CLEANUP FSM    = " << cleanup_fsm_str[r_cleanup_fsm] << std::endl
+      << " - IXR_CMD FSM    = " << ixr_cmd_fsm_str[r_ixr_cmd_fsm] << std::endl
+      << " - IXR_RSP FSM    = " << ixr_rsp_fsm_str[r_ixr_rsp_fsm] << std::endl
+      << " - XRAM_RSP FSM   = " << xram_rsp_fsm_str[r_xram_rsp_fsm] << std::endl
+      << " - ALLOC_DIR FSM  = " << alloc_dir_fsm_str[r_alloc_dir_fsm] << std::endl
+      << " - ALLOC_TRT FSM  = " << alloc_trt_fsm_str[r_alloc_trt_fsm] << std::endl
+      << " - ALLOC_UPT FSM  = " << alloc_upt_fsm_str[r_alloc_upt_fsm] << std::endl
+      << " - ALLOC_HEAP FSM = " << alloc_heap_fsm_str[r_alloc_heap_fsm] << std::endl;
+  }
+#endif
+
+  ////////////////////////////////////////////////////////////////////////////////////
+  //    TGT_CMD FSM
+  ////////////////////////////////////////////////////////////////////////////////////
+  // The TGT_CMD_FSM controls the incoming VCI command pakets from the processors
+  //
+  // There are 5 types of accepted commands :
+  // - READ   : A READ request has a length of 1 VCI cell. It can be a single word
+  //            or an entire cache line, depending on the PLEN value.
+  // - WRITE  : A WRITE request has a maximum length of 16 cells, and can only
+  //            concern words in a same line.
+  // - CAS    : A CAS request has a length of 2 cells or 4 cells.
+  // - LL     : An LL request has a length of 1 cell.
+  // - SC     : An SC request has a length of 2 cells. First cell contains the
+  //            acces key, second cell the data to write in case of success.
+  ////////////////////////////////////////////////////////////////////////////////////
+
+  switch ( r_tgt_cmd_fsm.read() )
+  {
+    //////////////////
+    case TGT_CMD_IDLE:
+      if ( p_vci_tgt.cmdval )
+      {
+
+#if DEBUG_MEMC_TGT_CMD
+        if( m_debug_tgt_cmd_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name() << ".TGT_CMD_IDLE> Receive command from srcid "
+            << std::dec << p_vci_tgt.srcid.read()
+            << " / for address " << std::hex << p_vci_tgt.address.read() << std::endl;
+        }
+#endif
+        // checking segmentation violation
+        vci_addr_t  address = p_vci_tgt.address.read();
+        uint32_t    plen    = p_vci_tgt.plen.read();
+        bool found = false;
+        for ( size_t seg_id = 0 ; seg_id < m_nseg ; seg_id++ )
+        {
+          if ( m_seg[seg_id]->contains(address) &&
+              m_seg[seg_id]->contains(address + plen - vci_param::B) )
+          {
+            found = true;
+          }
+        }
+        if ( not found )
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name() << std::endl;
+          std::cout
+            << "Out of segment VCI address in TGT_CMD_IDLE state (address = "
+            << std::hex << address << ", srcid = " << p_vci_tgt.srcid.read()
+            << std::dec << ", cycle = " << m_cpt_cycles << ")" << std::endl;
+          exit(0);
+        }
+
+        if ( p_vci_tgt.cmd.read() == vci_param::CMD_READ )
+        {
+          // check that the pktid is either :
+          // TYPE_READ_DATA_UNC
+          // TYPE_READ_DATA_MISS
+          // TYPE_READ_INS_UNC
+          // TYPE_READ_INS_MISS
+          // ==> bit2 must be zero with the TSAR encoding
+          // ==> mask = 0b0100 = 0x4
+          assert(((p_vci_tgt.pktid.read() & 0x4) == 0x0) &&
+            "The type specified in the pktid field is incompatible with the READ CMD");
+          r_tgt_cmd_fsm = TGT_CMD_READ;
+        }
+        else if ( p_vci_tgt.cmd.read() == vci_param::CMD_WRITE )
+        {
+          // check that the pktid is TYPE_WRITE
+          // ==> TYPE_WRITE = X100 with the TSAR encoding
+          // ==> mask = 0b0111 = 0x7
+          assert(((p_vci_tgt.pktid.read() & 0x7) == 0x4) &&
+            "The type specified in the pktid field is incompatible with the WRITE CMD");
+          r_tgt_cmd_fsm = TGT_CMD_WRITE;
+        }
+        else if ( p_vci_tgt.cmd.read() == vci_param::CMD_LOCKED_READ )
+        {
+          // check that the pktid is TYPE_LL
+          // ==> TYPE_LL = X110 with the TSAR encoding
+          // ==> mask = 0b0111 = 0x7
+          assert(((p_vci_tgt.pktid.read() & 0x7) == 0x6) &&
+            "The type specified in the pktid field is incompatible with the LL CMD");
+          r_tgt_cmd_fsm = TGT_CMD_READ;
+        }
+        else if ( p_vci_tgt.cmd.read() == vci_param::CMD_NOP )
+        {
+          // check that the pktid is either :
+          // TYPE_CAS
+          // TYPE_SC
+          // ==> TYPE_CAS = X101 with the TSAR encoding
+          // ==> TYPE_SC  = X111 with the TSAR encoding
+          // ==> mask = 0b0101 = 0x5
+          assert(((p_vci_tgt.pktid.read() & 0x5) == 0x5 ) &&
+            "The type specified in the pktid field is incompatible with the NOP CMD");
+
+          if((p_vci_tgt.pktid.read() & 0x7) == TYPE_CAS)
+            r_tgt_cmd_fsm = TGT_CMD_CAS;
+          else // TYPE_SC
+            r_tgt_cmd_fsm = TGT_CMD_WRITE;
+        }
+        else
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " TGT_CMD_IDLE state" << std::endl;
+          std::cout << " illegal VCI command type" << std::endl;
+          exit(0);
+        }
+      }
+      break;
+
+    //////////////////
+    case TGT_CMD_READ:
+      // This test checks that the read does not cross a cache line limit.
+      // It must not be taken into account when dealing with an LL CMD.
+      if (((m_x[(vci_addr_t)p_vci_tgt.address.read()]+(p_vci_tgt.plen.read()>>2)) > 16) && ( p_vci_tgt.cmd.read() != vci_param::CMD_LOCKED_READ ))
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name() << " TGT_CMD_READ state"
+          << std::endl;
+        std::cout
+          << " illegal address/plen combination for VCI read command" << std::endl;
+        exit(0);
+      }
+      if ( !p_vci_tgt.eop.read() )
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name() << " TGT_CMD_READ state"
+          << std::endl;
+        std::cout
+          << " read or ll command packets must contain one single flit"
+          << std::endl;
+        exit(0);
+      }
+
+      if ( p_vci_tgt.cmdval && m_cmd_read_addr_fifo.wok() )
+      {
+
+#if DEBUG_MEMC_TGT_CMD
+        if( m_debug_tgt_cmd_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".TGT_CMD_READ> Push into read_fifo:"
+            << " address = " << std::hex << p_vci_tgt.address.read()
+            << " srcid = " << std::dec << p_vci_tgt.srcid.read()
+            << " trdid = " << p_vci_tgt.trdid.read()
+            << " pktid = " << p_vci_tgt.pktid.read()
+            << " plen = " << std::dec << p_vci_tgt.plen.read() << std::endl;
+        }
+#endif
+        cmd_read_fifo_put = true;
+        if ( p_vci_tgt.cmd.read() == vci_param::CMD_LOCKED_READ )
+          m_cpt_ll++;
+        else
+          m_cpt_read++;
+        r_tgt_cmd_fsm = TGT_CMD_IDLE;
+      }
+      break;
+
+    ///////////////////
+    case TGT_CMD_WRITE:
+      if ( p_vci_tgt.cmdval && m_cmd_write_addr_fifo.wok() )
+      {
+
+#if DEBUG_MEMC_TGT_CMD
+        if( m_debug_tgt_cmd_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".TGT_CMD_WRITE> Push into write_fifo:"
+            << " address = " << std::hex << p_vci_tgt.address.read()
+            << " srcid = " << std::dec << p_vci_tgt.srcid.read()
+            << " trdid = " << p_vci_tgt.trdid.read()
+            << " pktid = " << p_vci_tgt.pktid.read()
+            << " wdata = " << std::hex << p_vci_tgt.wdata.read()
+            << " be = " << p_vci_tgt.be.read()
+            << " plen = " << std::dec << p_vci_tgt.plen.read() << std::endl;
+        }
+#endif
+        cmd_write_fifo_put = true;
+        if(  p_vci_tgt.eop )  r_tgt_cmd_fsm = TGT_CMD_IDLE;
+      }
+      break;
+
+    ////////////////////
+    case TGT_CMD_CAS:
+      if ( (p_vci_tgt.plen.read() != 8) && (p_vci_tgt.plen.read() != 16) )
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name() << " TGT_CMD_CAS state"
+          << std::endl
+          << "illegal format for CAS command " << std::endl;
+
+        exit(0);
+      }
+
+      if ( p_vci_tgt.cmdval && m_cmd_cas_addr_fifo.wok() )
+      {
+
+#if DEBUG_MEMC_TGT_CMD
+        if( m_debug_tgt_cmd_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".TGT_CMD_CAS> Pushing command into cmd_cas_fifo:"
+            << " address = " << std::hex << p_vci_tgt.address.read()
+            << " srcid = " << std::dec << p_vci_tgt.srcid.read()
+            << " trdid = " << p_vci_tgt.trdid.read()
+            << " pktid = " << p_vci_tgt.pktid.read()
+            << " wdata = " << std::hex << p_vci_tgt.wdata.read()
+            << " be = " << p_vci_tgt.be.read()
+            << " plen = " << std::dec << p_vci_tgt.plen.read() << std::endl;
+        }
+#endif
+        cmd_cas_fifo_put = true;
+        if( p_vci_tgt.eop ) r_tgt_cmd_fsm = TGT_CMD_IDLE;
+      }
+      break;
+  } // end switch tgt_cmd_fsm
+
+  /////////////////////////////////////////////////////////////////////////
+  //    INIT_RSP FSM
+  /////////////////////////////////////////////////////////////////////////
+  // This FSM controls the response to the update or inval coherence
+  // requests sent by the memory cache to the L1 caches and update the UPT.
+  //
+  // It can be update or inval requests initiated by the WRITE FSM,
+  // or inval requests initiated by the XRAM_RSP FSM.
+  // It can also be a direct request from the WRITE FSM.
+  //
+  // The FSM decrements the proper entry in UPT.
+  // It sends a request to the TGT_RSP FSM to complete the pending
+  // write transaction (acknowledge response to the writer processor),
+  // and clear the UPT entry when all responses have been received.
+  //
+  // All those response packets are one word, compact
+  // packets complying with the VCI advanced format.
+  // The index in the Table is defined in the RTRDID field, and
+  // the transaction type is defined in the UPT entry.
+  /////////////////////////////////////////////////////////////////////
+
+  switch ( r_init_rsp_fsm.read() )
+  {
+    ///////////////////
+    case INIT_RSP_IDLE:   // wait a response for a coherence transaction
+      if ( p_vci_ini.rspval )
+      {
+
+#if DEBUG_MEMC_INIT_RSP
+        if( m_debug_init_rsp_fsm )
+        {
+          std::cout <<  "  <MEMC " << name() << ".INIT_RSP_IDLE> Response for UPT entry "
+            << p_vci_ini.rtrdid.read() << std::endl;
+        }
+#endif
+        if ( p_vci_ini.rtrdid.read() >= m_update_tab.size() )
+        {
+          std::cout
+            << "VCI_MEM_CACHE ERROR " << name()
+            << " INIT_RSP_IDLE state" << std::endl
+            << "index too large for UPT: "
+            << " / rtrdid = " << std::dec << p_vci_ini.rtrdid.read()
+            << " / UPT size = " << std::dec << m_update_tab.size()
+            << std::endl;
+
+          exit(0);
+        }
+        if ( !p_vci_ini.reop.read() )
+        {
+          std::cout
+            << "VCI_MEM_CACHE ERROR " << name()
+            << " INIT_RSP_IDLE state" << std::endl
+            << "all coherence response packets must be one flit"
+            << std::endl;
+
+          exit(0);
+        }
+
+        r_init_rsp_upt_index = p_vci_ini.rtrdid.read();
+        r_init_rsp_fsm = INIT_RSP_UPT_LOCK;
+      }
+      else if( r_write_to_init_rsp_req.read() )
+      {
+        r_init_rsp_upt_index = r_write_to_init_rsp_upt_index.read();
+        r_write_to_init_rsp_req = false;
+        r_init_rsp_fsm = INIT_RSP_UPT_LOCK;
+      }
+      break;
+
+    ///////////////////////
+    case INIT_RSP_UPT_LOCK: // decrement the number of expected responses
+      if ( r_alloc_upt_fsm.read() == ALLOC_UPT_INIT_RSP )
+      {
+        size_t count = 0;
+        bool valid   = m_update_tab.decrement(r_init_rsp_upt_index.read(), count);
+
+#if DEBUG_MEMC_INIT_RSP
+        if( m_debug_init_rsp_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".INIT_RSP_UPT_LOCK> Decrement the responses counter for UPT:"
+            << " entry = " << r_init_rsp_upt_index.read()
+            << " / rsp_count = " << std::dec << count << std::endl;
+        }
+#endif
+        if ( not valid )
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " INIT_RSP_UPT_LOCK state" << std::endl
+            << "unsuccessful access to decrement the UPT" << std::endl;
+
+          exit(0);
+        }
+
+        if ( count == 0 ) r_init_rsp_fsm = INIT_RSP_UPT_CLEAR;
+        else              r_init_rsp_fsm = INIT_RSP_IDLE;
+      }
+      break;
+
+      ////////////////////////
+    case INIT_RSP_UPT_CLEAR:  // clear the UPT entry
+      if ( r_alloc_upt_fsm.read() == ALLOC_UPT_INIT_RSP )
+      {
+        r_init_rsp_srcid = m_update_tab.srcid(r_init_rsp_upt_index.read());
+        r_init_rsp_trdid = m_update_tab.trdid(r_init_rsp_upt_index.read());
+        r_init_rsp_pktid = m_update_tab.pktid(r_init_rsp_upt_index.read());
+        r_init_rsp_nline = m_update_tab.nline(r_init_rsp_upt_index.read());
+        bool need_rsp    = m_update_tab.need_rsp(r_init_rsp_upt_index.read());
+
+        if ( need_rsp ) r_init_rsp_fsm = INIT_RSP_END;
+        else            r_init_rsp_fsm = INIT_RSP_IDLE;
+
+        m_update_tab.clear(r_init_rsp_upt_index.read());
+
+#if DEBUG_MEMC_INIT_RSP
+        if ( m_debug_init_rsp_fsm )
+        {
+          std::cout <<  "  <MEMC " << name() << ".INIT_RSP_UPT_CLEAR> Clear UPT entry "
+            << r_init_rsp_upt_index.read() <<  std::endl;
+        }
+#endif
+      }
+      break;
+
+    //////////////////
+    case INIT_RSP_END:  // Post a request to TGT_RSP FSM
+      if ( !r_init_rsp_to_tgt_rsp_req )
+      {
+        r_init_rsp_to_tgt_rsp_req   = true;
+        r_init_rsp_to_tgt_rsp_srcid = r_init_rsp_srcid.read();
+        r_init_rsp_to_tgt_rsp_trdid = r_init_rsp_trdid.read();
+        r_init_rsp_to_tgt_rsp_pktid = r_init_rsp_pktid.read();
+        r_init_rsp_fsm = INIT_RSP_IDLE;
+
+#if DEBUG_MEMC_INIT_RSP
+        if ( m_debug_init_rsp_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name()
+            << ".INIT_RSP_END> Request TGT_RSP FSM to send a response to srcid "
+            << r_init_rsp_srcid.read()
+            << std::endl;
+        }
+#endif
+      }
+      break;
+  } // end switch r_init_rsp_fsm
+
+  ////////////////////////////////////////////////////////////////////////////////////
+  //    READ FSM
+  ////////////////////////////////////////////////////////////////////////////////////
+  // The READ FSM controls the VCI read  and ll requests.
+  // It takes the lock protecting the cache directory to check the cache line status:
+  // - In case of HIT
+  //   The fsm copies the data (one line, or one single word)
+  //   in the r_read_to_tgt_rsp buffer. It waits if this buffer is not empty.
+  //   The requesting initiator is registered in the cache directory.
+  //   If the number of copy is larger than 1, the new copy is registered
+  //   in the HEAP.
+  //   If the number of copy is larger than the threshold, the HEAP is cleared,
+  //   and the corresponding line switches to the counter mode.
+  // - In case of MISS
+  //   The READ fsm takes the lock protecting the transaction tab.
+  //   If a read transaction to the XRAM for this line already exists,
+  //   or if the transaction tab is full, the fsm is stalled.
+  //   If a TRT entry is free, the READ request is registered in TRT,
+  //   it is consumed in the request FIFO, and transmited to the IXR_CMD FSM.
+  //   The READ FSM returns in the IDLE state as the read transaction will be
+  //   completed when the missing line will be received.
+  ////////////////////////////////////////////////////////////////////////////////////
+
+  switch ( r_read_fsm.read() )
+  {
+    ///////////////
+    case READ_IDLE:
+    // waiting a read request
+    {
+      if (m_cmd_read_addr_fifo.rok())
+      {
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".READ_IDLE> Read request:"
+            << " srcid = " << std::dec << m_cmd_read_srcid_fifo.read()
+            << " / address = " << std::hex << m_cmd_read_addr_fifo.read()
+            << " / pktid = " << std::hex << m_cmd_read_pktid_fifo.read()
+            << " / nwords = " << std::dec << m_cmd_read_length_fifo.read() << std::endl;
+        }
+#endif
+        r_read_fsm = READ_DIR_REQ;
+      }
+      break;
+    }
+
+    ///////////////////
+    case READ_DIR_REQ:
+    // Get the lock to the directory
+    {
+      if ( r_alloc_dir_fsm.read() == ALLOC_DIR_READ )
+      {
+        r_read_fsm = READ_DIR_LOCK;
+      }
+
+#if DEBUG_MEMC_READ
+      if( m_debug_read_fsm )
+      {
+        std::cout 
+          << "  <MEMC " << name() << ".READ_DIR_REQ> Requesting DIR lock "
+          << std::endl;
+      }
+#endif
+      break;
+    }
+
+    ///////////////////
+    case READ_DIR_LOCK:
+    // check directory for hit / miss
+    {
+      if ( r_alloc_dir_fsm.read() == ALLOC_DIR_READ )
+      {
+        size_t way = 0;
+        DirectoryEntry entry =
+          m_cache_directory.read(m_cmd_read_addr_fifo.read(), way);
+        if((m_cmd_read_pktid_fifo.read() & 0x7) == TYPE_LL) // access the global table ONLY when we have an LL cmd
+        {
+          r_read_ll_key   = m_llsc_table.ll(m_cmd_read_addr_fifo.read());
+        }
+        r_read_is_cnt     = entry.is_cnt;
+        r_read_dirty      = entry.dirty;
+        r_read_lock       = entry.lock;
+        r_read_tag        = entry.tag;
+        r_read_way        = way;
+        r_read_count      = entry.count;
+        r_read_copy       = entry.owner.srcid;
+
+#if L1_MULTI_CACHE
+        r_read_copy_cache = entry.owner.cache_id;
+#endif
+        r_read_copy_inst  = entry.owner.inst;
+        r_read_ptr        = entry.ptr; // pointer to the heap
+
+        // check if this is a cached read, this means pktid is either
+        // TYPE_READ_DATA_MISS 0bX001 with TSAR encoding
+        // TYPE_READ_INS_MISS  0bX011 with TSAR encoding
+        bool cached_read = (m_cmd_read_pktid_fifo.read() & 0x1);
+        if(  entry.valid ) // hit
+        {
+          // test if we need to register a new copy in the heap
+          if ( entry.is_cnt || (entry.count == 0) || !cached_read )
+          {
+            r_read_fsm = READ_DIR_HIT;
+          }
+          else
+          {
+            r_read_fsm = READ_HEAP_REQ;
+          }
+        }
+        else      // miss
+        {
+          r_read_fsm = READ_TRT_LOCK;
+        }
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name() << ".READ_DIR_LOCK> Accessing directory: "
+            << " address = " << std::hex << m_cmd_read_addr_fifo.read()
+            << " / hit = " << std::dec << entry.valid
+            << " / count = " <<std::dec << entry.count
+            << " / is_cnt = " << entry.is_cnt << std::endl;
+            if((m_cmd_read_pktid_fifo.read() & 0x7) == TYPE_LL)
+            {
+              std::cout
+                << "  <MEMC " << name() << ".READ_DIR_LOCK> global_llsc_table LL access" << std::endl;
+            }
+        }
+#endif
+      }
+      else
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name()
+          << " READ_DIR_LOCK state" << std::endl
+          << "Bad DIR allocation"   << std::endl;
+
+        exit(0);
+      }
+      break;
+    }
+
+    //////////////////
+    case READ_DIR_HIT:
+    {
+      //  read data in cache & update the directory
+      //  we enter this state in 3 cases:
+      //  - the read request is uncachable
+      //  - the cache line is in counter mode
+      //  - the cache line is valid but not replcated
+
+      if( r_alloc_dir_fsm.read() == ALLOC_DIR_READ )
+      {
+        // signals generation
+        // check if this is an instruction read, this means pktid is either
+        // TYPE_READ_INS_UNC   0bX010 with TSAR encoding
+        // TYPE_READ_INS_MISS  0bX011 with TSAR encoding
+        bool inst_read    = (m_cmd_read_pktid_fifo.read() & 0x2);
+        // check if this is a cached read, this means pktid is either
+        // TYPE_READ_DATA_MISS 0bX001 with TSAR encoding
+        // TYPE_READ_INS_MISS  0bX011 with TSAR encoding
+        bool cached_read  = (m_cmd_read_pktid_fifo.read() & 0x1);
+        bool is_cnt       = r_read_is_cnt.read();
+
+        // read data in the cache
+        size_t set        = m_y[(vci_addr_t)(m_cmd_read_addr_fifo.read())];
+        size_t way        = r_read_way.read();
+
+        m_cache_data.read_line(way, set, r_read_data);
+
+        // update the cache directory
+        DirectoryEntry entry;
+        entry.valid   = true;
+        entry.is_cnt  = is_cnt;
+        entry.dirty   = r_read_dirty.read();
+        entry.tag   = r_read_tag.read();
+        entry.lock    = r_read_lock.read();
+        entry.ptr     = r_read_ptr.read();
+        if (cached_read)  // Cached read => we must update the copies
+        {
+          if (!is_cnt) // Not counter mode
+          {
+            entry.owner.srcid    = m_cmd_read_srcid_fifo.read();
+#if L1_MULTI_CACHE
+            entry.owner.cache_id = m_cmd_read_pktid_fifo.read();
+#endif
+            entry.owner.inst     = inst_read;
+            entry.count          = r_read_count.read() + 1;
+          }
+          else  // Counter mode
+          {
+            entry.owner.srcid    = 0;
+#if L1_MULTI_CACHE
+            entry.owner.cache_id = 0;
+#endif
+            entry.owner.inst     = false;
+            entry.count          = r_read_count.read() + 1;
+          }
+        }
+        else  // Uncached read
+        {
+          entry.owner.srcid     = r_read_copy.read();
+#if L1_MULTI_CACHE
+          entry.owner.cache_id  = r_read_copy_cache.read();
+#endif
+          entry.owner.inst      = r_read_copy_inst.read();
+          entry.count           = r_read_count.read();
+        }
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name() << ".READ_DIR_HIT> Update directory entry:"
+            << " set = " << std::dec << set
+            << " / way = " << way
+            << " / owner_id = " << entry.owner.srcid
+            << " / owner_ins = " << entry.owner.inst
+            << " / count = " << entry.count
+            << " / is_cnt = " << entry.is_cnt << std::endl;
+        }
+#endif
+
+        m_cache_directory.write(set, way, entry);
+        r_read_fsm    = READ_RSP;
+      }
+      break;
+    }
+
+    ////////////////////
+    case READ_HEAP_REQ:
+    // Get the lock to the HEAP directory
+    {
+      if( r_alloc_heap_fsm.read() == ALLOC_HEAP_READ )
+      {
+        r_read_fsm = READ_HEAP_LOCK;
+      }
+
+#if DEBUG_MEMC_READ
+      if( m_debug_read_fsm )
+      {
+        std::cout 
+          << "  <MEMC " << name() << ".READ_HEAP_REQ> Requesting HEAP lock "
+          << std::endl;
+      }
+#endif
+      break;
+    }
+
+    ////////////////////
+    case READ_HEAP_LOCK:
+    // read data in cache, update the directory
+    // and prepare the HEAP update
+    {
+      if( r_alloc_heap_fsm.read() == ALLOC_HEAP_READ )
+      {
+        // enter counter mode when we reach the limit of copies or the heap is full
+        bool go_cnt = (r_read_count.read() >= r_copies_limit.read()) || m_heap.is_full();
+
+        // read data in the cache
+        size_t set = m_y[(vci_addr_t)(m_cmd_read_addr_fifo.read())];
+        size_t way = r_read_way.read();
+
+        m_cache_data.read_line(way, set, r_read_data);
+
+        // update the cache directory
+        DirectoryEntry entry;
+        entry.valid  = true;
+        entry.is_cnt = go_cnt;
+        entry.dirty  = r_read_dirty.read();
+        entry.tag    = r_read_tag.read();
+        entry.lock   = r_read_lock.read();
+        entry.count  = r_read_count.read() + 1;
+
+        if (not go_cnt)        // Not entering counter mode
+        {
+          entry.owner.srcid    = r_read_copy.read();
+#if L1_MULTI_CACHE
+          entry.owner.cache_id = r_read_copy_cache.read();
+#endif
+          entry.owner.inst     = r_read_copy_inst.read();
+          entry.ptr            = m_heap.next_free_ptr();   // set pointer on the heap
+        }
+        else                // Entering Counter mode
+        {
+          entry.owner.srcid    = 0;
+#if L1_MULTI_CACHE
+          entry.owner.cache_id = 0;
+#endif
+          entry.owner.inst     = false;
+          entry.ptr            = 0;
+        }
+
+        m_cache_directory.write(set, way, entry);
+
+        // prepare the heap update (add an entry, or clear the linked list)
+        if (not go_cnt)     // not switching to counter mode
+        {
+          // We test if the next free entry in the heap is the last
+          HeapEntry heap_entry = m_heap.next_free_entry();
+          r_read_next_ptr      = heap_entry.next;
+          r_read_last_free     = ( heap_entry.next == m_heap.next_free_ptr() );
+
+          r_read_fsm           = READ_HEAP_WRITE; // add an entry in the HEAP
+        }
+        else            // switching to counter mode
+        {
+          if ( r_read_count.read()>1 )            // heap must be cleared
+          {
+            HeapEntry next_entry = m_heap.read(r_read_ptr.read());
+            r_read_next_ptr      = m_heap.next_free_ptr();
+            m_heap.write_free_ptr(r_read_ptr.read());
+
+            if( next_entry.next == r_read_ptr.read() )  // last entry
+            {
+              r_read_fsm = READ_HEAP_LAST;    // erase the entry
+            }
+            else                                        // not the last entry
+            {
+              r_read_ptr = next_entry.next;
+              r_read_fsm = READ_HEAP_ERASE;   // erase the list
+            }
+          }
+          else  // the heap is not used / nothing to do
+          {
+            r_read_fsm = READ_RSP;
+          }
+        }
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".READ_HEAP_LOCK> Update directory:"
+            << " tag = " << std::hex << entry.tag
+            << " set = " << std::dec << set
+            << " way = " << way
+            << " count = " << entry.count
+            << " is_cnt = " << entry.is_cnt << std::endl;
+        }
+#endif
+      }
+      else
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name()
+          << " READ_HEAP_LOCK state" << std::endl
+          << "Bad HEAP allocation"   << std::endl;
+
+        exit(0);
+      }
+
+      break;
+    }
+
+    /////////////////////
+    case READ_HEAP_WRITE:       // add a entry in the heap
+    {
+      if ( r_alloc_heap_fsm.read() == ALLOC_HEAP_READ )
+      {
+        HeapEntry heap_entry;
+        heap_entry.owner.srcid    = m_cmd_read_srcid_fifo.read();
+#if L1_MULTI_CACHE
+        heap_entry.owner.cache_id = m_cmd_read_pktid_fifo.read();
+#endif
+        heap_entry.owner.inst     = (m_cmd_read_pktid_fifo.read() & 0x2);
+
+        if(r_read_count.read() == 1) // creation of a new linked list
+        {
+          heap_entry.next         = m_heap.next_free_ptr();
+        }
+        else                         // head insertion in existing list
+        {
+          heap_entry.next         = r_read_ptr.read();
+        }
+        m_heap.write_free_entry(heap_entry);
+        m_heap.write_free_ptr(r_read_next_ptr.read());
+        if(r_read_last_free.read())  m_heap.set_full();
+
+        r_read_fsm = READ_RSP;
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name() << ".READ_HEAP_WRITE> Add an entry in the heap:"
+            << " owner_id = " << heap_entry.owner.srcid
+            << " owner_ins = " << heap_entry.owner.inst << std::endl;
+        }
+#endif
+      }
+      else
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name()
+          << " READ_HEAP_WRITE state" << std::endl
+          << "Bad HEAP allocation" << std::endl;
+
+        exit(0);
+      }
+      break;
+    }
+
+    /////////////////////
+    case READ_HEAP_ERASE:
+    {
+      if ( r_alloc_heap_fsm.read() == ALLOC_HEAP_READ )
+      {
+        HeapEntry next_entry = m_heap.read(r_read_ptr.read());
+        if( next_entry.next == r_read_ptr.read() )
+        {
+          r_read_fsm = READ_HEAP_LAST;
+        }
+        else
+        {
+          r_read_ptr = next_entry.next;
+          r_read_fsm = READ_HEAP_ERASE;
+        }
+      }
+      else
+      {
+        std::cout
+          << "VCI_MEM_CACHE ERROR " << name()
+          << " READ_HEAP_ERASE state" << std::endl
+          << "Bad HEAP allocation" << std::endl;
+
+        exit(0);
+      }
+      break;
+    }
+
+    ////////////////////
+    case READ_HEAP_LAST:
+    {
+      if ( r_alloc_heap_fsm.read() == ALLOC_HEAP_READ )
+      {
+        HeapEntry last_entry;
+        last_entry.owner.srcid    = 0;
+#if L1_MULTI_CACHE
+        last_entry.owner.cache_id = 0;
+#endif
+        last_entry.owner.inst     = false;
+
+        if(m_heap.is_full())
+        {
+          last_entry.next       = r_read_ptr.read();
+          m_heap.unset_full();
+        }
+        else
+        {
+          last_entry.next       = r_read_next_ptr.read();
+        }
+        m_heap.write(r_read_ptr.read(),last_entry);
+        r_read_fsm = READ_RSP;
+      }
+      else
+      {
+        std::cout << "VCI_MEM_CACHE ERROR " << name()
+          << " READ_HEAP_LAST state" << std::endl;
+        std::cout << "Bad HEAP allocation" << std::endl;
+        exit(0);
+      }
+      break;
+    }
+
+    //////////////
+    case READ_RSP:    //  request the TGT_RSP FSM to return data
+    {
+      if( !r_read_to_tgt_rsp_req )
+      {
+        for ( size_t i=0 ; i<m_words ; i++ )  r_read_to_tgt_rsp_data[i] = r_read_data[i];
+        r_read_to_tgt_rsp_word   = m_x[(vci_addr_t)m_cmd_read_addr_fifo.read()];
+        r_read_to_tgt_rsp_length = m_cmd_read_length_fifo.read();
+        r_read_to_tgt_rsp_srcid  = m_cmd_read_srcid_fifo.read();
+        r_read_to_tgt_rsp_trdid  = m_cmd_read_trdid_fifo.read();
+        r_read_to_tgt_rsp_pktid  = m_cmd_read_pktid_fifo.read();
+        r_read_to_tgt_rsp_ll_key = r_read_ll_key.read();
+        cmd_read_fifo_get        = true;
+        r_read_to_tgt_rsp_req    = true;
+        r_read_fsm               = READ_IDLE;
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".READ_RSP> Request the TGT_RSP FSM to return data:"
+            << " rsrcid = " << std::dec << m_cmd_read_srcid_fifo.read()
+            << " / address = " << std::hex << m_cmd_read_addr_fifo.read()
+            << " / nwords = " << std::dec << m_cmd_read_length_fifo.read() << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    ///////////////////
+    case READ_TRT_LOCK: // read miss : check the Transaction Table
+    {
+      if ( r_alloc_trt_fsm.read() == ALLOC_TRT_READ )
+      {
+        size_t      index     = 0;
+        vci_addr_t  addr      = (vci_addr_t)m_cmd_read_addr_fifo.read();
+        bool        hit_read  = m_transaction_tab.hit_read(m_nline[addr], index);
+        bool        hit_write = m_transaction_tab.hit_write(m_nline[addr]);
+        bool        wok       = !m_transaction_tab.full(index);
+
+        if( hit_read || !wok || hit_write )  // missing line already requested or no space
+        {
+          if(!wok)      m_cpt_trt_full++;
+          if(hit_read || hit_write)   m_cpt_trt_rb++;
+          r_read_fsm = READ_IDLE;
+        }
+        else                  // missing line is requested to the XRAM
+        {
+          m_cpt_read_miss++;
+          r_read_trt_index = index;
+          r_read_fsm       = READ_TRT_SET;
+        }
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".READ_TRT_LOCK> Check TRT:"
+            << " hit_read = " << hit_read
+            << " / hit_write = " << hit_write
+            << " / full = " << !wok << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    //////////////////
+    case READ_TRT_SET:      // register get transaction in TRT
+    {
+      if ( r_alloc_trt_fsm.read() == ALLOC_TRT_READ )
+      {
+        m_transaction_tab.set(r_read_trt_index.read(),
+            true,
+            m_nline[(vci_addr_t)(m_cmd_read_addr_fifo.read())],
+            m_cmd_read_srcid_fifo.read(),
+            m_cmd_read_trdid_fifo.read(),
+            m_cmd_read_pktid_fifo.read(),
+            true,
+            m_cmd_read_length_fifo.read(),
+            m_x[(vci_addr_t)(m_cmd_read_addr_fifo.read())],
+            std::vector<be_t>(m_words,0),
+            std::vector<data_t>(m_words,0),
+            r_read_ll_key.read());
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".READ_TRT_SET> Write in Transaction Table: " << std::hex
+            << " address = " << std::hex << m_cmd_read_addr_fifo.read()
+            << " / srcid = " << std::dec << m_cmd_read_srcid_fifo.read()
+            << std::endl;
+        }
+#endif
+        r_read_fsm = READ_TRT_REQ;
+      }
+      break;
+    }
+
+    //////////////////
+    case READ_TRT_REQ:
+    {
+      // consume the read request in the FIFO,
+      // and send it to the ixr_cmd_fsm
+
+      if( not r_read_to_ixr_cmd_req )
+      {
+        cmd_read_fifo_get       = true;
+        r_read_to_ixr_cmd_req   = true;
+        r_read_to_ixr_cmd_nline = m_nline[(vci_addr_t)(m_cmd_read_addr_fifo.read())];
+        r_read_to_ixr_cmd_trdid = r_read_trt_index.read();
+        r_read_fsm              = READ_IDLE;
+
+#if DEBUG_MEMC_READ
+        if( m_debug_read_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name() << ".READ_TRT_REQ> Request GET transaction for address "
+            << std::hex << m_cmd_read_addr_fifo.read() << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+  } // end switch read_fsm
+
+  ///////////////////////////////////////////////////////////////////////////////////
+  //    WRITE FSM
+  ///////////////////////////////////////////////////////////////////////////////////
+  // The WRITE FSM handles the write bursts and sc requests sent by the processors.
+  // All addresses in a burst must be in the same cache line.
+  // A complete write burst is consumed in the FIFO & copied to a local buffer.
+  // Then the FSM takes the lock protecting the cache directory, to check
+  // if the line is in the cache.
+  //
+  // - In case of HIT, the cache is updated.
+  //   If there is no other copy, an acknowledge response is immediately
+  //   returned to the writing processor.
+  //   If the data is cached by other processors, a coherence transaction must
+  //   be launched (sc requests always require a coherence transaction):
+  //   It is a multicast update if the line is not in counter mode, and the processor
+  //   takes the lock protecting the Update Table (UPT) to register this transaction.
+  //   It is a broadcast invalidate if the line is in counter mode.
+  //   If the UPT is full, it releases the lock(s) and retry. Then, it sends
+  //   a multi-update request to all owners of the line (but the writer),
+  //   through the INIT_CMD FSM. In case of coherence transaction, the WRITE FSM
+  //   does not respond to the writing processor, as this response will be sent by
+  //   the INIT_RSP FSM when all update responses have been received.
+  //
+  // - In case of MISS, the WRITE FSM takes the lock protecting the transaction
+  //   table (TRT). If a read transaction to the XRAM for this line already exists,
+  //   it writes in the TRT (write buffer). Otherwise, if a TRT entry is free,
+  //   the WRITE FSM register a new transaction in TRT, and sends a read line request
+  //   to the XRAM. If the TRT is full, it releases the lock, and waits.
+  //   Finally, the WRITE FSM returns an aknowledge response to the writing processor.
+  /////////////////////////////////////////////////////////////////////////////////////
+
+  switch ( r_write_fsm.read() )
+  {
+    ////////////////
+    case WRITE_IDLE:  // copy first word of a write burst in local buffer
+    {
+      if ( m_cmd_write_addr_fifo.rok() )
+      {
+        if((m_cmd_write_pktid_fifo.read() & 0x7) == TYPE_SC)
+          m_cpt_sc++;
+        else
+        {
+          m_cpt_write++;
+          m_cpt_write_cells++;
+        }
+
+        // consume a word in the FIFO & write it in the local buffer
+        cmd_write_fifo_get  = true;
+        r_write_pending_sc  = false;
+        size_t index        = m_x[(vci_addr_t)(m_cmd_write_addr_fifo.read())];
+
+        r_write_address     = (addr_t)(m_cmd_write_addr_fifo.read());
+        r_write_word_index  = index;
+        r_write_word_count  = 1;
+        r_write_data[index] = m_cmd_write_data_fifo.read();
+        r_write_srcid       = m_cmd_write_srcid_fifo.read();
+        r_write_trdid       = m_cmd_write_trdid_fifo.read();
+        r_write_pktid       = m_cmd_write_pktid_fifo.read();
+
+        // initialize the be field for all words
+        for ( size_t word=0 ; word<m_words ; word++ )
+        {
+          if ( word == index ) r_write_be[word] = m_cmd_write_be_fifo.read();
+          else                 r_write_be[word] = 0x0;
+        }
+
+        if( m_cmd_write_eop_fifo.read() || ((m_cmd_write_pktid_fifo.read() & 0x7)  == TYPE_SC) )
+        {
+          r_write_fsm = WRITE_DIR_REQ;
+        }
+        else
+        {
+          r_write_fsm = WRITE_NEXT;
+        }
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_IDLE> Write request "
+            << " srcid = " << std::dec << m_cmd_write_srcid_fifo.read()
+            << " / address = " << std::hex << m_cmd_write_addr_fifo.read()
+            << " / data = " << m_cmd_write_data_fifo.read() << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    ////////////////
+    case WRITE_NEXT:  // copy next word of a write burst in local buffer
+    {
+      if ( m_cmd_write_addr_fifo.rok() )
+      {
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_NEXT> Write another word in local buffer"
+                    << std::endl;
+        }
+#endif
+        m_cpt_write_cells++;
+
+        // check that the next word is in the same cache line
+        if (( m_nline[(vci_addr_t)(r_write_address.read())]       !=
+              m_nline[(vci_addr_t)(m_cmd_write_addr_fifo.read())] ))
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name() << " WRITE_NEXT state" << std::endl
+                    << "all words in a write burst must be in same cache line" << std::endl;
+
+          exit(0);
+        }
+
+        // consume a word in the FIFO & write it in the local buffer
+        cmd_write_fifo_get  = true;
+        r_write_pending_sc  = false;
+        size_t index        = r_write_word_index.read() + r_write_word_count.read();
+
+        r_write_be[index]   = m_cmd_write_be_fifo.read();
+        r_write_data[index] = m_cmd_write_data_fifo.read();
+        r_write_word_count  = r_write_word_count.read() + 1;
+
+        if ( m_cmd_write_eop_fifo.read() )
+        {
+          r_write_fsm = WRITE_DIR_REQ;
+        }
+      }
+      break;
+    }
+
+    ////////////////////
+    case WRITE_DIR_REQ:
+    // Get the lock to the directory
+    {
+      if ( r_alloc_dir_fsm.read() == ALLOC_DIR_WRITE )
+      {
+        if(((r_write_pktid.read() & 0x7) == TYPE_SC) && not r_write_pending_sc.read()) // check for an SC command (and check that its second flit is not already consumed)
+        {
+          if ( m_cmd_write_addr_fifo.rok() )
+          {
+            size_t index    = m_x[(vci_addr_t)(r_write_address.read())];
+            bool sc_success = m_llsc_table.sc(r_write_address.read(),r_write_data[index].read());
+            r_write_sc_fail = !sc_success;
+
+            assert(m_cmd_write_eop_fifo.read() && "Error in VCI_MEM_CACHE : invalid packet format for SC command");
+            // consume a word in the FIFO & write it in the local buffer
+            cmd_write_fifo_get  = true;
+            r_write_pending_sc  = true;
+            index               = m_x[(vci_addr_t)(m_cmd_write_addr_fifo.read())];
+
+            r_write_address     = (addr_t)(m_cmd_write_addr_fifo.read());
+            r_write_word_index  = index;
+            r_write_word_count  = 1;
+            r_write_data[index] = m_cmd_write_data_fifo.read();
+            if (!sc_success)
+            {
+              r_write_fsm = WRITE_RSP;
+              break;
+            }
+          }
+          else break;
+        }
+        //else it is a TYPE_WRITE, need a simple sw access to the
+        // llsc_global_table
+        else
+        {
+          m_llsc_table.sw(r_write_address.read());
+        }
+        r_write_fsm = WRITE_DIR_LOCK;
+      }
+
+#if DEBUG_MEMC_WRITE
+      if( m_debug_write_fsm )
+      {
+        std::cout 
+          << "  <MEMC " << name() << ".WRITE_DIR_REQ> Requesting DIR lock "
+          << std::endl;
+      }
+#endif
+
+      break;
+    }
+
+    ////////////////////
+    case WRITE_DIR_LOCK:
+    // access directory to check hit/miss
+    {
+      if ( r_alloc_dir_fsm.read() == ALLOC_DIR_WRITE )
+      {
+        size_t  way = 0;
+        DirectoryEntry entry(m_cache_directory.read(r_write_address.read(), way));
+
+        if ( entry.valid ) // hit
+        {
+          // copy directory entry in local buffer in case of hit
+          r_write_is_cnt     = entry.is_cnt;
+          r_write_lock       = entry.lock;
+          r_write_tag        = entry.tag;
+          r_write_copy       = entry.owner.srcid;
+#if L1_MULTI_CACHE
+          r_write_copy_cache = entry.owner.cache_id;
+#endif
+          r_write_copy_inst  = entry.owner.inst;
+          r_write_count      = entry.count;
+          r_write_ptr        = entry.ptr;
+          r_write_way        = way;
+
+          if( entry.is_cnt && entry.count )
+          {
+            r_write_fsm = WRITE_DIR_READ;
+          }
+          else
+          {
+            r_write_fsm = WRITE_DIR_HIT;
+          }
+        }
+        else  // miss
+        {
+          r_write_fsm = WRITE_MISS_TRT_LOCK;
+        }
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_DIR_LOCK> Check the directory: "
+            << " address = " << std::hex << r_write_address.read()
+            << " hit = " << std::dec << entry.valid
+            << " count = " << entry.count
+            << " is_cnt = " << entry.is_cnt << std::endl;
+          if((r_write_pktid.read() & 0x7) == TYPE_SC)
+            std::cout << "  <MEMC " << name() << ".WRITE_DIR_LOCK> global_llsc_table SC access" << std::endl;
+          else
+            std::cout << "  <MEMC " << name() << ".WRITE_DIR_LOCK> global_llsc_table SW access" << std::endl;
+        }
+#endif
+      }
+      else
+      {
+        std::cout << "VCI_MEM_CACHE ERROR " << name()
+          << " WRITE_DIR_LOCK state"        << std::endl
+          << "bad DIR allocation"           << std::endl;
+
+        exit(0);
+      }
+
+      break;
+    }
+
+    ////////////////////
+    case WRITE_DIR_READ:  // read the cache and complete the buffer when be!=0xF
+    {
+      // update local buffer
+      size_t set  = m_y[(vci_addr_t)(r_write_address.read())];
+      size_t way  = r_write_way.read();
+      for(size_t word=0 ; word<m_words ; word++)
+      {
+        data_t mask = 0;
+        if  (r_write_be[word].read() & 0x1) mask = mask | 0x000000FF;
+        if  (r_write_be[word].read() & 0x2) mask = mask | 0x0000FF00;
+        if  (r_write_be[word].read() & 0x4) mask = mask | 0x00FF0000;
+        if  (r_write_be[word].read() & 0x8) mask = mask | 0xFF000000;
+
+        // complete only if mask is not null (for energy consumption)
+        r_write_data[word]  = (r_write_data[word].read() & mask) |
+          (m_cache_data.read(way, set, word) & ~mask);
+
+      } // end for
+
+      // test if a coherence broadcast is required
+      r_write_fsm = WRITE_BC_TRT_LOCK;
+
+#if DEBUG_MEMC_WRITE
+      if( m_debug_write_fsm )
+      {
+        std::cout << "  <MEMC " << name() << ".WRITE_DIR_READ> Read the cache to complete local buffer" << std::endl;
+      }
+#endif
+      break;
+    }
+
+    ///////////////////
+    case WRITE_DIR_HIT:
+    {
+      // update the cache directory
+      // update directory with Dirty bit
+      DirectoryEntry entry;
+      entry.valid          = true;
+      entry.dirty          = true;
+      entry.tag          = r_write_tag.read();
+      entry.is_cnt         = r_write_is_cnt.read();
+      entry.lock           = r_write_lock.read();
+      entry.owner.srcid    = r_write_copy.read();
+#if L1_MULTI_CACHE
+      entry.owner.cache_id = r_write_copy_cache.read();
+#endif
+      entry.owner.inst     = r_write_copy_inst.read();
+      entry.count          = r_write_count.read();
+      entry.ptr            = r_write_ptr.read();
+
+      size_t set           = m_y[(vci_addr_t)(r_write_address.read())];
+      size_t way           = r_write_way.read();
+
+      // update directory
+      m_cache_directory.write(set, way, entry);
+
+      // owner is true when the  the first registered copy is the writer itself
+      bool owner = (((r_write_copy.read() == r_write_srcid.read())
+#if L1_MULTI_CACHE
+            and (r_write_copy_cache.read()==r_write_pktid.read())
+#endif
+            ) and not r_write_copy_inst.read());
+
+      // no_update is true when there is no need for coherence transaction
+      // (tests for sc requests)
+      bool no_update = ((r_write_count.read()==0) || ( owner && (r_write_count.read()==1) && (r_write_pktid.read() != TYPE_SC)));
+
+      // write data in the cache if no coherence transaction
+      if( no_update )
+      {
+        for(size_t word=0 ; word<m_words ; word++)
+        {
+          m_cache_data.write(way, set, word, r_write_data[word].read(), r_write_be[word].read());
+
+          if ( m_monitor_ok )
+          {
+            vci_addr_t address = (r_write_address.read() & ~(vci_addr_t)0x3F) | word<<2;
+            char buf[80];
+            snprintf(buf, 80, "WRITE_DIR_HIT srcid %d", r_write_srcid.read());
+            check_monitor( buf, address, r_write_data[word].read() );
+          }
+        }
+      }
+
+      if ( owner and not no_update and (r_write_pktid.read() != TYPE_SC))
+      {
+        r_write_count = r_write_count.read() - 1;
+      }
+
+      if ( no_update )
+      // Write transaction completed
+      {
+        r_write_fsm = WRITE_RSP;
+      }
+      else
+      // coherence update required
+      {
+        if( !r_write_to_init_cmd_multi_req.read()   &&
+            !r_write_to_init_cmd_brdcast_req.read() )
+        {
+          r_write_fsm = WRITE_UPT_LOCK;
+        }
+        else
+        {
+          r_write_fsm = WRITE_WAIT;
+        }
+      }
+
+#if DEBUG_MEMC_WRITE
+      if( m_debug_write_fsm )
+      {
+        if ( no_update )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_DIR_HIT> Write into cache / No coherence transaction"
+            << std::endl;
+        }
+        else
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_DIR_HIT> Coherence update required:"
+            << " is_cnt = " << r_write_is_cnt.read()
+            << " nb_copies = " << std::dec << r_write_count.read() << std::endl;
+          if (owner)
+            std::cout << "       ... but the first copy is the writer" << std::endl;
+        }
+      }
+#endif
+      break;
+    }
+
+      ////////////////////
+    case WRITE_UPT_LOCK:  // Try to register the update request in UPT
+    {
+      if ( r_alloc_upt_fsm.read() == ALLOC_UPT_WRITE )
+      {
+        bool        wok        = false;
+        size_t      index      = 0;
+        size_t      srcid      = r_write_srcid.read();
+        size_t      trdid      = r_write_trdid.read();
+        size_t      pktid      = r_write_pktid.read();
+        addr_t      nline      = m_nline[(vci_addr_t)(r_write_address.read())];
+        size_t      nb_copies  = r_write_count.read();
+        size_t      set        = m_y[(vci_addr_t)(r_write_address.read())];
+        size_t      way        = r_write_way.read();
+
+        wok = m_update_tab.set(true,  // it's an update transaction
+            false,    // it's not a broadcast
+            true,     // it needs a response
+            srcid,
+            trdid,
+            pktid,
+            nline,
+            nb_copies,
+            index);
+        if ( wok )    // write data in cache
+        {
+          for(size_t word=0 ; word<m_words ; word++)
+          {
+            m_cache_data.write(way, set, word, r_write_data[word].read(), r_write_be[word].read());
+
+            if ( m_monitor_ok )
+            {
+              vci_addr_t address = (r_write_address.read() & ~(vci_addr_t)0x3F) | word<<2;
+              char buf[80];
+              snprintf(buf, 80, "WRITE_UPT_LOCK srcid %d", srcid);
+              check_monitor(buf, address, r_write_data[word].read() );
+            }
+          }
+        }
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          if ( wok )
+          {
+            std::cout << "  <MEMC " << name() << ".WRITE_UPT_LOCK> Register the multicast update in UPT / "
+              << " nb_copies = " << r_write_count.read() << std::endl;
+          }
+        }
+#endif
+        r_write_upt_index = index;
+        //  releases the lock protecting UPT and the DIR if no entry...
+        if ( wok ) r_write_fsm = WRITE_UPT_HEAP_LOCK;
+        else       r_write_fsm = WRITE_WAIT;
+      }
+      break;
+    }
+
+      /////////////////////////
+    case WRITE_UPT_HEAP_LOCK:   // get access to heap
+    {
+      if( r_alloc_heap_fsm.read() == ALLOC_HEAP_WRITE )
+      {
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_UPT_HEAP_LOCK> Get acces to the HEAP" << std::endl;
+        }
+#endif
+        r_write_fsm = WRITE_UPT_REQ;
+      }
+      break;
+    }
+
+    //////////////////
+    case WRITE_UPT_REQ:
+    {
+      // prepare the coherence transaction for the INIT_CMD FSM
+      // and write the first copy in the FIFO
+      // send the request if only one copy
+
+      if( !r_write_to_init_cmd_multi_req.read() &&
+          !r_write_to_init_cmd_brdcast_req.read()  )  // no pending coherence request
+      {
+        r_write_to_init_cmd_brdcast_req  = false;
+        r_write_to_init_cmd_trdid        = r_write_upt_index.read();
+        r_write_to_init_cmd_nline        = m_nline[(vci_addr_t)(r_write_address.read())];
+        r_write_to_init_cmd_index        = r_write_word_index.read();
+        r_write_to_init_cmd_count        = r_write_word_count.read();
+
+        for(size_t i=0; i<m_words ; i++) r_write_to_init_cmd_be[i]=r_write_be[i].read();
+
+        size_t min = r_write_word_index.read();
+        size_t max = r_write_word_index.read() + r_write_word_count.read();
+        for (size_t i=min ; i<max ; i++) r_write_to_init_cmd_data[i] = r_write_data[i];
+
+        if( (r_write_copy.read() != r_write_srcid.read()) or (r_write_pktid.read() == TYPE_SC) or
+#if L1_MULTI_CACHE
+            (r_write_copy_cache.read() != r_write_pktid.read()) or
+#endif
+            r_write_copy_inst.read() )
+        {
+          // put the first srcid in the fifo
+          write_to_init_cmd_fifo_put     = true;
+          write_to_init_cmd_fifo_inst    = r_write_copy_inst.read();
+          write_to_init_cmd_fifo_srcid   = r_write_copy.read();
+#if L1_MULTI_CACHE
+          write_to_init_cmd_fifo_cache_id= r_write_copy_cache.read();
+#endif
+          if(r_write_count.read() == 1 || ((r_write_count.read() == 0) && (r_write_pktid.read() == TYPE_SC)) )
+          {
+            r_write_fsm = WRITE_IDLE;
+            r_write_to_init_cmd_multi_req = true;
+          }
+          else
+          {
+            r_write_fsm = WRITE_UPT_NEXT;
+            r_write_to_dec = false;
+
+          }
+        }
+        else
+        {
+          r_write_fsm = WRITE_UPT_NEXT;
+          r_write_to_dec = false;
+        }
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_UPT_REQ> Post first request to INIT_CMD FSM"
+            << " / srcid = " << std::dec << r_write_copy.read()
+            << " / inst = "  << std::dec << r_write_copy_inst.read() << std::endl;
+          if ( r_write_count.read() == 1)
+            std::cout << "         ... and this is the last" << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    ///////////////////
+    case WRITE_UPT_NEXT:
+    {
+      // continue the multi-update request to INIT_CMD fsm
+      // when there is copies in the heap.
+      // if one copy in the heap is the writer itself
+      // the corresponding SRCID should not be written in the fifo,
+      // but the UPT counter must be decremented.
+      // As this decrement is done in the WRITE_UPT_DEC state,
+      // after the last copy has been found, the decrement request
+      // must be  registered in the r_write_to_dec flip-flop.
+
+      HeapEntry entry = m_heap.read(r_write_ptr.read());
+
+      bool dec_upt_counter;
+
+      if(((entry.owner.srcid != r_write_srcid.read()) || (r_write_pktid.read() == TYPE_SC)) or
+#if L1_MULTI_CACHE
+          (entry.owner.cache_id != r_write_pktid.read()) or
+#endif
+          entry.owner.inst)             // put the next srcid in the fifo
+      {
+        dec_upt_counter                 = false;
+        write_to_init_cmd_fifo_put      = true;
+        write_to_init_cmd_fifo_inst     = entry.owner.inst;
+        write_to_init_cmd_fifo_srcid    = entry.owner.srcid;
+#if L1_MULTI_CACHE
+        write_to_init_cmd_fifo_cache_id = entry.owner.cache_id;
+#endif
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_UPT_NEXT> Post another request to INIT_CMD FSM"
+            << " / heap_index = " << std::dec << r_write_ptr.read()
+            << " / srcid = " << std::dec << r_write_copy.read()
+            << " / inst = "  << std::dec << r_write_copy_inst.read() << std::endl;
+          if( entry.next == r_write_ptr.read() )
+            std::cout << "        ... and this is the last" << std::endl;
+        }
+#endif
+      }
+      else                                // the UPT counter must be decremented
+      {
+        dec_upt_counter = true;
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_UPT_NEXT> Skip one entry in heap matching the writer"
+            << " / heap_index = " << std::dec << r_write_ptr.read()
+            << " / srcid = " << std::dec << r_write_copy.read()
+            << " / inst = "  << std::dec << r_write_copy_inst.read() << std::endl;
+          if( entry.next == r_write_ptr.read() )
+            std::cout << "        ... and this is the last" << std::endl;
+        }
+#endif
+      }
+
+      // register the possible UPT decrement request
+      r_write_to_dec = dec_upt_counter or r_write_to_dec.read();
+
+      if( not m_write_to_init_cmd_inst_fifo.wok() )
+      {
+        std::cout << "VCI_MEM_CACHE ERROR " << name() << " WRITE_UPT_NEXT state" << std::endl
+          << "The write_to_init_cmd_fifo should not be full" << std::endl
+          << "as the depth should be larger than the max number of copies" << std::endl;
+        exit(0);
+      }
+
+      r_write_ptr = entry.next;
+
+      if( entry.next == r_write_ptr.read() )  // last copy
+      {
+        r_write_to_init_cmd_multi_req = true;
+        if( r_write_to_dec.read() or dec_upt_counter)   r_write_fsm = WRITE_UPT_DEC;
+        else                                          r_write_fsm = WRITE_IDLE;
+      }
+      break;
+    }
+
+    //////////////////
+    case WRITE_UPT_DEC:
+    {
+      // If the initial writer has a copy, it should not
+      // receive an update request, but the counter in the
+      // update table must be decremented by the INIT_RSP FSM.
+
+      if ( !r_write_to_init_rsp_req.read() )
+      {
+        r_write_to_init_rsp_req = true;
+        r_write_to_init_rsp_upt_index = r_write_upt_index.read();
+        r_write_fsm = WRITE_IDLE;
+      }
+      break;
+    }
+    
+    ///////////////
+    case WRITE_RSP:
+    {
+      // Post a request to TGT_RSP FSM to acknowledge the write
+      // In order to increase the Write requests throughput,
+      // we don't wait to return in the IDLE state to consume
+      // a new request in the write FIFO
+
+      if ( !r_write_to_tgt_rsp_req.read() )
+      {
+        // post the request to TGT_RSP_FSM
+        r_write_to_tgt_rsp_req     = true;
+        r_write_to_tgt_rsp_srcid   = r_write_srcid.read();
+        r_write_to_tgt_rsp_trdid   = r_write_trdid.read();
+        r_write_to_tgt_rsp_pktid   = r_write_pktid.read();
+        r_write_to_tgt_rsp_sc_fail = r_write_sc_fail.read();
+
+        // try to get a new write request from the FIFO
+        if ( m_cmd_write_addr_fifo.rok() )
+        {
+          if((m_cmd_write_pktid_fifo.read() & 0x7) == TYPE_SC)
+            m_cpt_sc++;
+          else
+          {
+            m_cpt_write++;
+            m_cpt_write_cells++;
+          }
+
+          // consume a word in the FIFO & write it in the local buffer
+          cmd_write_fifo_get  = true;
+          r_write_pending_sc  = false;
+          size_t index        = m_x[(vci_addr_t)(m_cmd_write_addr_fifo.read())];
+
+          r_write_address     = (addr_t)(m_cmd_write_addr_fifo.read());
+          r_write_word_index  = index;
+          r_write_word_count  = 1;
+          r_write_data[index] = m_cmd_write_data_fifo.read();
+          r_write_srcid       = m_cmd_write_srcid_fifo.read();
+          r_write_trdid       = m_cmd_write_trdid_fifo.read();
+          r_write_pktid       = m_cmd_write_pktid_fifo.read();
+
+          // initialize the be field for all words
+          for ( size_t word=0 ; word<m_words ; word++ )
+          {
+            if ( word == index ) r_write_be[word] = m_cmd_write_be_fifo.read();
+            else                 r_write_be[word] = 0x0;
+          }
+
+          if( m_cmd_write_eop_fifo.read() || ((m_cmd_write_pktid_fifo.read() & 0x7)  == TYPE_SC) )
+          {
+            r_write_fsm = WRITE_DIR_REQ;
+          }
+          else
+          {
+            r_write_fsm = WRITE_NEXT;
+          }
+        }
+        else
+        {
+          r_write_fsm = WRITE_IDLE;
+        }
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_RSP> Post a request to TGT_RSP FSM: rsrcid = "
+            << std::dec << r_write_srcid.read() << std::endl;
+          if ( m_cmd_write_addr_fifo.rok() )
+          {
+            std::cout << "                    New Write request: "
+              << " srcid = " << std::dec << m_cmd_write_srcid_fifo.read()
+              << " / address = " << std::hex << m_cmd_write_addr_fifo.read()
+              << " / data = " << m_cmd_write_data_fifo.read() << std::endl;
+          }
+        }
+#endif
+      }
+      break;
+    }
+
+    /////////////////////////
+    case WRITE_MISS_TRT_LOCK: // Miss : check Transaction Table
+    {
+      if ( r_alloc_trt_fsm.read() == ALLOC_TRT_WRITE )
+      {
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_MISS_TRT_LOCK> Check the TRT" << std::endl;
+        }
+#endif
+        size_t  hit_index = 0;
+        size_t  wok_index = 0;
+        vci_addr_t  addr  = (vci_addr_t)r_write_address.read();
+        bool    hit_read  = m_transaction_tab.hit_read(m_nline[addr], hit_index);
+        bool    hit_write = m_transaction_tab.hit_write(m_nline[addr]);
+        bool    wok       = !m_transaction_tab.full(wok_index);
+
+        if ( hit_read )   // register the modified data in TRT
+        {
+          r_write_trt_index = hit_index;
+          r_write_fsm       = WRITE_MISS_TRT_DATA;
+          m_cpt_write_miss++;
+        }
+        else if ( wok && !hit_write )   // set a new entry in TRT
+        {
+          r_write_trt_index = wok_index;
+          r_write_fsm       = WRITE_MISS_TRT_SET;
+          m_cpt_write_miss++;
+        }
+        else    // wait an empty entry in TRT
+        {
+          r_write_fsm       = WRITE_WAIT;
+          m_cpt_trt_full++;
+        }
+      }
+      break;
+    }
+
+    ////////////////
+    case WRITE_WAIT:  // release the locks protecting the shared ressources
+    {
+#if DEBUG_MEMC_WRITE
+      if( m_debug_write_fsm )
+      {
+        std::cout << "  <MEMC " << name() << ".WRITE_WAIT> Releases the locks before retry" << std::endl;
+      }
+#endif
+      r_write_fsm = WRITE_DIR_REQ;
+      break;
+    }
+
+    ////////////////////////
+    case WRITE_MISS_TRT_SET:  // register a new transaction in TRT (Write Buffer)
+    {
+      if ( r_alloc_trt_fsm.read() == ALLOC_TRT_WRITE )
+      {
+        std::vector<be_t>   be_vector;
+        std::vector<data_t> data_vector;
+        be_vector.clear();
+        data_vector.clear();
+        for ( size_t i=0; i<m_words; i++ )
+        {
+          be_vector.push_back(r_write_be[i]);
+          data_vector.push_back(r_write_data[i]);
+        }
+        m_transaction_tab.set(r_write_trt_index.read(),
+            true,     // read request to XRAM
+            m_nline[(vci_addr_t)(r_write_address.read())],
+            r_write_srcid.read(),
+            r_write_trdid.read(),
+            r_write_pktid.read(),
+            false,      // not a processor read
+            0,        // not a single word
+            0,            // word index
+            be_vector,
+            data_vector);
+        r_write_fsm = WRITE_MISS_XRAM_REQ;
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_MISS_TRT_SET> Set a new entry in TRT" << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+      /////////////////////////
+    case WRITE_MISS_TRT_DATA: // update an entry in TRT (used as a Write Buffer)
+    {
+      if ( r_alloc_trt_fsm.read() == ALLOC_TRT_WRITE )
+      {
+        std::vector<be_t> be_vector;
+        std::vector<data_t> data_vector;
+        be_vector.clear();
+        data_vector.clear();
+        for ( size_t i=0; i<m_words; i++ )
+        {
+          be_vector.push_back(r_write_be[i]);
+          data_vector.push_back(r_write_data[i]);
+        }
+        m_transaction_tab.write_data_mask(r_write_trt_index.read(),
+            be_vector,
+            data_vector);
+        r_write_fsm = WRITE_RSP;
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_MISS_TRT_DATA> Modify an existing entry in TRT" << std::endl;
+          m_transaction_tab.print( r_write_trt_index.read() );
+        }
+#endif
+      }
+      break;
+    }
+
+    /////////////////////////
+    case WRITE_MISS_XRAM_REQ: // send a GET request to IXR_CMD FSM
+    {
+      if ( !r_write_to_ixr_cmd_req )
+      {
+        r_write_to_ixr_cmd_req   = true;
+        r_write_to_ixr_cmd_write = false;
+        r_write_to_ixr_cmd_nline = m_nline[(vci_addr_t)(r_write_address.read())];
+        r_write_to_ixr_cmd_trdid = r_write_trt_index.read();
+        r_write_fsm              = WRITE_RSP;
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_MISS_XRAM_REQ> Post a GET request to the IXR_CMD FSM" << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    ///////////////////////
+    case WRITE_BC_TRT_LOCK:     // Check TRT not full
+    {
+      if ( r_alloc_trt_fsm.read() == ALLOC_TRT_WRITE )
+      {
+        size_t wok_index = 0;
+        bool wok = !m_transaction_tab.full( wok_index );
+        if ( wok )    // set a new entry in TRT
+        {
+          r_write_trt_index = wok_index;
+          r_write_fsm       = WRITE_BC_UPT_LOCK;
+        }
+        else  // wait an empty entry in TRT
+        {
+          r_write_fsm       = WRITE_WAIT;
+        }
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_BC_TRT_LOCK> Check TRT : wok = "
+            << wok << " / index = " << wok_index << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    //////////////////////
+    case WRITE_BC_UPT_LOCK:      // register BC transaction in UPT
+    {
+      if ( r_alloc_upt_fsm.read() == ALLOC_UPT_WRITE )
+      {
+        bool        wok       = false;
+        size_t      index     = 0;
+        size_t      srcid     = r_write_srcid.read();
+        size_t      trdid     = r_write_trdid.read();
+        size_t      pktid     = r_write_pktid.read();
+        addr_t      nline     = m_nline[(vci_addr_t)(r_write_address.read())];
+        size_t      nb_copies = r_write_count.read();
+
+        wok =m_update_tab.set(false,  // it's an inval transaction
+            true,     // it's a broadcast
+            true,     // it needs a response
+            srcid,
+            trdid,
+            pktid,
+            nline,
+            nb_copies,
+            index);
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          if ( wok )
+          {
+            std::cout << "  <MEMC " << name() << ".WRITE_BC_UPT_LOCK> Register the broadcast inval in UPT / "
+              << " nb_copies = " << r_write_count.read() << std::endl;
+          }
+        }
+#endif
+        r_write_upt_index = index;
+
+        if ( wok ) r_write_fsm = WRITE_BC_DIR_INVAL;
+        else       r_write_fsm = WRITE_WAIT;
+      }
+      break;
+    }
+
+    ////////////////////////
+    case WRITE_BC_DIR_INVAL:
+    {
+      // Register a put transaction to XRAM in TRT
+      // and invalidate the line in directory
+      if ( (r_alloc_trt_fsm.read() != ALLOC_TRT_WRITE ) ||
+          (r_alloc_upt_fsm.read() != ALLOC_UPT_WRITE ) ||
+          (r_alloc_dir_fsm.read() != ALLOC_DIR_WRITE ) )
+      {
+        std::cout << "VCI_MEM_CACHE ERROR " << name() << " WRITE_BC_DIR_INVAL state" << std::endl;
+        std::cout << "bad TRT, DIR, or UPT allocation" << std::endl;
+        exit(0);
+      }
+
+      // register a write request to XRAM in TRT
+      m_transaction_tab.set(r_write_trt_index.read(),
+          false,    // write request to XRAM
+          m_nline[(vci_addr_t)(r_write_address.read())],
+          0,
+          0,
+          0,
+          false,    // not a processor read
+          0,        // not a single word
+          0,            // word index
+          std::vector<be_t>(m_words,0),
+          std::vector<data_t>(m_words,0));
+
+      // invalidate directory entry
+      DirectoryEntry entry;
+      entry.valid         = false;
+      entry.dirty         = false;
+      entry.tag         = 0;
+      entry.is_cnt        = false;
+      entry.lock          = false;
+      entry.owner.srcid   = 0;
+#if L1_MULTI_CACHE
+      entry.owner.cache_id= 0;
+#endif
+      entry.owner.inst    = false;
+      entry.ptr           = 0;
+      entry.count         = 0;
+      size_t set          = m_y[(vci_addr_t)(r_write_address.read())];
+      size_t way          = r_write_way.read();
+
+      m_cache_directory.write(set, way, entry);
+
+#if DEBUG_MEMC_WRITE
+      if( m_debug_write_fsm )
+      {
+        std::cout << "  <MEMC " << name() << ".WRITE_BC_DIR_INVAL> Invalidate the directory entry: @ = "
+          << r_write_address.read() << " / register the put transaction in TRT:" << std::endl;
+      }
+#endif
+      r_write_fsm = WRITE_BC_CC_SEND;
+      break;
+    }
+
+    //////////////////////
+    case WRITE_BC_CC_SEND:    // Post a coherence broadcast request to INIT_CMD FSM
+    {
+      if ( !r_write_to_init_cmd_multi_req.read() && !r_write_to_init_cmd_brdcast_req.read() )
+      {
+        r_write_to_init_cmd_multi_req   = false;
+        r_write_to_init_cmd_brdcast_req = true;
+        r_write_to_init_cmd_trdid       = r_write_upt_index.read();
+        r_write_to_init_cmd_nline       = m_nline[(vci_addr_t)(r_write_address.read())];
+        r_write_to_init_cmd_index       = 0;
+        r_write_to_init_cmd_count       = 0;
+
+        for(size_t i=0; i<m_words ; i++)
+        {
+          r_write_to_init_cmd_be[i]=0;
+          r_write_to_init_cmd_data[i] = 0;
+        }
+        r_write_fsm = WRITE_BC_XRAM_REQ;
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_BC_CC_SEND> Post a broadcast request to INIT_CMD FSM" << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+
+    ///////////////////////
+    case WRITE_BC_XRAM_REQ:   // Post a put request to IXR_CMD FSM
+    {
+      if ( !r_write_to_ixr_cmd_req )
+      {
+        r_write_to_ixr_cmd_req     = true;
+        r_write_to_ixr_cmd_write   = true;
+        r_write_to_ixr_cmd_nline   = m_nline[(vci_addr_t)(r_write_address.read())];
+        r_write_to_ixr_cmd_trdid   = r_write_trt_index.read();
+
+        for(size_t i=0; i<m_words; i++) r_write_to_ixr_cmd_data[i] = r_write_data[i];
+
+        r_write_fsm = WRITE_IDLE;
+
+#if DEBUG_MEMC_WRITE
+        if( m_debug_write_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".WRITE_BC_XRAM_REQ> Post a put request to IXR_CMD FSM" << std::endl;
+        }
+#endif
+      }
+      break;
+    }
+  } // end switch r_write_fsm
+
+    ///////////////////////////////////////////////////////////////////////
+    //    IXR_CMD FSM
+    ///////////////////////////////////////////////////////////////////////
+    // The IXR_CMD fsm controls the command packets to the XRAM :
+    // - It sends a single cell VCI read request to the XRAM in case of MISS
+    // posted by the READ, WRITE or CAS FSMs : the TRDID field contains
+    // the Transaction Tab index.
+    // The VCI response is a multi-cell packet : the N cells contain
+    // the N data words.
+    // - It sends a multi-cell VCI write when the XRAM_RSP FSM, WRITE FSM
+    // or CAS FSM request to save a dirty line to the XRAM.
+    // The VCI response is a single cell packet.
+    // This FSM handles requests from the READ, WRITE, CAS & XRAM_RSP FSMs
+    // with a round-robin priority.
+    ////////////////////////////////////////////////////////////////////////
+
+    switch ( r_ixr_cmd_fsm.read() )
+    {
+        ////////////////////////
+        case IXR_CMD_READ_IDLE:
+        if      ( r_write_to_ixr_cmd_req )     r_ixr_cmd_fsm = IXR_CMD_WRITE_NLINE;
+        else if ( r_cas_to_ixr_cmd_req  )      r_ixr_cmd_fsm = IXR_CMD_CAS_NLINE;
+        else if ( r_xram_rsp_to_ixr_cmd_req  ) r_ixr_cmd_fsm = IXR_CMD_XRAM_DATA;
+        else if ( r_read_to_ixr_cmd_req  )     r_ixr_cmd_fsm = IXR_CMD_READ_NLINE;
+        break;
+        ////////////////////////
+        case IXR_CMD_WRITE_IDLE:
+        if      ( r_cas_to_ixr_cmd_req  )      r_ixr_cmd_fsm = IXR_CMD_CAS_NLINE;
+        else if ( r_xram_rsp_to_ixr_cmd_req  ) r_ixr_cmd_fsm = IXR_CMD_XRAM_DATA;
+        else if ( r_read_to_ixr_cmd_req  )     r_ixr_cmd_fsm = IXR_CMD_READ_NLINE;
+        else if ( r_write_to_ixr_cmd_req )     r_ixr_cmd_fsm = IXR_CMD_WRITE_NLINE;
+        break;
+        ////////////////////////
+        case IXR_CMD_CAS_IDLE:
+        if      ( r_xram_rsp_to_ixr_cmd_req  ) r_ixr_cmd_fsm = IXR_CMD_XRAM_DATA;
+        else if ( r_read_to_ixr_cmd_req  )     r_ixr_cmd_fsm = IXR_CMD_READ_NLINE;
+        else if ( r_write_to_ixr_cmd_req )     r_ixr_cmd_fsm = IXR_CMD_WRITE_NLINE;
+        else if ( r_cas_to_ixr_cmd_req  )      r_ixr_cmd_fsm = IXR_CMD_CAS_NLINE;
+        break;
+        ////////////////////////
+        case IXR_CMD_XRAM_IDLE:
+        if      ( r_read_to_ixr_cmd_req  )     r_ixr_cmd_fsm = IXR_CMD_READ_NLINE;
+        else if ( r_write_to_ixr_cmd_req )     r_ixr_cmd_fsm = IXR_CMD_WRITE_NLINE;
+        else if ( r_cas_to_ixr_cmd_req  )      r_ixr_cmd_fsm = IXR_CMD_CAS_NLINE;
+        else if ( r_xram_rsp_to_ixr_cmd_req  ) r_ixr_cmd_fsm = IXR_CMD_XRAM_DATA;
+        break;
+        /////////////////////////       // send a get request to XRAM
+        case IXR_CMD_READ_NLINE:
+        if ( p_vci_ixr.cmdack )
+        {
+            r_ixr_cmd_fsm = IXR_CMD_READ_IDLE;
+            r_read_to_ixr_cmd_req = false;
+
+#if DEBUG_MEMC_IXR_CMD
+if( m_debug_ixr_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_CMD_READ_NLINE> Send a get request to xram" << std::endl;
+}
+#endif
+        }
+        break;
+        //////////////////////////
+        case IXR_CMD_WRITE_NLINE:     // send a put or get command to XRAM
+        if ( p_vci_ixr.cmdack )
+        {
+            if( r_write_to_ixr_cmd_write.read())
+            {
+                if ( r_ixr_cmd_cpt.read() == (m_words - 1) )
+                {
+                    r_ixr_cmd_cpt = 0;
+                    r_ixr_cmd_fsm = IXR_CMD_WRITE_IDLE;
+                    r_write_to_ixr_cmd_req = false;
+                }
+                else
+                {
+                    r_ixr_cmd_cpt = r_ixr_cmd_cpt + 1;
+                }
+
+#if DEBUG_MEMC_IXR_CMD
+if( m_debug_ixr_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_CMD_WRITE_NLINE> Send a put request to xram" << std::endl;
+}
+#endif
+            }
+            else
+            {
+                r_ixr_cmd_fsm = IXR_CMD_WRITE_IDLE;
+                r_write_to_ixr_cmd_req = false;
+
+#if DEBUG_MEMC_IXR_CMD
+if( m_debug_ixr_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_CMD_WRITE_NLINE> Send a get request to xram" << std::endl;
+}
+#endif
+            }
+        }
+        break;
+        //////////////////////
+        case IXR_CMD_CAS_NLINE:      // send a put or get command to XRAM
+        if ( p_vci_ixr.cmdack )
+        {
+            if( r_cas_to_ixr_cmd_write.read())
+            {
+                if ( r_ixr_cmd_cpt.read() == (m_words - 1) )
+                {
+                    r_ixr_cmd_cpt = 0;
+                    r_ixr_cmd_fsm = IXR_CMD_CAS_IDLE;
+                    r_cas_to_ixr_cmd_req = false;
+                }
+                else
+                {
+                    r_ixr_cmd_cpt = r_ixr_cmd_cpt + 1;
+                }
+
+#if DEBUG_MEMC_IXR_CMD
+if( m_debug_ixr_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_CMD_CAS_NLINE> Send a put request to xram" << std::endl;
+}
+#endif
+            }
+            else
+            {
+                r_ixr_cmd_fsm = IXR_CMD_CAS_IDLE;
+                r_cas_to_ixr_cmd_req = false;
+
+#if DEBUG_MEMC_IXR_CMD
+if( m_debug_ixr_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_CMD_CAS_NLINE> Send a get request to xram" << std::endl;
+}
+#endif
+            }
+        }
+        break;
+        ////////////////////////
+        case IXR_CMD_XRAM_DATA:     // send a put command to XRAM
+        if ( p_vci_ixr.cmdack )
+        {
+            if ( r_ixr_cmd_cpt.read() == (m_words - 1) )
+            {
+                r_ixr_cmd_cpt = 0;
+                r_ixr_cmd_fsm = IXR_CMD_XRAM_IDLE;
+                r_xram_rsp_to_ixr_cmd_req = false;
+            }
+            else
+            {
+                r_ixr_cmd_cpt = r_ixr_cmd_cpt + 1;
+            }
+
+#if DEBUG_MEMC_IXR_CMD
+if( m_debug_ixr_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_CMD_XRAM_DATA> Send a put request to xram" << std::endl;
+}
+#endif
+        }
+        break;
+
+    } // end switch r_ixr_cmd_fsm
+
+    ////////////////////////////////////////////////////////////////////////////
+    //                IXR_RSP FSM
+    ////////////////////////////////////////////////////////////////////////////
+    // The IXR_RSP FSM receives the response packets from the XRAM,
+    // for both put transaction, and get transaction.
+    //
+    // - A response to a put request is a single-cell VCI packet.
+    // The Transaction Tab index is contained in the RTRDID field.
+    // The FSM takes the lock protecting the TRT, and the corresponding
+    // entry is erased.
+    //
+    // - A response to a get request is a multi-cell VCI packet.
+    // The Transaction Tab index is contained in the RTRDID field.
+    // The N cells contain the N words of the cache line in the RDATA field.
+    // The FSM takes the lock protecting the TRT to store the line in the TRT
+    // (taking into account the write requests already stored in the TRT).
+    // When the line is completely written, the corresponding rok signal is set.
+    ///////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_ixr_rsp_fsm.read() )
+    {
+        //////////////////
+        case IXR_RSP_IDLE:  // test if it's a get or a put transaction
+        {
+            if ( p_vci_ixr.rspval.read() )
+            {
+                r_ixr_rsp_cpt   = 0;
+                r_ixr_rsp_trt_index = p_vci_ixr.rtrdid.read();
+                if ( p_vci_ixr.reop.read() && !(p_vci_ixr.rerror.read()&0x1))  // put transaction
+                {
+                    r_ixr_rsp_fsm = IXR_RSP_ACK;
+
+#if DEBUG_MEMC_IXR_RSP
+if( m_debug_ixr_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_RSP_IDLE> Response from XRAM to a put transaction" << std::endl;
+}
+#endif
+                }
+                else                     // get transaction
+                {
+          r_ixr_rsp_fsm = IXR_RSP_TRT_READ;
+
+#if DEBUG_MEMC_IXR_RSP
+if( m_debug_ixr_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_RSP_IDLE> Response from XRAM to a get transaction" << std::endl;
+}
+#endif
+                }
+            }
+            break;
+        }
+        ////////////////////////
+        case IXR_RSP_ACK:        // Aknowledge the VCI response
+        {
+            if(p_vci_ixr.rspval.read()) r_ixr_rsp_fsm = IXR_RSP_TRT_ERASE;
+
+#if DEBUG_MEMC_IXR_RSP
+if( m_debug_ixr_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_RSP_ACK>" << std::endl;
+}
+#endif
+            break;
+        }
+        ////////////////////////
+        case IXR_RSP_TRT_ERASE:   // erase the entry in the TRT
+        {
+            if ( r_alloc_trt_fsm.read() == ALLOC_TRT_IXR_RSP )
+            {
+                m_transaction_tab.erase(r_ixr_rsp_trt_index.read());
+                r_ixr_rsp_fsm = IXR_RSP_IDLE;
+
+#if DEBUG_MEMC_IXR_RSP
+if( m_debug_ixr_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_RSP_TRT_ERASE> Erase TRT entry "
+              << r_ixr_rsp_trt_index.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        ///////////////////////
+        case IXR_RSP_TRT_READ:    // write data in the TRT
+        {
+            if ( (r_alloc_trt_fsm.read() == ALLOC_TRT_IXR_RSP) &&  p_vci_ixr.rspval )
+            {
+                size_t index    = r_ixr_rsp_trt_index.read();
+                bool   eop    = p_vci_ixr.reop.read();
+                data_t data   = p_vci_ixr.rdata.read();
+                bool   error    = ((p_vci_ixr.rerror.read() & 0x1) == 1);
+                assert(((eop == (r_ixr_rsp_cpt.read() == (m_words-1))) || p_vci_ixr.rerror.read())
+                    and "Error in VCI_MEM_CACHE : invalid length for a response from XRAM");
+                m_transaction_tab.write_rsp(index,
+                                            r_ixr_rsp_cpt.read(),
+                                            data,
+                                            error);
+                r_ixr_rsp_cpt = r_ixr_rsp_cpt.read() + 1;
+                if ( eop )
+                {
+                    r_ixr_rsp_to_xram_rsp_rok[r_ixr_rsp_trt_index.read()]=true;
+                    r_ixr_rsp_fsm = IXR_RSP_IDLE;
+                }
+
+#if DEBUG_MEMC_IXR_RSP
+if( m_debug_ixr_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".IXR_RSP_TRT_READ> Writing a word in TRT : "
+              << " index = " << std::dec << index
+              << " / word = " << r_ixr_rsp_cpt.read()
+              << " / data = " << std::hex << data << std::endl;
+}
+#endif
+            }
+            break;
+        }
+    } // end swich r_ixr_rsp_fsm
+
+    ////////////////////////////////////////////////////////////////////////////
+    //                XRAM_RSP FSM
+    ////////////////////////////////////////////////////////////////////////////
+    // The XRAM_RSP FSM handles the incoming cache lines from the XRAM.
+    // The cache line has been written in the TRT by the IXR_CMD_FSM.
+    // As the IXR_RSP FSM and the XRAM_RSP FSM are running in parallel,
+    // there is as many flip-flops r_ixr_rsp_to_xram_rsp_rok[i]
+    // as the number of entries in the TRT, that are handled with
+    // a round-robin priority...
+    //
+    // When a response is available, the corresponding TRT entry
+    // must be copied in a local buffer to be written in the cache.
+    // The FSM takes the lock protecting the TRT, and the lock protecting the DIR.
+    // It selects a cache slot and writes the line in the cache.
+    // If it was a read MISS, the XRAM_RSP FSM send a request to the TGT_RSP
+    // FSM to return the cache line to the registered processor.
+    // If there is no empty slot, a victim line is evicted, and
+    // invalidate requests are sent to the L1 caches containing copies.
+    // If this line is dirty, the XRAM_RSP FSM send a request to the IXR_CMD
+    // FSM to save the victim line to the XRAM, and register the write transaction
+    // in the TRT (using the entry previously used by the read transaction).
+    ///////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_xram_rsp_fsm.read() )
+    {
+        ///////////////////
+        case XRAM_RSP_IDLE: // scan the XRAM responses to get the TRT index (round robin)
+        {
+            size_t ptr   = r_xram_rsp_trt_index.read();
+            size_t lines = m_transaction_tab_lines;
+            for( size_t i=0 ; i<lines ; i++)
+            {
+                size_t index=(i+ptr+1)%lines;
+                if ( r_ixr_rsp_to_xram_rsp_rok[index] )
+                {
+                    r_xram_rsp_trt_index             = index;
+                    r_ixr_rsp_to_xram_rsp_rok[index] = false;
+                    r_xram_rsp_fsm                   = XRAM_RSP_DIR_LOCK;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_IDLE> Available cache line in TRT:"
+              << " index = " << std::dec << index << std::endl;
+}
+#endif
+                    break;
+                }
+            }
+            break;
+        }
+        ///////////////////////
+        case XRAM_RSP_DIR_LOCK:
+        // Takes the lock on the directory
+        // Takes the lock on TRT
+        // Copy the TRT entry in a local buffer
+        {
+            if (( r_alloc_dir_fsm.read() == ALLOC_DIR_XRAM_RSP ) &&
+                ( r_alloc_trt_fsm.read() == ALLOC_TRT_XRAM_RSP ))
+            {
+                // copy the TRT entry in the r_xram_rsp_trt_buf local buffer
+                size_t  index = r_xram_rsp_trt_index.read();
+
+                TransactionTabEntry trt_entry(m_transaction_tab.read(index));
+                r_xram_rsp_trt_buf.copy(trt_entry);  // TRT entry local buffer
+
+                r_xram_rsp_fsm = XRAM_RSP_TRT_COPY;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_DIR_LOCK> Get access to directory" << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        ///////////////////////
+        case XRAM_RSP_TRT_COPY:
+        // Select a victim cache line
+        {
+            if ( (r_alloc_trt_fsm.read() == ALLOC_TRT_XRAM_RSP) )
+            {
+                // selects & extracts a victim line from cache
+                size_t way = 0;
+                size_t set = m_y[(vci_addr_t)(r_xram_rsp_trt_buf.nline * m_words * 4)];
+
+                DirectoryEntry victim(m_cache_directory.select(set, way));
+
+                bool inval = (victim.count && victim.valid) ;
+
+                // copy the victim line in a local buffer
+                m_cache_data.read_line(way, set, r_xram_rsp_victim_data);
+
+                r_xram_rsp_victim_copy      = victim.owner.srcid;
+#if L1_MULTI_CACHE
+                r_xram_rsp_victim_copy_cache= victim.owner.cache_id;
+#endif
+                r_xram_rsp_victim_copy_inst = victim.owner.inst;
+                r_xram_rsp_victim_count     = victim.count;
+                r_xram_rsp_victim_ptr       = victim.ptr;
+                r_xram_rsp_victim_way       = way;
+                r_xram_rsp_victim_set       = set;
+                r_xram_rsp_victim_nline     = victim.tag*m_sets + set;
+                r_xram_rsp_victim_is_cnt    = victim.is_cnt;
+                r_xram_rsp_victim_inval     = inval ;
+                r_xram_rsp_victim_dirty     = victim.dirty;
+
+                if(!r_xram_rsp_trt_buf.rerror)
+                {
+                  r_xram_rsp_fsm = XRAM_RSP_INVAL_LOCK;
+                }
+                else
+                {
+                  r_xram_rsp_fsm = XRAM_RSP_ERROR_ERASE;
+                }
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_TRT_COPY> Select a slot: "
+              << " way = " << std::dec << way
+              << " / set = " << set
+              << " / inval_required = " << inval << std::endl;
+}
+#endif
+            }
+            else
+            {
+                std::cout << "VCI_MEM_CACHE ERROR "     << name()
+                          << " XRAM_RSP_TRT_COPY state" << std::endl
+                          << "bad TRT allocation"       << std::endl;
+
+                exit(0);
+            }
+            break;
+        }
+        /////////////////////////
+        case XRAM_RSP_INVAL_LOCK: // check a possible pending inval
+        {
+            if ( r_alloc_upt_fsm == ALLOC_UPT_XRAM_RSP )
+            {
+                size_t index;
+                if (m_update_tab.search_inval(r_xram_rsp_trt_buf.nline, index))
+                {
+                    r_xram_rsp_fsm = XRAM_RSP_INVAL_WAIT;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_INVAL_LOCK> Get acces to UPT,"
+              << " but an invalidation is already registered at this address" << std::endl;
+    m_update_tab.print();
+}
+#endif
+
+                }
+              else if (m_update_tab.is_full() && r_xram_rsp_victim_inval.read())
+                {
+                  r_xram_rsp_fsm = XRAM_RSP_INVAL_WAIT;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_INVAL_LOCK> Get acces to UPT,"
+              << " but the table is full" << std::endl;
+    m_update_tab.print();
+}
+#endif
+              }
+                else
+                {
+                    r_xram_rsp_fsm = XRAM_RSP_DIR_UPDT;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_INVAL_LOCK> Get acces to UPT" << std::endl;
+}
+#endif
+                }
+            }
+            break;
+        }
+        /////////////////////////
+        case XRAM_RSP_INVAL_WAIT: // returns to DIR_LOCK to retry
+        {
+            r_xram_rsp_fsm = XRAM_RSP_DIR_LOCK;
+            break;
+        }
+        ///////////////////////
+        case XRAM_RSP_DIR_UPDT:   // updates the cache (both data & directory)
+                                        // and possibly set an inval request in UPT
+        {
+            // signals generation
+            // check if this is an instruction read, this means pktid is either
+            // TYPE_READ_INS_UNC   0bX010 with TSAR encoding
+            // TYPE_READ_INS_MISS  0bX011 with TSAR encoding
+            bool inst_read = (r_xram_rsp_trt_buf.pktid & 0x2) && r_xram_rsp_trt_buf.proc_read;
+            // check if this is a cached read, this means pktid is either
+            // TYPE_READ_DATA_MISS 0bX001 with TSAR encoding
+            // TYPE_READ_INS_MISS  0bX011 with TSAR encoding
+            bool cached_read = (r_xram_rsp_trt_buf.pktid & 0x1) && r_xram_rsp_trt_buf.proc_read;
+
+            // update data
+            size_t set   = r_xram_rsp_victim_set.read();
+            size_t way   = r_xram_rsp_victim_way.read();
+            for(size_t word=0; word<m_words ; word++)
+            {
+                m_cache_data.write(way, set, word, r_xram_rsp_trt_buf.wdata[word]);
+
+                if ( m_monitor_ok )
+                {
+                    vci_addr_t address = r_xram_rsp_trt_buf.nline<<6 | word<<2;
+                    check_monitor("XRAM_RSP_DIR_UPDT", address, r_xram_rsp_trt_buf.wdata[word]);
+                }
+            }
+            // compute dirty
+            bool dirty = false;
+            for(size_t i=0; i<m_words;i++) dirty = dirty || (r_xram_rsp_trt_buf.wdata_be[i] != 0);
+            // update directory
+            DirectoryEntry entry;
+            entry.valid   = true;
+            entry.is_cnt  = false;
+            entry.lock    = false;
+            entry.dirty   = dirty;
+            entry.tag     = r_xram_rsp_trt_buf.nline / m_sets;
+            entry.ptr     = 0;
+            if(cached_read)
+            {
+                entry.owner.srcid   = r_xram_rsp_trt_buf.srcid;
+#if L1_MULTI_CACHE
+                entry.owner.cache_id= r_xram_rsp_trt_buf.pktid;
+#endif
+                entry.owner.inst    = inst_read;
+                entry.count         = 1;
+            }
+            else
+            {
+                entry.owner.srcid    = 0;
+#if L1_MULTI_CACHE
+                entry.owner.cache_id = 0;
+#endif
+                entry.owner.inst     = 0;
+                entry.count          = 0;
+            }
+            m_cache_directory.write(set, way, entry);
+
+            if (r_xram_rsp_victim_inval.read())
+            {
+                bool   brdcast    = r_xram_rsp_victim_is_cnt.read();
+                size_t index    = 0;
+                size_t count_copies   = r_xram_rsp_victim_count.read();
+
+                bool   wok = m_update_tab.set(  false,    // it's an inval transaction
+                        brdcast,  // set brdcast bit
+                        false,    // it does not need a response
+                        0,    // srcid
+                        0,    // trdid
+                        0,    // pktid
+                        r_xram_rsp_victim_nline.read(),
+                        count_copies,
+                        index);
+                r_xram_rsp_upt_index = index;
+
+                if (!wok)
+                {
+                    std::cout << "VCI_MEM_CACHE ERROR " << name() << " XRAM_RSP_HEAP_LAST state" << std::endl;
+                    std::cout << "an update_tab entry was free but write is unsuccessful" << std::endl;
+                    exit(0);
+                }
+            }
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_DIR_UPDT> Directory update: "
+              << " way = " << std::dec << way
+              << " / set = " << set
+              << " / count = " << entry.count
+              << " / is_cnt = " << entry.is_cnt << std::endl;
+    if (r_xram_rsp_victim_inval.read())
+    std::cout << "                           Invalidation request for victim line "
+              << std::hex << r_xram_rsp_victim_nline.read()
+              << " / broadcast = " << r_xram_rsp_victim_is_cnt.read() << std::endl;
+}
+#endif
+
+            // If the victim is not dirty, we don't need another XRAM  put transaction,
+            // and we canwe erase the TRT entry
+            if (!r_xram_rsp_victim_dirty.read())  m_transaction_tab.erase(r_xram_rsp_trt_index.read());
+
+            // Next state
+            if      ( r_xram_rsp_victim_dirty.read())       r_xram_rsp_fsm = XRAM_RSP_TRT_DIRTY;
+            else if ( r_xram_rsp_trt_buf.proc_read  )       r_xram_rsp_fsm = XRAM_RSP_DIR_RSP;
+            else if ( r_xram_rsp_victim_inval.read())       r_xram_rsp_fsm = XRAM_RSP_INVAL;
+            else                                            r_xram_rsp_fsm = XRAM_RSP_IDLE;
+            break;
+        }
+        ////////////////////////
+        case XRAM_RSP_TRT_DIRTY:  // set the TRT entry (write to XRAM) if the victim is dirty
+        {
+            if ( r_alloc_trt_fsm.read() == ALLOC_TRT_XRAM_RSP )
+            {
+                m_transaction_tab.set( r_xram_rsp_trt_index.read(),
+                                       false,       // write to XRAM
+                                       r_xram_rsp_victim_nline.read(),  // line index
+                                       0,
+                                       0,
+                                       0,
+                                       false,
+                                       0,
+                                       0,
+                                       std::vector<be_t>(m_words,0),
+                                       std::vector<data_t>(m_words,0) );
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_TRT_DIRTY> Set TRT entry for the put transaction:"
+        << " dirty victim line = " << r_xram_rsp_victim_nline.read() << std::endl;
+}
+#endif
+                if      ( r_xram_rsp_trt_buf.proc_read  )       r_xram_rsp_fsm = XRAM_RSP_DIR_RSP;
+                else if ( r_xram_rsp_victim_inval.read())       r_xram_rsp_fsm = XRAM_RSP_INVAL;
+                else                                            r_xram_rsp_fsm = XRAM_RSP_WRITE_DIRTY;
+            }
+            break;
+        }
+        //////////////////////
+        case XRAM_RSP_DIR_RSP:     // Request a response to TGT_RSP FSM
+        {
+            if ( !r_xram_rsp_to_tgt_rsp_req.read() )
+            {
+                r_xram_rsp_to_tgt_rsp_srcid = r_xram_rsp_trt_buf.srcid;
+                r_xram_rsp_to_tgt_rsp_trdid = r_xram_rsp_trt_buf.trdid;
+                r_xram_rsp_to_tgt_rsp_pktid = r_xram_rsp_trt_buf.pktid;
+                for (size_t i=0; i < m_words; i++) r_xram_rsp_to_tgt_rsp_data[i] = r_xram_rsp_trt_buf.wdata[i];
+                r_xram_rsp_to_tgt_rsp_word   = r_xram_rsp_trt_buf.word_index;
+                r_xram_rsp_to_tgt_rsp_length = r_xram_rsp_trt_buf.read_length;
+                r_xram_rsp_to_tgt_rsp_ll_key = r_xram_rsp_trt_buf.ll_key;
+                r_xram_rsp_to_tgt_rsp_rerror = false;
+                r_xram_rsp_to_tgt_rsp_req    = true;
+
+                if      ( r_xram_rsp_victim_inval ) r_xram_rsp_fsm = XRAM_RSP_INVAL;
+                else if ( r_xram_rsp_victim_dirty ) r_xram_rsp_fsm = XRAM_RSP_WRITE_DIRTY;
+                else                                r_xram_rsp_fsm = XRAM_RSP_IDLE;
+
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_DIR_RSP> Request the TGT_RSP FSM to return data:"
+              << " rsrcid = " << std::dec << r_xram_rsp_trt_buf.srcid
+              << " / address = " << std::hex << r_xram_rsp_trt_buf.nline*m_words*4
+              << " / nwords = " << std::dec << r_xram_rsp_trt_buf.read_length << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        ////////////////////
+        case XRAM_RSP_INVAL:  // send invalidate request to INIT_CMD FSM
+        {
+            if(   !r_xram_rsp_to_init_cmd_multi_req.read() &&
+                  !r_xram_rsp_to_init_cmd_brdcast_req.read() )
+            {
+                bool multi_req = !r_xram_rsp_victim_is_cnt.read();
+                bool last_multi_req  = multi_req && (r_xram_rsp_victim_count.read() == 1);
+                bool not_last_multi_req = multi_req && (r_xram_rsp_victim_count.read() != 1);
+
+                r_xram_rsp_to_init_cmd_multi_req    = last_multi_req;
+                r_xram_rsp_to_init_cmd_brdcast_req  = r_xram_rsp_victim_is_cnt.read();
+                r_xram_rsp_to_init_cmd_nline        = r_xram_rsp_victim_nline.read();
+                r_xram_rsp_to_init_cmd_trdid        = r_xram_rsp_upt_index;
+                xram_rsp_to_init_cmd_fifo_srcid     = r_xram_rsp_victim_copy.read();
+                xram_rsp_to_init_cmd_fifo_inst      = r_xram_rsp_victim_copy_inst.read();
+#if L1_MULTI_CACHE
+                xram_rsp_to_init_cmd_fifo_cache_id  = r_xram_rsp_victim_copy_cache.read();
+#endif
+                xram_rsp_to_init_cmd_fifo_put       = multi_req;
+                r_xram_rsp_next_ptr                 = r_xram_rsp_victim_ptr.read();
+
+                if ( r_xram_rsp_victim_dirty )  r_xram_rsp_fsm = XRAM_RSP_WRITE_DIRTY;
+                else if (not_last_multi_req)    r_xram_rsp_fsm = XRAM_RSP_HEAP_REQ;
+                else                            r_xram_rsp_fsm = XRAM_RSP_IDLE;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_INVAL> Send an inval request to INIT_CMD FSM:"
+              << " victim line = " << r_xram_rsp_victim_nline.read() << std::endl;
+}
+#endif
+          }
+          break;
+        }
+        //////////////////////////
+        case XRAM_RSP_WRITE_DIRTY:  // send a write request to IXR_CMD FSM
+        {
+            if ( !r_xram_rsp_to_ixr_cmd_req.read() )
+            {
+                r_xram_rsp_to_ixr_cmd_req = true;
+                r_xram_rsp_to_ixr_cmd_nline = r_xram_rsp_victim_nline.read();
+                r_xram_rsp_to_ixr_cmd_trdid = r_xram_rsp_trt_index.read();
+                for(size_t i=0; i<m_words ; i++) r_xram_rsp_to_ixr_cmd_data[i] = r_xram_rsp_victim_data[i];
+                m_cpt_write_dirty++;
+
+                bool multi_req = !r_xram_rsp_victim_is_cnt.read() && r_xram_rsp_victim_inval.read();
+                bool not_last_multi_req = multi_req && (r_xram_rsp_victim_count.read() != 1);
+                if ( not_last_multi_req )   r_xram_rsp_fsm = XRAM_RSP_HEAP_REQ;
+                else                        r_xram_rsp_fsm = XRAM_RSP_IDLE;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_WRITE_DIRTY> Send the put request to IXR_CMD FSM:"
+              << " victim line = " << r_xram_rsp_victim_nline.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+
+        /////////////////////////
+        case XRAM_RSP_HEAP_REQ:
+        // Get the lock to the HEAP directory
+        {
+          if( r_alloc_heap_fsm.read() == ALLOC_HEAP_XRAM_RSP )
+          {
+            r_xram_rsp_fsm = XRAM_RSP_HEAP_ERASE;
+          }
+
+#if DEBUG_MEMC_XRAM_RSP
+          if( m_debug_xram_rsp_fsm )
+          {
+            std::cout 
+              << "  <MEMC " << name() << ".XRAM_RSP_HEAP_REQ> Requesting HEAP lock "
+              << std::endl;
+          }
+#endif
+          break;
+        }
+
+        /////////////////////////
+        case XRAM_RSP_HEAP_ERASE: // erase the list of copies and sent invalidations
+        {
+            if( r_alloc_heap_fsm.read() == ALLOC_HEAP_XRAM_RSP )
+            {
+                HeapEntry entry = m_heap.read(r_xram_rsp_next_ptr.read());
+
+                xram_rsp_to_init_cmd_fifo_srcid    = entry.owner.srcid;
+#if L1_MULTI_CACHE
+                xram_rsp_to_init_cmd_fifo_cache_id = entry.owner.cache_id;
+#endif
+                xram_rsp_to_init_cmd_fifo_inst  = entry.owner.inst;
+                xram_rsp_to_init_cmd_fifo_put   = true;
+                if( m_xram_rsp_to_init_cmd_inst_fifo.wok() )
+                {
+                    r_xram_rsp_next_ptr = entry.next;
+                    if( entry.next == r_xram_rsp_next_ptr.read() ) // last copy
+                    {
+                        r_xram_rsp_to_init_cmd_multi_req = true;
+                        r_xram_rsp_fsm = XRAM_RSP_HEAP_LAST;
+                    }
+                    else
+                    {
+                        r_xram_rsp_fsm = XRAM_RSP_HEAP_ERASE;
+                    }
+                }
+                else
+                {
+                    r_xram_rsp_fsm = XRAM_RSP_HEAP_ERASE;
+                }
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_HEAP_ERASE> Erase the list of copies:"
+              << " srcid = " << std::dec << entry.owner.srcid
+              << " / inst = " << std::dec << entry.owner.inst << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        /////////////////////////
+        case XRAM_RSP_HEAP_LAST:  // last member of the list
+        {
+            if ( r_alloc_heap_fsm.read() != ALLOC_HEAP_XRAM_RSP )
+            {
+                std::cout << "VCI_MEM_CACHE ERROR " << name() << " XRAM_RSP_HEAP_LAST state" << std::endl;
+                std::cout << "bad HEAP allocation" << std::endl;
+                exit(0);
+            }
+            size_t free_pointer = m_heap.next_free_ptr();
+
+            HeapEntry last_entry;
+            last_entry.owner.srcid    = 0;
+#if L1_MULTI_CACHE
+            last_entry.owner.cache_id = 0;
+#endif
+            last_entry.owner.inst     = false;
+            if(m_heap.is_full())
+            {
+                last_entry.next     = r_xram_rsp_next_ptr.read();
+                m_heap.unset_full();
+            }
+            else
+            {
+                last_entry.next     = free_pointer;
+            }
+
+            m_heap.write_free_ptr(r_xram_rsp_victim_ptr.read());
+            m_heap.write(r_xram_rsp_next_ptr.read(),last_entry);
+
+            r_xram_rsp_fsm = XRAM_RSP_IDLE;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_HEAP_LAST> Heap housekeeping" << std::endl;
+}
+#endif
+            break;
+        }
+        // ///////////////////////
+        case XRAM_RSP_ERROR_ERASE:  // erase TRT entry in case of error
+        {
+            m_transaction_tab.erase(r_xram_rsp_trt_index.read());
+
+            // Next state
+            if ( r_xram_rsp_trt_buf.proc_read  ) r_xram_rsp_fsm = XRAM_RSP_ERROR_RSP;
+            else                                 r_xram_rsp_fsm = XRAM_RSP_IDLE;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_ERROR_ERASE> Error reported by XRAM / erase the TRT entry" << std::endl;
+}
+#endif
+            break;
+        }
+        ////////////////////////
+        case XRAM_RSP_ERROR_RSP:     // Request an error response to TGT_RSP FSM
+        {
+            if ( !r_xram_rsp_to_tgt_rsp_req.read() )
+            {
+                r_xram_rsp_to_tgt_rsp_srcid  = r_xram_rsp_trt_buf.srcid;
+                r_xram_rsp_to_tgt_rsp_trdid  = r_xram_rsp_trt_buf.trdid;
+                r_xram_rsp_to_tgt_rsp_pktid  = r_xram_rsp_trt_buf.pktid;
+                for (size_t i=0; i < m_words; i++) r_xram_rsp_to_tgt_rsp_data[i] = r_xram_rsp_trt_buf.wdata[i];
+                r_xram_rsp_to_tgt_rsp_word   = r_xram_rsp_trt_buf.word_index;
+                r_xram_rsp_to_tgt_rsp_length = r_xram_rsp_trt_buf.read_length;
+                r_xram_rsp_to_tgt_rsp_rerror = true;
+                r_xram_rsp_to_tgt_rsp_req    = true;
+
+                r_xram_rsp_fsm = XRAM_RSP_IDLE;
+
+#if DEBUG_MEMC_XRAM_RSP
+if( m_debug_xram_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".XRAM_RSP_ERROR_RSP> Request a response error to TGT_RSP FSM:"
+              << " srcid = " << std::dec << r_xram_rsp_trt_buf.srcid << std::endl;
+}
+#endif
+            }
+            break;
+        }
+    } // end swich r_xram_rsp_fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    CLEANUP FSM
+    ////////////////////////////////////////////////////////////////////////////////////
+    // The CLEANUP FSM handles the cleanup request from L1 caches.
+    // It accesses the cache directory and the heap to update the list of copies.
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_cleanup_fsm.read() )
+    {
+      //////////////////
+      case CLEANUP_IDLE:
+      {
+        if ( p_vci_tgt_cleanup.cmdval.read() )
+        {
+          if (p_vci_tgt_cleanup.srcid.read() >= m_initiators )
+          {
+            std::cout << "VCI_MEM_CACHE ERROR " << name()
+              << " CLEANUP_IDLE state" << std::endl;
+            std::cout << "illegal srcid for  cleanup request" << std::endl;
+            exit(0);
+          }
+
+          bool reached = false;
+          for ( size_t index = 0 ; index < m_ncseg && !reached ; index++ )
+          {
+            if ( m_cseg[index]->contains((addr_t)(p_vci_tgt_cleanup.address.read())) )
+              reached = true;
+          }
+          // only write request to a mapped address that are not broadcast are handled
+          if (( p_vci_tgt_cleanup.cmd.read() == vci_param::CMD_WRITE ) &&
+              (( p_vci_tgt_cleanup.address.read() & 0x3 ) == 0 ) && reached )
+          {
+            addr_t line =(((addr_t) p_vci_tgt_cleanup.be.read() << (vci_param::B*8))) |
+              (((addr_t) p_vci_tgt_cleanup.wdata.read()));
+
+            r_cleanup_nline = line;
+            r_cleanup_srcid = p_vci_tgt_cleanup.srcid.read();
+            r_cleanup_trdid = p_vci_tgt_cleanup.trdid.read();
+            r_cleanup_pktid = p_vci_tgt_cleanup.pktid.read();
+            r_cleanup_fsm   = CLEANUP_DIR_REQ;
+
+  #if DEBUG_MEMC_CLEANUP
+            if( m_debug_cleanup_fsm )
+            {
+              std::cout << "  <MEMC " << name() << ".CLEANUP_IDLE> Cleanup request:" << std::hex
+                << " line addr = " << line * m_words * 4
+                << " / owner_id = " << p_vci_tgt_cleanup.srcid.read()
+                << " / owner_ins = " << (p_vci_tgt_cleanup.trdid.read()&0x1)
+                << std::endl;
+            }
+  #endif
+            m_cpt_cleanup++;
+          }
+        }
+        break;
+      }
+
+      //////////////////////
+      case CLEANUP_DIR_REQ:
+      // Get the lock to the directory
+      {
+        if ( r_alloc_dir_fsm.read() == ALLOC_DIR_CLEANUP )
+        {
+          r_cleanup_fsm = CLEANUP_DIR_LOCK;
+        }
+
+#if DEBUG_MEMC_CLEANUP
+        if( m_debug_cleanup_fsm )
+        {
+          std::cout 
+            << "  <MEMC " << name() << ".CLEANUP_DIR_REQ> Requesting DIR lock "
+            << std::endl;
+        }
+#endif
+        break;
+      }
+
+      //////////////////////
+      case CLEANUP_DIR_LOCK:  // test directory status
+      {
+        if ( r_alloc_dir_fsm.read() == ALLOC_DIR_CLEANUP )
+        {
+          // Read the directory
+          size_t way = 0;
+          addr_t cleanup_address = r_cleanup_nline.read() * m_words * 4;
+          DirectoryEntry entry   = m_cache_directory.read(cleanup_address , way);
+          r_cleanup_is_cnt       = entry.is_cnt;
+          r_cleanup_dirty        = entry.dirty;
+          r_cleanup_tag          = entry.tag;
+          r_cleanup_lock         = entry.lock;
+          r_cleanup_way          = way;
+          r_cleanup_copy         = entry.owner.srcid;
+#if L1_MULTI_CACHE
+          r_cleanup_copy_cache   = entry.owner.cache_id;
+#endif
+          r_cleanup_copy_inst    = entry.owner.inst;
+          r_cleanup_count        = entry.count;
+          r_cleanup_ptr          = entry.ptr;
+
+          if( entry.valid) //  hit : the copy must be cleared
+          {
+            if ( (entry.count==1) || (entry.is_cnt) )  // no access to the heap
+            {
+              r_cleanup_fsm = CLEANUP_DIR_WRITE;
+            }
+            else          // access to the heap
+            {
+              r_cleanup_fsm = CLEANUP_HEAP_REQ;
+            }
+          }
+          else    // miss : we must check the update table
+          {
+            r_cleanup_fsm = CLEANUP_UPT_LOCK;
+          }
+
+#if DEBUG_MEMC_CLEANUP
+          if( m_debug_cleanup_fsm )
+          {
+            std::cout
+              << "  <MEMC " << name()
+              << ".CLEANUP_DIR_LOCK> Test directory status: " << std::hex
+              << " line = " << r_cleanup_nline.read() * m_words * 4
+              << " / hit = " << entry.valid
+              << " / dir_id = " << entry.owner.srcid
+              << " / dir_ins = " << entry.owner.inst
+              << " / search_id = " << r_cleanup_srcid.read()
+              << " / search_ins = " << (r_cleanup_trdid.read()&0x1)
+              << " / count = " << entry.count
+              << " / is_cnt = " << entry.is_cnt << std::endl;
+          }
+#endif
+        }
+        else
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " CLEANUP_DIR_LOCK state"
+            << " bad DIR allocation" << std::endl;
+
+          exit(0);
+        }
+        break;
+      }
+
+      ///////////////////////
+      case CLEANUP_DIR_WRITE:
+      // Update the directory entry without heap access
+      {
+        if ( r_alloc_dir_fsm.read() != ALLOC_DIR_CLEANUP )
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " CLEANUP_DIR_WRITE state"
+            << " bad DIR allocation" << std::endl;
+          exit(0);
+        }
+
+        size_t way         = r_cleanup_way.read();
+        size_t set         = m_y[(vci_addr_t)(r_cleanup_nline.read()*m_words*4)];
+        bool cleanup_inst  = r_cleanup_trdid.read() & 0x1;
+        bool match_srcid   = ((r_cleanup_copy.read() == r_cleanup_srcid.read())
+#if L1_MULTI_CACHE
+            and (r_cleanup_copy_cache.read() == r_cleanup_pktid.read())
+#endif
+            );
+        bool match_inst    = (r_cleanup_copy_inst.read()  == cleanup_inst);
+        bool match         = match_srcid && match_inst;
+
+        if (not r_cleanup_is_cnt.read() and not match) {
+            std::cout
+              << "VCI_MEM_CACHE ERROR : Cleanup request on a valid"
+              << "entry using linked list mode with no corresponding"
+              << "directory or heap entry"
+              << std::endl;
+
+            exit(1);
+        }
+
+        // update the cache directory (for the copies)
+        DirectoryEntry entry;
+        entry.valid       = true;
+        entry.is_cnt      = r_cleanup_is_cnt.read();
+        entry.dirty       = r_cleanup_dirty.read();
+        entry.tag         = r_cleanup_tag.read();
+        entry.lock        = r_cleanup_lock.read();
+        entry.ptr         = r_cleanup_ptr.read();
+        entry.count       = r_cleanup_count.read() - 1;
+        entry.owner.srcid = 0;
+        entry.owner.inst  = 0;
+#if L1_MULTI_CACHE
+        entry.owner.cache_id = 0;
+#endif
+
+        m_cache_directory.write(set, way, entry);
+
+        r_cleanup_fsm = CLEANUP_RSP;
+
+#if DEBUG_MEMC_CLEANUP
+        if( m_debug_cleanup_fsm )
+        {
+          std::cout
+            << "  <MEMC " << name()
+            << ".CLEANUP_DIR_WRITE> Update directory:" << std::hex
+            << " line = " << r_cleanup_nline.read() * m_words * 4
+            << " / dir_id = " << entry.owner.srcid
+            << " / dir_ins = " << entry.owner.inst
+            << " / count = " << entry.count
+            << " / is_cnt = " << entry.is_cnt << std::endl;
+        }
+#endif
+
+        break;
+      }
+      
+      ///////////////////////
+      case CLEANUP_HEAP_REQ:
+      // Get the lock to the HEAP directory
+      {
+        if ( r_alloc_heap_fsm.read() == ALLOC_HEAP_CLEANUP )
+        {
+          r_cleanup_fsm = CLEANUP_HEAP_LOCK;
+        }
+
+#if DEBUG_MEMC_CLEANUP
+        if( m_debug_cleanup_fsm )
+        {
+          std::cout 
+            << "  <MEMC " << name() << ".CLEANUP_HEAP_REQ> Requesting HEAP lock "
+            << std::endl;
+        }
+#endif
+        break;
+      }
+
+      ///////////////////////
+      case CLEANUP_HEAP_LOCK:
+      // two cases are handled in this state:
+      // - the matching copy is directly in the directory
+      // - the matching copy is the first copy in the heap
+      {
+        if ( r_alloc_heap_fsm.read() == ALLOC_HEAP_CLEANUP )
+        {
+          size_t way              = r_cleanup_way.read();
+          size_t set              = m_y[(vci_addr_t)(r_cleanup_nline.read()*m_words*4)];
+          HeapEntry heap_entry    = m_heap.read(r_cleanup_ptr.read());
+          bool last               = (heap_entry.next == r_cleanup_ptr.read());
+          bool cleanup_inst       = r_cleanup_trdid.read() & 0x1;
+
+          // match_dir computation
+          bool match_dir_srcid    = (r_cleanup_copy.read() == r_cleanup_srcid.read());
+          bool match_dir_inst     = (r_cleanup_copy_inst.read()  == cleanup_inst);
+          bool match_dir          = match_dir_srcid and match_dir_inst;
+#if L1_MULTI_CACHE
+          match_dir = match_dir and (r_cleanup_copy_cache.read() == r_cleanup_pktid.read());
+#endif
+
+          // match_heap computation
+          bool match_heap_srcid   = (heap_entry.owner.srcid == r_cleanup_srcid.read());
+          bool match_heap_inst    = (heap_entry.owner.inst  == cleanup_inst);
+          bool match_heap         = match_heap_srcid and match_heap_inst;
+#if L1_MULTI_CACHE
+          match_heap = match_heap and (heap_entry.owner.cache_id == r_cleanup_pktid.read());
+#endif
+
+          r_cleanup_prev_ptr      = r_cleanup_ptr.read();
+          r_cleanup_prev_srcid    = heap_entry.owner.srcid;
+#if L1_MULTI_CACHE
+          r_cleanup_prev_cache_id = heap_entry.owner.cache_id;
+#endif
+          r_cleanup_prev_inst     = heap_entry.owner.inst;
+
+          if (match_dir)
+          // the matching copy is registered in the directory
+          {
+            // the copy registered in the directory must be replaced
+            // by the first copy registered in the heap
+            // and the corresponding entry must be freed
+            DirectoryEntry dir_entry;
+            dir_entry.valid          = true;
+            dir_entry.is_cnt         = r_cleanup_is_cnt.read();
+            dir_entry.dirty          = r_cleanup_dirty.read();
+            dir_entry.tag            = r_cleanup_tag.read();
+            dir_entry.lock           = r_cleanup_lock.read();
+            dir_entry.ptr            = heap_entry.next;
+            dir_entry.count          = r_cleanup_count.read()-1;
+            dir_entry.owner.srcid    = heap_entry.owner.srcid;
+#if L1_MULTI_CACHE
+            dir_entry.owner.cache_id = heap_entry.owner.cache_id;
+#endif
+            dir_entry.owner.inst     = heap_entry.owner.inst;
+
+            m_cache_directory.write(set,way,dir_entry);
+
+            r_cleanup_next_ptr       = r_cleanup_ptr.read();
+            r_cleanup_fsm            = CLEANUP_HEAP_FREE;
+          }
+          else if (match_heap)
+          // the matching copy is the first copy in the heap
+          {
+            // The first copy in heap must be freed
+            // and the copy registered in directory must point to the next copy in heap
+            DirectoryEntry dir_entry;
+            dir_entry.valid          = true;
+            dir_entry.is_cnt         = r_cleanup_is_cnt.read();
+            dir_entry.dirty          = r_cleanup_dirty.read();
+            dir_entry.tag            = r_cleanup_tag.read();
+            dir_entry.lock           = r_cleanup_lock.read();
+            dir_entry.ptr            = heap_entry.next;
+            dir_entry.count          = r_cleanup_count.read()-1;
+            dir_entry.owner.srcid    = r_cleanup_copy.read();
+#if L1_MULTI_CACHE
+            dir_entry.owner.cache_id = r_cleanup_copy_cache.read();
+#endif
+            dir_entry.owner.inst     = r_cleanup_copy_inst.read();
+
+            m_cache_directory.write(set,way,dir_entry);
+
+            r_cleanup_next_ptr       = r_cleanup_ptr.read();
+            r_cleanup_fsm            = CLEANUP_HEAP_FREE;
+          }
+          else if(!last)
+          // The matching copy is in the heap, but is not the first copy
+          {
+            // The directory entry must be modified to decrement count
+            DirectoryEntry  dir_entry;
+            dir_entry.valid          = true;
+            dir_entry.is_cnt         = r_cleanup_is_cnt.read();
+            dir_entry.dirty          = r_cleanup_dirty.read();
+            dir_entry.tag            = r_cleanup_tag.read();
+            dir_entry.lock           = r_cleanup_lock.read();
+            dir_entry.ptr            = r_cleanup_ptr.read();
+            dir_entry.count          = r_cleanup_count.read()-1;
+            dir_entry.owner.srcid    = r_cleanup_copy.read();
+#if L1_MULTI_CACHE
+            dir_entry.owner.cache_id = r_cleanup_copy_cache.read();
+#endif
+            dir_entry.owner.inst     = r_cleanup_copy_inst.read();
+
+            m_cache_directory.write(set,way,dir_entry);
+
+            r_cleanup_next_ptr       = heap_entry.next;
+            r_cleanup_fsm            = CLEANUP_HEAP_SEARCH;
+          }
+          else
+          {
+            std::cout << "VCI_MEM_CACHE ERROR " << name()
+              << " CLEANUP_HEAP_LOCK state"
+              << " hit but copy not found" << std::endl;
+            exit(0);
+          }
+
+#if DEBUG_MEMC_CLEANUP
+          if( m_debug_cleanup_fsm )
+          {
+            std::cout
+              << "  <MEMC " << name() << ".CLEANUP_HEAP_LOCK> Checks matching:"
+              << " line = " << r_cleanup_nline.read() * m_words * 4
+              << " / dir_id = " << r_cleanup_copy.read()
+              << " / dir_ins = " << r_cleanup_copy_inst.read()
+              << " / heap_id = " << heap_entry.owner.srcid
+              << " / heap_ins = " << heap_entry.owner.inst
+              << " / search_id = " << r_cleanup_srcid.read()
+              << " / search_ins = " << (r_cleanup_trdid.read()&0x1) << std::endl;
+          }
+#endif
+        }
+        else
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " CLEANUP_HEAP_LOCK state"
+            << " bad HEAP allocation" << std::endl;
+
+          exit(0);
+        }
+        break;
+      }
+
+      /////////////////////////
+      case CLEANUP_HEAP_SEARCH:  // This state is handling the case where the copy
+      // is in the heap, but is not the first in the linked list
+      {
+        if ( r_alloc_heap_fsm.read() != ALLOC_HEAP_CLEANUP )
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " CLEANUP_HEAP_SEARCH state"
+            << " bad HEAP allocation" << std::endl;
+          exit(0);
+        }
+
+        HeapEntry heap_entry  = m_heap.read(r_cleanup_next_ptr.read());
+        bool last             = (heap_entry.next == r_cleanup_next_ptr.read());
+        bool cleanup_inst     = r_cleanup_trdid.read() & 0x1;
+        bool match_heap_srcid = (heap_entry.owner.srcid == r_cleanup_srcid.read());
+        bool match_heap_inst  = (heap_entry.owner.inst  == cleanup_inst);
+        bool match_heap       = match_heap_srcid && match_heap_inst;
+#if L1_MULTI_CACHE
+        match_heap = match_heap and (heap_entry.owner.cache_id == r_cleanup_pktid.read());
+#endif
+
+#if DEBUG_MEMC_CLEANUP
+        if( m_debug_cleanup_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".CLEANUP_HEAP_SEARCH> Cheks matching:"
+            << " line = " << r_cleanup_nline.read() * m_words * 4
+            << " / heap_id = " << heap_entry.owner.srcid
+            << " / heap_ins = " << heap_entry.owner.inst
+            << " / search_id = " << r_cleanup_srcid.read()
+            << " / search_ins = " << (r_cleanup_trdid.read()&0x1)
+            << " / last = " << last << std::endl;
+        }
+#endif
+        if(match_heap) // the matching copy must be removed
+        {
+          r_cleanup_ptr = heap_entry.next; // reuse ressources
+          r_cleanup_fsm = CLEANUP_HEAP_CLEAN;
+        }
+        else
+        {
+          if ( last )
+          {
+            std::cout << "VCI_MEM_CACHE_ERROR " << name()
+              << " CLEANUP_HEAP_SEARCH state"
+              << " cleanup hit but copy not found" << std::endl;
+            exit(0);
+          }
+          else // test the next in the linked list
+          {
+            r_cleanup_prev_ptr      = r_cleanup_next_ptr.read();
+            r_cleanup_prev_srcid    = heap_entry.owner.srcid;
+#if L1_MULTI_CACHE
+            r_cleanup_prev_cache_id = heap_entry.owner.cache_id;
+#endif
+            r_cleanup_prev_inst     = heap_entry.owner.inst;
+            r_cleanup_next_ptr      = heap_entry.next;
+            r_cleanup_fsm           = CLEANUP_HEAP_SEARCH;
+
+#if DEBUG_MEMC_CLEANUP
+            if( m_debug_cleanup_fsm )
+            {
+              std::cout << "  <MEMC " << name() << ".CLEANUP_HEAP_SEARCH> Matching copy not found, search next:"
+                << " line = " << r_cleanup_nline.read() * m_words * 4
+                << " / heap_id = " << heap_entry.owner.srcid
+                << " / heap_ins = " << heap_entry.owner.inst
+                << " / search_id = " << r_cleanup_srcid.read()
+                << " / search_ins = " << (r_cleanup_trdid.read()&0x1) << std::endl;
+            }
+#endif
+          }
+        }
+        break;
+      }
+
+      ////////////////////////
+      case CLEANUP_HEAP_CLEAN:  // remove a copy in the linked list
+      {
+        if ( r_alloc_heap_fsm.read() != ALLOC_HEAP_CLEANUP )
+        {
+          std::cout << "VCI_MEM_CACHE ERROR " << name()
+            << " CLEANUP_HEAP_CLEAN state"
+            << "Bad HEAP allocation" << std::endl;
+          exit(0);
+        }
+
+        bool last = (r_cleanup_next_ptr.read() == r_cleanup_ptr.read());
+        HeapEntry heap_entry;
+        heap_entry.owner.srcid    = r_cleanup_prev_srcid.read();
+#if L1_MULTI_CACHE
+        heap_entry.owner.cache_id = r_cleanup_prev_cache_id.read();
+#endif
+        heap_entry.owner.inst     = r_cleanup_prev_inst.read();
+        
+        if(last) // this is the last entry of the list of copies
+        {
+          heap_entry.next     = r_cleanup_prev_ptr.read();
+        }
+        else  // this is not the last entry
+        {
+          heap_entry.next     = r_cleanup_ptr.read();
+        }
+
+        m_heap.write(r_cleanup_prev_ptr.read(),heap_entry);
+        r_cleanup_fsm = CLEANUP_HEAP_FREE;
+
+#if DEBUG_MEMC_CLEANUP
+        if( m_debug_cleanup_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".CLEANUP_HEAP_SEARCH> Remove the copy in the linked list" << std::endl;
+        }
+#endif
+        break;
+      }
+
+      ///////////////////////
+      case CLEANUP_HEAP_FREE:
+      // The heap entry pointed by r_cleanup_next_ptr is freed
+      // and becomes the head of the list of free entries
+      {
+        if ( r_alloc_heap_fsm.read() != ALLOC_HEAP_CLEANUP )
+        {
+          std::cout 
+            << "VCI_MEM_CACHE ERROR " << name()
+            << " CLEANUP_HEAP_CLEAN state" << std::endl
+            << "Bad HEAP allocation" << std::endl;
+
+          exit(0);
+        }
+
+        HeapEntry heap_entry;
+        heap_entry.owner.srcid    = 0;
+#if L1_MULTI_CACHE
+        heap_entry.owner.cache_id = 0;
+#endif
+        heap_entry.owner.inst     = false;
+
+        if(m_heap.is_full())
+        {
+          heap_entry.next = r_cleanup_next_ptr.read();
+        }
+        else
+        {
+          heap_entry.next = m_heap.next_free_ptr();
+        }
+
+        m_heap.write(r_cleanup_next_ptr.read(),heap_entry);
+        m_heap.write_free_ptr(r_cleanup_next_ptr.read());
+        m_heap.unset_full();
+
+        r_cleanup_fsm = CLEANUP_RSP;
+
+#if DEBUG_MEMC_CLEANUP
+        if( m_debug_cleanup_fsm )
+        {
+          std::cout << "  <MEMC " << name() << ".CLEANUP_HEAP_SEARCH> Update the list of free entries" << std::endl;
+        }
+#endif
+        break;
+      }
+
+      //////////////////////
+      case CLEANUP_UPT_LOCK:
+      {
+        if ( r_alloc_upt_fsm.read() == ALLOC_UPT_CLEANUP )
+        {
+          size_t index = 0;
+          bool hit_inval;
+          hit_inval = m_update_tab.search_inval(r_cleanup_nline.read(),index);
+
+          if ( !hit_inval ) // no pending inval
+          {
+
+#if DEBUG_MEMC_CLEANUP
+            if( m_debug_cleanup_fsm )
+            {
+              std::cout << "  <MEMC " << name() << ".CLEANUP_UPT_LOCK> Unexpected cleanup with no corresponding UPT entry:"
+                << " address = " << std::hex << (r_cleanup_nline.read()*4*m_words) << std::endl;
+            }
+#endif
+            r_cleanup_fsm = CLEANUP_RSP;
+          }
+          else    // pending inval
+          {
+            r_cleanup_write_srcid = m_update_tab.srcid(index);
+            r_cleanup_write_trdid = m_update_tab.trdid(index);
+            r_cleanup_write_pktid = m_update_tab.pktid(index);
+            r_cleanup_need_rsp    = m_update_tab.need_rsp(index);
+            r_cleanup_fsm = CLEANUP_UPT_WRITE;
+          }
+          r_cleanup_index.write(index) ;
+        }
+        break;
+      }
+
+      ///////////////////////
+      case CLEANUP_UPT_WRITE:  // decrement response counter
+      {
+        size_t count = 0;
+        m_update_tab.decrement(r_cleanup_index.read(), count);
+        if ( count == 0 )
+        {
+          m_update_tab.clear(r_cleanup_index.read());
+
+#if DEBUG_MEMC_CLEANUP
+          if( m_debug_cleanup_fsm )
+          {
+            std::cout << "  <MEMC " << name() << ".CLEANUP_UPT_WRITE> Decrement response counter in UPT:"
+              << " UPT_index = " << r_cleanup_index.read()
+              << " rsp_count = " << count << std::endl;
+          }
+#endif
+          if( r_cleanup_need_rsp.read() ) r_cleanup_fsm = CLEANUP_WRITE_RSP ;
+          else                      r_cleanup_fsm = CLEANUP_RSP;
+        }
+        else
+        {
+          r_cleanup_fsm = CLEANUP_RSP ;
+        }
+        break;
+      }
+
+      ///////////////////////
+      case CLEANUP_WRITE_RSP: // Response to a previous write on the direct network
+      {
+        if( !r_cleanup_to_tgt_rsp_req.read() )
+        {
+          r_cleanup_to_tgt_rsp_req     = true;
+          r_cleanup_to_tgt_rsp_srcid   = r_cleanup_write_srcid.read();
+          r_cleanup_to_tgt_rsp_trdid   = r_cleanup_write_trdid.read();
+          r_cleanup_to_tgt_rsp_pktid   = r_cleanup_write_pktid.read();
+          r_cleanup_fsm                = CLEANUP_RSP;
+
+#if DEBUG_MEMC_CLEANUP
+          if( m_debug_cleanup_fsm )
+          {
+            std::cout << "  <MEMC " << name() << ".CLEANUP_WRITE_RSP> Send a response to a cleanup request:"
+              << " rsrcid = " << std::dec << r_cleanup_write_srcid.read()
+              << " / rtrdid = " << std::dec << r_cleanup_write_trdid.read() << std::endl;
+          }
+#endif
+        }
+        break;
+      }
+
+      /////////////////
+      case CLEANUP_RSP: // Response to a cleanup on the coherence network
+      {
+        if ( p_vci_tgt_cleanup.rspack.read() )
+        {
+          r_cleanup_fsm = CLEANUP_IDLE;
+
+#if DEBUG_MEMC_CLEANUP
+          if( m_debug_cleanup_fsm )
+          {
+            std::cout << "  <MEMC " << name() << ".CLEANUP_RSP> Send the response to a cleanup request:"
+              << " rsrcid = " << std::dec << r_cleanup_write_srcid.read()
+              << " / rtrdid = " << r_cleanup_write_trdid.read() << std::endl;
+          }
+#endif
+        }
+        break;
+      }
+    } // end switch cleanup fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    CAS FSM
+    ////////////////////////////////////////////////////////////////////////////////////
+    // The CAS FSM handles the CAS (Store Conditionnal) atomic commands,
+    // that are handled as "compare-and-swap instructions.
+    //
+    // This command contains two or four flits:
+    // - In case of 32 bits atomic access, the first flit contains the value read
+    // by a previous LL instruction, the second flit contains the value to be writen.
+    // - In case of 64 bits atomic access, the 2 first flits contains the value read
+    // by a previous LL instruction, the 2 next flits contains the value to be writen.
+    //
+    // The target address is cachable. If it is replicated in other L1 caches
+    // than the writer, a coherence operation is done.
+    //
+    // It access the directory to check hit / miss.
+    // - In case of miss, the CAS FSM must register a GET transaction in TRT.
+    // If a read transaction to the XRAM for this line already exists,
+    // or if the transaction table is full, it goes to the WAIT state
+    // to release the locks and try again. When the GET transaction has been
+    // launched, it goes to the WAIT state and try again.
+    // The CAS request is not consumed in the FIFO until a HIT is obtained.
+    // - In case of hit...
+    ///////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_cas_fsm.read() )
+    {
+        /////////////
+        case CAS_IDLE:     // fill the local rdata buffers
+        {
+            if( m_cmd_cas_addr_fifo.rok() )
+            {
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_IDLE> CAS command: " << std::hex
+              << " srcid = " <<  std::dec << m_cmd_cas_srcid_fifo.read()
+              << " addr = " << std::hex << m_cmd_cas_addr_fifo.read()
+              << " wdata = " << m_cmd_cas_wdata_fifo.read()
+              << " eop = " << std::dec << m_cmd_cas_eop_fifo.read()
+              << " cpt  = " << std::dec << r_cas_cpt.read() << std::endl;
+}
+#endif
+                if( m_cmd_cas_eop_fifo.read() )
+                {
+                    m_cpt_cas++;
+                    r_cas_fsm = CAS_DIR_REQ;
+                }
+                else  // we keep the last word in the FIFO
+                {
+                    cmd_cas_fifo_get = true;
+                }
+                // We fill the two buffers
+                if ( r_cas_cpt.read() < 2 ) // 32 bits access
+                    r_cas_rdata[r_cas_cpt.read()] = m_cmd_cas_wdata_fifo.read();
+
+                if((r_cas_cpt.read() == 1) && m_cmd_cas_eop_fifo.read())
+                    r_cas_wdata = m_cmd_cas_wdata_fifo.read();
+
+                if( r_cas_cpt.read()>3 ) // more than 4 flits...
+                {
+                    std::cout << "VCI_MEM_CACHE ERROR in CAS_IDLE state : illegal CAS command"
+                              << std::endl;
+                    exit(0);
+                }
+
+                if ( r_cas_cpt.read()==2 )
+                    r_cas_wdata = m_cmd_cas_wdata_fifo.read();
+
+                r_cas_cpt = r_cas_cpt.read()+1;
+            }
+            break;
+        }
+        
+        /////////////////
+        case CAS_DIR_REQ:
+        {
+            if( r_alloc_dir_fsm.read() == ALLOC_DIR_CAS )
+            {
+              r_cas_fsm = CAS_DIR_LOCK;
+            }
+
+#if DEBUG_MEMC_CAS
+            if( m_debug_cas_fsm )
+            {
+              std::cout 
+                << "  <MEMC " << name() << ".CAS_DIR_REQ> Requesting DIR lock "
+                << std::endl;
+            }
+#endif
+            break;
+        }
+
+        /////////////////
+        case CAS_DIR_LOCK:  // Read the directory
+        {
+            if( r_alloc_dir_fsm.read() == ALLOC_DIR_CAS )
+            {
+                size_t way = 0;
+                DirectoryEntry entry(m_cache_directory.read(m_cmd_cas_addr_fifo.read(), way));
+
+                r_cas_is_cnt     = entry.is_cnt;
+                r_cas_dirty      = entry.dirty;
+                r_cas_tag        = entry.tag;
+                r_cas_way        = way;
+                r_cas_copy       = entry.owner.srcid;
+#if L1_MULTI_CACHE
+                r_cas_copy_cache = entry.owner.cache_id;
+#endif
+                r_cas_copy_inst  = entry.owner.inst;
+                r_cas_ptr        = entry.ptr;
+                r_cas_count      = entry.count;
+
+                if ( entry.valid )  r_cas_fsm = CAS_DIR_HIT_READ;
+                else          r_cas_fsm = CAS_MISS_TRT_LOCK;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_DIR_LOCK> Directory acces"
+              << " / address = " << std::hex << m_cmd_cas_addr_fifo.read()
+              << " / hit = " << std::dec << entry.valid
+              << " / count = " << entry.count
+              << " / is_cnt = " << entry.is_cnt << std::endl;
+}
+#endif
+            }
+            else
+            {
+              std::cout
+                << "VCI_MEM_CACHE ERROR " << name()
+                << " CAS_DIR_LOCK state" << std::endl
+                << "Bad DIR allocation"   << std::endl;
+
+              exit(0);
+            }
+
+            break;
+        }
+        /////////////////////
+        case CAS_DIR_HIT_READ:  // update directory for lock and dirty bit
+                               // and check data change in cache
+        {
+            size_t way  = r_cas_way.read();
+            size_t set  = m_y[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+            size_t word = m_x[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+
+            // update directory (lock & dirty bits)
+            DirectoryEntry entry;
+            entry.valid          = true;
+            entry.is_cnt         = r_cas_is_cnt.read();
+            entry.dirty          = true;
+            entry.lock           = true;
+            entry.tag          = r_cas_tag.read();
+            entry.owner.srcid    = r_cas_copy.read();
+#if L1_MULTI_CACHE
+            entry.owner.cache_id = r_cas_copy_cache.read();
+#endif
+            entry.owner.inst     = r_cas_copy_inst.read();
+            entry.count          = r_cas_count.read();
+            entry.ptr            = r_cas_ptr.read();
+
+            m_cache_directory.write(set, way, entry);
+
+            // read data in cache & check data change
+            bool ok = ( r_cas_rdata[0].read() == m_cache_data.read(way, set, word) );
+            if ( r_cas_cpt.read()==4 )  // 64 bits CAS
+                ok &= ( r_cas_rdata[1] == m_cache_data.read(way, set, word+1));
+
+            // to avoid livelock, force the atomic access to fail pseudo-randomly
+            bool forced_fail = ( (r_cas_lfsr % (64) == 0) && RANDOMIZE_CAS );
+            r_cas_lfsr = (r_cas_lfsr >> 1) ^ ((-(r_cas_lfsr & 1)) & 0xd0000001);
+
+            if( ok and not forced_fail )  // no data change
+            {
+                r_cas_fsm = CAS_DIR_HIT_WRITE;
+            }
+            else                            // return failure
+            {
+                r_cas_fsm = CAS_RSP_FAIL;
+            }
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_DIR_HIT_READ> Test if CAS success:"
+              << " / expected value = " << r_cas_rdata[0].read()
+              << " / actual value = " << m_cache_data.read(way, set, word)
+              << " / forced_fail = " << forced_fail << std::endl;
+}
+#endif
+            break;
+        }
+        //////////////////////
+        case CAS_DIR_HIT_WRITE:    // test if a CC transaction is required
+                                   // write data in cache if no CC request
+        {
+            // The CAS is a success => sw access to the llsc_global_table
+            m_llsc_table.sw(m_cmd_cas_addr_fifo.read());
+
+            // test coherence request
+            if(r_cas_count.read())   // replicated line
+            {
+                if ( r_cas_is_cnt.read() )
+                {
+                    r_cas_fsm = CAS_BC_TRT_LOCK;    // broadcast invalidate required
+                }
+                else if( !r_cas_to_init_cmd_multi_req.read() &&
+                         !r_cas_to_init_cmd_brdcast_req.read()  )
+                {
+                    r_cas_fsm = CAS_UPT_LOCK;     // multi update required
+                }
+                else
+                {
+                    r_cas_fsm = CAS_WAIT;
+                }
+            }
+            else                    // no copies
+            {
+                size_t way  = r_cas_way.read();
+                size_t set  = m_y[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                size_t word = m_x[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+
+                // cache update
+                m_cache_data.write(way, set, word, r_cas_wdata.read());
+                if(r_cas_cpt.read()==4)
+                    m_cache_data.write(way, set, word+1, m_cmd_cas_wdata_fifo.read());
+
+                // monitor
+                if ( m_monitor_ok )
+                {
+                    vci_addr_t address = m_cmd_cas_addr_fifo.read();
+                char buf[80];
+                snprintf(buf, 80, "CAS_DIR_HIT_WRITE srcid %d", m_cmd_cas_srcid_fifo.read());
+                    check_monitor( buf, address, r_cas_wdata.read() );
+                    if ( r_cas_cpt.read()==4 )
+                    check_monitor( buf, address+4, m_cmd_cas_wdata_fifo.read() );
+                }
+                r_cas_fsm = CAS_RSP_SUCCESS;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_DIR_HIT_WRITE> Update cache:"
+              << " way = " << std::dec << way
+              << " / set = " << set
+              << " / word = " << word
+              << " / value = " << r_cas_wdata.read()
+              << " / count = " << r_cas_count.read() << std::endl;
+    std::cout << "  <MEMC " << name() << ".CAS_DIR_HIT_WRITE> global_llsc_table SW access" << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        /////////////////
+        case CAS_UPT_LOCK:  // try to register the transaction in UPT
+                           // and write data in cache if successful registration
+                           // releases locks to retry later if UPT full
+        {
+            if ( r_alloc_upt_fsm.read() == ALLOC_UPT_CAS )
+            {
+                bool        wok        = false;
+                size_t      index      = 0;
+                size_t      srcid      = m_cmd_cas_srcid_fifo.read();
+                size_t      trdid      = m_cmd_cas_trdid_fifo.read();
+                size_t      pktid      = m_cmd_cas_pktid_fifo.read();
+                addr_t      nline      = m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                size_t      nb_copies  = r_cas_count.read();
+
+                wok = m_update_tab.set(true,  // it's an update transaction
+                                       false,   // it's not a broadcast
+                                       true,    // it needs a response
+                                       srcid,
+                                       trdid,
+                                       pktid,
+                                       nline,
+                                       nb_copies,
+                                       index);
+                if (wok)  // coherence transaction registered in UPT
+                {
+                    // cache update
+                    size_t way  = r_cas_way.read();
+                    size_t set  = m_y[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                    size_t word = m_x[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+
+                    m_cache_data.write(way, set, word, r_cas_wdata.read());
+                    if(r_cas_cpt.read()==4)
+                        m_cache_data.write(way, set, word+1, m_cmd_cas_wdata_fifo.read());
+
+                    // monitor
+                    if ( m_monitor_ok )
+                    {
+                        vci_addr_t address = m_cmd_cas_addr_fifo.read();
+                    char buf[80];
+                    snprintf(buf, 80, "CAS_DIR_HIT_WRITE srcid %d", m_cmd_cas_srcid_fifo.read());
+                        check_monitor( buf, address, r_cas_wdata.read() );
+                        if ( r_cas_cpt.read()==4 )
+                        check_monitor( buf, address+4, m_cmd_cas_wdata_fifo.read() );
+                    }
+
+                    r_cas_upt_index = index;
+                    r_cas_fsm = CAS_UPT_HEAP_LOCK;
+                }
+                else       //  releases the locks protecting UPT and DIR UPT full
+                {
+                    r_cas_fsm = CAS_WAIT;
+                }
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_UPT_LOCK> Register multi-update transaction in UPT"
+              << " / wok = " << wok
+              << " / nline  = " << std::hex << nline
+              << " / count = " << nb_copies << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        /////////////
+        case CAS_WAIT:   // release all locks and retry from beginning
+        {
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_WAIT> Release all locks" << std::endl;
+}
+#endif
+            r_cas_fsm = CAS_DIR_REQ;
+            break;
+        }
+        //////////////////
+        case CAS_UPT_HEAP_LOCK:  // lock the heap
+        {
+            if( r_alloc_heap_fsm.read() == ALLOC_HEAP_CAS )
+            {
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_UPT_HEAP_LOCK> Get access to the heap" << std::endl;
+}
+#endif
+                r_cas_fsm = CAS_UPT_REQ;
+            }
+            break;
+        }
+        ////////////////
+        case CAS_UPT_REQ:  // send a first update request to INIT_CMD FSM
+        {
+            assert((r_alloc_heap_fsm.read() == ALLOC_HEAP_CAS) and
+                   "VCI_MEM_CACHE ERROR : bad HEAP allocation");
+
+            if( !r_cas_to_init_cmd_multi_req.read() && !r_cas_to_init_cmd_brdcast_req.read() )
+            {
+                r_cas_to_init_cmd_brdcast_req  = false;
+                r_cas_to_init_cmd_trdid        = r_cas_upt_index.read();
+                r_cas_to_init_cmd_nline        = m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                r_cas_to_init_cmd_index        = m_x[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                r_cas_to_init_cmd_wdata        = r_cas_wdata.read();
+
+                if(r_cas_cpt.read() == 4)
+                {
+                    r_cas_to_init_cmd_is_long    = true;
+                    r_cas_to_init_cmd_wdata_high = m_cmd_cas_wdata_fifo.read();
+                }
+                else
+                {
+                    r_cas_to_init_cmd_is_long    = false;
+                    r_cas_to_init_cmd_wdata_high = 0;
+                }
+
+                // We put the first copy in the fifo
+                cas_to_init_cmd_fifo_put     = true;
+                cas_to_init_cmd_fifo_inst    = r_cas_copy_inst.read();
+                cas_to_init_cmd_fifo_srcid   = r_cas_copy.read();
+#if L1_MULTI_CACHE
+                cas_to_init_cmd_fifo_cache_id= r_cas_copy_cache.read();
+#endif
+                if(r_cas_count.read() == 1) // one single copy
+                {
+                    r_cas_fsm = CAS_IDLE;   // Response will be sent after receiving
+                                            // update responses
+                    cmd_cas_fifo_get            = true;
+                    r_cas_to_init_cmd_multi_req = true;
+                    r_cas_cpt = 0;
+                }
+                else      // several copies
+                {
+                    r_cas_fsm = CAS_UPT_NEXT;
+                }
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_UPT_REQ> Send the first update request to INIT_CMD FSM "
+              << " / address = " << std::hex << m_cmd_cas_addr_fifo.read()
+              << " / wdata = " << std::hex << r_cas_wdata.read()
+              << " / srcid = " << std::dec << r_cas_copy.read()
+              << " / inst = " << std::dec << r_cas_copy_inst.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        /////////////////
+        case CAS_UPT_NEXT:     // send a multi-update request to INIT_CMD FSM
+        {
+            assert((r_alloc_heap_fsm.read() == ALLOC_HEAP_CAS)
+                 and "VCI_MEM_CACHE ERROR : bad HEAP allocation");
+
+            HeapEntry entry = m_heap.read(r_cas_ptr.read());
+            cas_to_init_cmd_fifo_srcid    = entry.owner.srcid;
+#if L1_MULTI_CACHE
+            cas_to_init_cmd_fifo_cache_id = entry.owner.cache_id;
+#endif
+            cas_to_init_cmd_fifo_inst     = entry.owner.inst;
+            cas_to_init_cmd_fifo_put = true;
+
+            if( m_cas_to_init_cmd_inst_fifo.wok() ) // request accepted by INIT_CMD FSM
+            {
+                r_cas_ptr = entry.next;
+                if( entry.next == r_cas_ptr.read() )  // last copy
+                {
+                    r_cas_to_init_cmd_multi_req = true;
+                    r_cas_fsm = CAS_IDLE;   // Response will be sent after receiving
+                                            // all update responses
+                    cmd_cas_fifo_get = true;
+                    r_cas_cpt        = 0;
+                }
+            }
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_UPT_NEXT> Send the next update request to INIT_CMD FSM "
+              << " / address = " << std::hex << m_cmd_cas_addr_fifo.read()
+              << " / wdata = " << std::hex << r_cas_wdata.read()
+              << " / srcid = " << std::dec << entry.owner.srcid
+              << " / inst = " << std::dec << entry.owner.inst << std::endl;
+}
+#endif
+            break;
+        }
+        /////////////////////
+        case CAS_BC_TRT_LOCK:      // check the TRT to register a PUT transaction
+        {
+            if( r_alloc_trt_fsm.read() == ALLOC_TRT_CAS )
+            {
+                if( !r_cas_to_ixr_cmd_req )  // we can transfer the request to IXR_CMD FSM
+                {
+                    // fill the data buffer
+                    size_t way  = r_cas_way.read();
+                    size_t set  = m_y[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                        size_t word = m_x[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                    for(size_t i = 0; i<m_words; i++)
+                    {
+                        if (i == word)
+                        {
+                            r_cas_to_ixr_cmd_data[i] = r_cas_wdata.read();
+                        }
+                        else if ( (i == word+1) && (r_cas_cpt.read()==4) ) // 64 bit CAS
+                        {
+                            r_cas_to_ixr_cmd_data[i] = m_cmd_cas_wdata_fifo.read();
+                        }
+                        else
+                        {
+                            r_cas_to_ixr_cmd_data[i] = m_cache_data.read(way, set, i);
+                        }
+                    }
+                    size_t wok_index = 0;
+                    bool   wok       = !m_transaction_tab.full(wok_index);
+                    if ( wok )
+                    {
+                        r_cas_trt_index = wok_index;
+                        r_cas_fsm       = CAS_BC_UPT_LOCK;
+                    }
+                    else
+                    {
+                        r_cas_fsm       = CAS_WAIT;
+                    }
+                }
+                else
+                {
+                    r_cas_fsm = CAS_WAIT;
+                }
+            }
+            break;
+        }
+        ///////////////////
+        case CAS_BC_UPT_LOCK:  // register a broadcast inval transaction in UPT
+                              // write data in cache in case of successful registration
+        {
+            if ( r_alloc_upt_fsm.read() == ALLOC_UPT_CAS )
+            {
+                bool        wok       = false;
+                size_t      index     = 0;
+                size_t      srcid     = m_cmd_cas_srcid_fifo.read();
+                size_t      trdid     = m_cmd_cas_trdid_fifo.read();
+                size_t      pktid     = m_cmd_cas_pktid_fifo.read();
+                addr_t      nline     = m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                size_t      nb_copies = r_cas_count.read();
+
+                // register a broadcast inval transaction in UPT
+                wok = m_update_tab.set(false, // it's an inval transaction
+                                       true,    // it's a broadcast
+                                       true,    // it needs a response
+                                       srcid,
+                                       trdid,
+                                       pktid,
+                                       nline,
+                                       nb_copies,
+                                       index);
+
+                if ( wok )  // UPT not full
+                {
+                    // cache update
+                    size_t way  = r_cas_way.read();
+                    size_t set  = m_y[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                    size_t word = m_x[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+
+                    m_cache_data.write(way, set, word, r_cas_wdata.read());
+                    if(r_cas_cpt.read()==4)
+                        m_cache_data.write(way, set, word+1, m_cmd_cas_wdata_fifo.read());
+
+                    // monitor
+                    if ( m_monitor_ok )
+                    {
+                        vci_addr_t address = m_cmd_cas_addr_fifo.read();
+                    char buf[80];
+                    snprintf(buf, 80, "CAS_DIR_HIT_WRITE srcid %d", m_cmd_cas_srcid_fifo.read());
+                        check_monitor( buf, address, r_cas_wdata.read() );
+                        if ( r_cas_cpt.read()==4 )
+                        check_monitor( buf, address+4, m_cmd_cas_wdata_fifo.read() );
+                    }
+                    r_cas_upt_index = index;
+                    r_cas_fsm = CAS_BC_DIR_INVAL;
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_BC_UPT_LOCK> Register a broadcast inval transaction in UPT"
+              << " / nline = " << nline
+              << " / count = " << nb_copies
+              << " / upt_index = " << index << std::endl;
+}
+#endif
+                }
+                else      //  releases the lock protecting UPT
+                {
+                     r_cas_fsm = CAS_WAIT;
+                }
+            }
+            break;
+        }
+        //////////////////
+        case CAS_BC_DIR_INVAL:  // Register the PUT transaction in TRT, and inval the DIR entry
+        {
+            if ( (r_alloc_trt_fsm.read() == ALLOC_TRT_CAS ) &&
+                 (r_alloc_upt_fsm.read() == ALLOC_UPT_CAS ) &&
+                 (r_alloc_dir_fsm.read() == ALLOC_DIR_CAS ))
+            {
+                // set TRT
+                m_transaction_tab.set(r_cas_trt_index.read(),
+                                      false,    // PUT request to XRAM
+                                      m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())],
+                                      0,
+                                      0,
+                                      0,
+                                      false,    // not a processor read
+                                      0,
+                                      0,
+                                      std::vector<be_t>(m_words,0),
+                                      std::vector<data_t>(m_words,0));
+
+                // invalidate directory entry
+                DirectoryEntry entry;
+                entry.valid         = false;
+                entry.dirty         = false;
+                entry.tag         = 0;
+                entry.is_cnt        = false;
+                entry.lock          = false;
+                entry.count         = 0;
+                entry.owner.srcid   = 0;
+#if L1_MULTI_CACHE
+                entry.owner.cache_id= 0;
+#endif
+                entry.owner.inst    = false;
+                entry.ptr           = 0;
+                size_t set          = m_y[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                size_t way          = r_cas_way.read();
+                m_cache_directory.write(set, way, entry);
+
+                r_cas_fsm = CAS_BC_CC_SEND;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_BC_DIR_INVAL> Register the PUT in TRT and invalidate DIR entry"
+              << " / nline = " << std::hex << m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())]
+              << " / set = " << std::dec << set << " / way = " << way << std::endl;
+}
+#endif
+            }
+            else
+            {
+                assert(false and "LOCK ERROR in CAS_FSM, STATE = CAS_BC_DIR_INVAL");
+            }
+            break;
+        }
+        ///////////////////
+        case CAS_BC_CC_SEND:  // Request the broadcast inval to INIT_CMD FSM
+        {
+            if ( !r_cas_to_init_cmd_multi_req.read() &&
+                 !r_cas_to_init_cmd_brdcast_req.read())
+            {
+                r_cas_to_init_cmd_multi_req    = false;
+                r_cas_to_init_cmd_brdcast_req  = true;
+                r_cas_to_init_cmd_trdid        = r_cas_upt_index.read();
+                r_cas_to_init_cmd_nline        = m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                r_cas_to_init_cmd_index        = 0;
+                r_cas_to_init_cmd_wdata        = 0;
+
+                r_cas_fsm = CAS_BC_XRAM_REQ;
+            }
+            break;
+        }
+        ////////////////////
+        case CAS_BC_XRAM_REQ: // request the IXR FSM to start a put transaction
+        {
+            if ( !r_cas_to_ixr_cmd_req )
+            {
+                r_cas_to_ixr_cmd_req     = true;
+                r_cas_to_ixr_cmd_write   = true;
+                r_cas_to_ixr_cmd_nline   = m_nline[(vci_addr_t)(m_cmd_cas_addr_fifo.read())];
+                r_cas_to_ixr_cmd_trdid   = r_cas_trt_index.read();
+                r_cas_fsm                = CAS_IDLE;
+                cmd_cas_fifo_get         = true;
+                r_cas_cpt                = 0;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_BC_XRAM_REQ> Request a PUT transaction to IXR_CMD FSM" << std::hex
+              << " / nline = " << m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()]
+              << " / trt_index = " << r_cas_trt_index.read() << std::endl;
+}
+#endif
+            }
+            else
+            {
+               std::cout << "MEM_CACHE, CAS_BC_XRAM_REQ state : request should not have been previously set"
+                         << std::endl;
+            }
+            break;
+        }
+        /////////////////
+        case CAS_RSP_FAIL:  // request TGT_RSP FSM to send a failure response
+        {
+            if( !r_cas_to_tgt_rsp_req )
+            {
+                cmd_cas_fifo_get     = true;
+                r_cas_cpt              = 0;
+                r_cas_to_tgt_rsp_req = true;
+                r_cas_to_tgt_rsp_data  = 1;
+                r_cas_to_tgt_rsp_srcid = m_cmd_cas_srcid_fifo.read();
+                r_cas_to_tgt_rsp_trdid = m_cmd_cas_trdid_fifo.read();
+                r_cas_to_tgt_rsp_pktid = m_cmd_cas_pktid_fifo.read();
+                r_cas_fsm              = CAS_IDLE;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_RSP_FAIL> Request TGT_RSP to send a failure response" << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        ////////////////////
+        case CAS_RSP_SUCCESS:  // request TGT_RSP FSM to send a success response
+        {
+            if( !r_cas_to_tgt_rsp_req )
+            {
+                cmd_cas_fifo_get       = true;
+                r_cas_cpt              = 0;
+                r_cas_to_tgt_rsp_req = true;
+                r_cas_to_tgt_rsp_data  = 0;
+                r_cas_to_tgt_rsp_srcid = m_cmd_cas_srcid_fifo.read();
+                r_cas_to_tgt_rsp_trdid = m_cmd_cas_trdid_fifo.read();
+                r_cas_to_tgt_rsp_pktid = m_cmd_cas_pktid_fifo.read();
+                r_cas_fsm              = CAS_IDLE;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_RSP_SUCCESS> Request TGT_RSP to send a success response" << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        /////////////////////
+        case CAS_MISS_TRT_LOCK:         // cache miss : request access to transaction Table
+        {
+            if( r_alloc_trt_fsm.read() == ALLOC_TRT_CAS )
+            {
+                size_t   index = 0;
+                bool hit_read = m_transaction_tab.hit_read(
+                                  m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()],index);
+                bool hit_write = m_transaction_tab.hit_write(
+                                   m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()]);
+                bool wok = !m_transaction_tab.full(index);
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_MISS_TRT_LOCK> Check TRT state"
+              << " / hit_read = "  << hit_read
+              << " / hit_write = " << hit_write
+              << " / wok = " << wok
+              << " / index = " << index << std::endl;
+}
+#endif
+
+                if ( hit_read || !wok || hit_write ) // missing line already requested or no space in TRT
+                {
+                    r_cas_fsm = CAS_WAIT;
+                }
+                else
+                {
+                    r_cas_trt_index = index;
+                    r_cas_fsm       = CAS_MISS_TRT_SET;
+                }
+            }
+            break;
+        }
+        ////////////////////
+        case CAS_MISS_TRT_SET: // register the GET transaction in TRT
+        {
+            if( r_alloc_trt_fsm.read() == ALLOC_TRT_CAS )
+            {
+                std::vector<be_t> be_vector;
+                std::vector<data_t> data_vector;
+                be_vector.clear();
+                data_vector.clear();
+                for ( size_t i=0; i<m_words; i++ )
+                {
+                    be_vector.push_back(0);
+                    data_vector.push_back(0);
+                }
+
+                m_transaction_tab.set(r_cas_trt_index.read(),
+                                      true,   // read request
+                                      m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()],
+                                      m_cmd_cas_srcid_fifo.read(),
+                                      m_cmd_cas_trdid_fifo.read(),
+                                      m_cmd_cas_pktid_fifo.read(),
+                                      false,    // write request from processor
+                                      0,
+                                      0,
+                                      be_vector,
+                                      data_vector);
+                r_cas_fsm = CAS_MISS_XRAM_REQ;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_MISS_TRT_SET> Register a GET transaction in TRT" << std::hex
+              << " / nline = " << m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()]
+              << " / trt_index = " << r_cas_trt_index.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+        //////////////////////
+        case CAS_MISS_XRAM_REQ:  // request the IXR_CMD FSM to fetch the missing line
+        {
+            if ( !r_cas_to_ixr_cmd_req )
+            {
+                r_cas_to_ixr_cmd_req        = true;
+                r_cas_to_ixr_cmd_write      = false;
+                r_cas_to_ixr_cmd_trdid      = r_cas_trt_index.read();
+                r_cas_to_ixr_cmd_nline      = m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()];
+                r_cas_fsm                   = CAS_WAIT;
+
+#if DEBUG_MEMC_CAS
+if( m_debug_cas_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".CAS_MISS_XRAM_REQ> Request a GET transaction to IXR_CMD FSM" << std::hex
+              << " / nline = " << m_nline[(vci_addr_t)m_cmd_cas_addr_fifo.read()]
+              << " / trt_index = " << r_cas_trt_index.read() << std::endl;
+}
+#endif
+            }
+            break;
+        }
+    } // end switch r_cas_fsm
+
+
+    //////////////////////////////////////////////////////////////////////////////
+    //    INIT_CMD FSM
+    //////////////////////////////////////////////////////////////////////////////
+    // The INIT_CMD fsm controls the VCI CMD initiator port on the coherence
+    // network, used to update or invalidate cache lines in L1 caches.
+    //
+    // It implements a round-robin priority between the three possible client FSMs
+    // XRAM_RSP, WRITE and CAS. Each FSM can request two types of services:
+    // - r_xram_rsp_to_init_cmd_multi_req : multi-inval
+    //   r_xram_rsp_to_init_cmd_brdcast_req : broadcast-inval
+    // - r_write_to_init_cmd_multi_req : multi-update
+    //   r_write_to_init_cmd_brdcast_req : broadcast-inval
+    // - r_cas_to_init_cmd_multi_req : multi-update
+    //   r_cas_to_init_cmd_brdcast_req : broadcast-inval
+    //
+    // An inval request is a single cell VCI write command containing the
+    // index of the line to be invalidated.
+    // An update request is a multi-cells VCI write command : The first cell
+    // contains the index of the cache line to be updated. The second cell contains
+    // the index of the first modified word in the line. The following cells
+    // contain the data.
+    ///////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_init_cmd_fsm.read() )
+    {
+        ////////////////////////
+        case INIT_CMD_UPDT_IDLE:  // XRAM_RSP FSM has highest priority
+        {
+            if ( m_xram_rsp_to_init_cmd_inst_fifo.rok() ||
+                 r_xram_rsp_to_init_cmd_multi_req.read()  )
+            {
+                r_init_cmd_fsm = INIT_CMD_INVAL_NLINE;
+                m_cpt_inval++;
+            }
+            else if ( r_xram_rsp_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_XRAM_BRDCAST;
+                m_cpt_inval++;
+            }
+            else if ( m_write_to_init_cmd_inst_fifo.rok() ||
+                      r_write_to_init_cmd_multi_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_UPDT_NLINE;
+                m_cpt_update++;
+            }
+            else if ( r_write_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_WRITE_BRDCAST;
+                m_cpt_inval++;
+            }
+            else if ( m_cas_to_init_cmd_inst_fifo.rok() ||
+                      r_cas_to_init_cmd_multi_req.read()  )
+            {
+                r_init_cmd_fsm = INIT_CMD_CAS_UPDT_NLINE;
+                m_cpt_update++;
+            }
+            else if( r_cas_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_CAS_BRDCAST;
+                m_cpt_inval++;
+            }
+            break;
+        }
+        /////////////////////////
+        case INIT_CMD_INVAL_IDLE: // WRITE FSM has highest priority
+        {
+            if ( m_write_to_init_cmd_inst_fifo.rok() ||
+                 r_write_to_init_cmd_multi_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_UPDT_NLINE;
+                m_cpt_update++;
+            }
+            else if ( r_write_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_WRITE_BRDCAST;
+                m_cpt_inval++;
+            }
+            else if ( m_cas_to_init_cmd_inst_fifo.rok() ||
+                      r_cas_to_init_cmd_multi_req.read()  )
+            {
+                r_init_cmd_fsm = INIT_CMD_CAS_UPDT_NLINE;
+                m_cpt_update++;
+            }
+            else if( r_cas_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_CAS_BRDCAST;
+                m_cpt_inval++;
+            }
+            else if ( m_xram_rsp_to_init_cmd_inst_fifo.rok() ||
+                      r_xram_rsp_to_init_cmd_multi_req.read()  )
+            {
+                r_init_cmd_fsm = INIT_CMD_INVAL_NLINE;
+                m_cpt_inval++;
+            }
+            else if ( r_xram_rsp_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_XRAM_BRDCAST;
+                m_cpt_inval++;
+            }
+            break;
+        }
+        //////////////////////////
+        case INIT_CMD_CAS_UPDT_IDLE: // CAS FSM has highest priority
+        {
+            if ( m_cas_to_init_cmd_inst_fifo.rok() ||
+                 r_cas_to_init_cmd_multi_req.read()  )
+            {
+                r_init_cmd_fsm = INIT_CMD_CAS_UPDT_NLINE;
+                m_cpt_update++;
+            }
+            else if( r_cas_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_CAS_BRDCAST;
+                m_cpt_inval++;
+            }
+            else if ( m_xram_rsp_to_init_cmd_inst_fifo.rok() ||
+                      r_xram_rsp_to_init_cmd_multi_req.read()  )
+            {
+                r_init_cmd_fsm = INIT_CMD_INVAL_NLINE;
+                m_cpt_inval++;
+            }
+            else if ( r_xram_rsp_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_XRAM_BRDCAST;
+                m_cpt_inval++;
+            }
+            else if ( m_write_to_init_cmd_inst_fifo.rok() ||
+                      r_write_to_init_cmd_multi_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_UPDT_NLINE;
+                m_cpt_update++;
+            }
+            else if ( r_write_to_init_cmd_brdcast_req.read() )
+            {
+                r_init_cmd_fsm = INIT_CMD_WRITE_BRDCAST;
+                m_cpt_inval++;
+            }
+            break;
+        }
+        //////////////////////////
+        case INIT_CMD_INVAL_NLINE:  // send a multi-inval (from XRAM_RSP)
+        {
+            if ( m_xram_rsp_to_init_cmd_inst_fifo.rok() )
+            {
+                if ( p_vci_ini.cmdack )
+                {
+                    m_cpt_inval_mult++;
+                    r_init_cmd_fsm = INIT_CMD_INVAL_NLINE;
+                    xram_rsp_to_init_cmd_fifo_get = true;
+                }
+            }
+            else
+            {
+                if( r_xram_rsp_to_init_cmd_multi_req.read() ) r_xram_rsp_to_init_cmd_multi_req = false;
+                r_init_cmd_fsm = INIT_CMD_INVAL_IDLE;
+            }
+            break;
+        }
+        ///////////////////////////
+        case INIT_CMD_XRAM_BRDCAST: // send a broadcast-inval (from XRAM_RSP)
+        {
+            if ( p_vci_ini.cmdack )
+            {
+                m_cpt_inval_brdcast++;
+                r_init_cmd_fsm = INIT_CMD_INVAL_IDLE;
+                r_xram_rsp_to_init_cmd_brdcast_req = false;
+            }
+            break;
+        }
+        ////////////////////////////
+        case INIT_CMD_WRITE_BRDCAST:  // send a broadcast-inval (from WRITE FSM)
+        {
+            if( p_vci_ini.cmdack )
+            {
+
+#if DEBUG_MEMC_INIT_CMD
+if( m_debug_init_cmd_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".INIT_CMD_WRITE_BRDCAST> Broadcast-Inval for line "
+              << r_write_to_init_cmd_nline.read() << std::endl;
+}
+#endif
+                m_cpt_inval_brdcast++;
+                r_write_to_init_cmd_brdcast_req = false;
+                r_init_cmd_fsm = INIT_CMD_UPDT_IDLE;
+            }
+            break;
+        }
+        /////////////////////////
+        case INIT_CMD_UPDT_NLINE:  // send nline for a multi-update (from WRITE FSM)
+        {
+            if ( m_write_to_init_cmd_inst_fifo.rok() )
+            {
+                if ( p_vci_ini.cmdack )
+                {
+                    m_cpt_update_mult++;
+                    r_init_cmd_fsm = INIT_CMD_UPDT_INDEX;
+                    // write_to_init_cmd_fifo_get = true;
+                }
+            }
+            else
+            {
+                if ( r_write_to_init_cmd_multi_req.read() ) r_write_to_init_cmd_multi_req = false;
+                r_init_cmd_fsm = INIT_CMD_UPDT_IDLE;
+            }
+            break;
+        }
+        /////////////////////////
+        case INIT_CMD_UPDT_INDEX:  // send word index for a multi-update (from WRITE FSM)
+        {
+            r_init_cmd_cpt    = 0;
+            if ( p_vci_ini.cmdack )  r_init_cmd_fsm = INIT_CMD_UPDT_DATA;
+            break;
+        }
+        ////////////////////////
+        case INIT_CMD_UPDT_DATA:  // send the data for a multi-update (from WRITE FSM)
+        {
+            if ( p_vci_ini.cmdack )
+            {
+                if ( r_init_cmd_cpt.read() == (r_write_to_init_cmd_count.read()-1) )
+                {
+                    r_init_cmd_fsm = INIT_CMD_UPDT_NLINE;
+                    write_to_init_cmd_fifo_get = true;
+                }
+                else
+                {
+                    r_init_cmd_cpt = r_init_cmd_cpt.read() + 1;
+                }
+            }
+            break;
+        }
+        /////////////////////////
+        case INIT_CMD_CAS_BRDCAST: // send a broadcast-inval (from CAS FSM)
+        {
+            if( p_vci_ini.cmdack )
+            {
+                m_cpt_inval_brdcast++;
+                r_cas_to_init_cmd_brdcast_req = false;
+                r_init_cmd_fsm = INIT_CMD_CAS_UPDT_IDLE;
+            }
+            break;
+        }
+        ////////////////////////////
+        case INIT_CMD_CAS_UPDT_NLINE:   // send nline for a multi-update (from CAS FSM)
+        {
+            if ( m_cas_to_init_cmd_inst_fifo.rok() )
+            {
+                if ( p_vci_ini.cmdack )
+                {
+                    m_cpt_update_mult++;
+                    r_init_cmd_fsm = INIT_CMD_CAS_UPDT_INDEX;
+                }
+            }
+            else
+            {
+                if( r_cas_to_init_cmd_multi_req.read() ) r_cas_to_init_cmd_multi_req = false;
+                r_init_cmd_fsm = INIT_CMD_CAS_UPDT_IDLE;
+            }
+            break;
+        }
+        ////////////////////////////
+        case INIT_CMD_CAS_UPDT_INDEX:  // send word index for a multi-update (from CAS FSM)
+        {
+            if ( p_vci_ini.cmdack )  r_init_cmd_fsm = INIT_CMD_CAS_UPDT_DATA;
+            break;
+        }
+        ///////////////////////////
+        case INIT_CMD_CAS_UPDT_DATA:  // send first data for a multi-update (from CAS FSM)
+        {
+            if ( p_vci_ini.cmdack )
+            {
+                if ( r_cas_to_init_cmd_is_long.read() )
+                {
+                    r_init_cmd_fsm = INIT_CMD_CAS_UPDT_DATA_HIGH;
+                }
+                else
+                {
+                    cas_to_init_cmd_fifo_get = true;
+                    r_init_cmd_fsm = INIT_CMD_CAS_UPDT_NLINE;
+                }
+            }
+            break;
+        }
+        ////////////////////////
+        case INIT_CMD_CAS_UPDT_DATA_HIGH:  // send second data for a multi-update (from CAS FSM)
+        {
+            if ( p_vci_ini.cmdack )
+            {
+                cas_to_init_cmd_fifo_get = true;
+                r_init_cmd_fsm = INIT_CMD_CAS_UPDT_NLINE;
+            }
+            break;
+        }
+    } // end switch r_init_cmd_fsm
+
+    /////////////////////////////////////////////////////////////////////
+    //    TGT_RSP FSM
+    /////////////////////////////////////////////////////////////////////
+    // The TGT_RSP fsm sends the responses on the VCI target port
+    // with a round robin priority between six requests :
+    // - r_read_to_tgt_rsp_req
+    // - r_write_to_tgt_rsp_req
+    // - r_cas_to_tgt_rsp_req
+    // - r_cleanup_to_tgt_rsp_req
+    // - r_xram_rsp_to_tgt_rsp_req
+    // - r_init_rsp_to_tgt_rsp_req
+    // The  ordering is :  read > write > cas > xram > init > cleanup
+    /////////////////////////////////////////////////////////////////////
+
+    switch ( r_tgt_rsp_fsm.read() )
+    {
+        ///////////////////////
+        case TGT_RSP_READ_IDLE:   // write requests have the highest priority
+        {
+          if      ( r_write_to_tgt_rsp_req    ) r_tgt_rsp_fsm = TGT_RSP_WRITE;
+          else if ( r_cas_to_tgt_rsp_req      ) r_tgt_rsp_fsm = TGT_RSP_CAS  ;
+          else if ( r_xram_rsp_to_tgt_rsp_req )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_XRAM;
+            r_tgt_rsp_cpt = r_xram_rsp_to_tgt_rsp_word.read();
+          }
+          else if ( r_init_rsp_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_INIT   ;
+          else if ( r_cleanup_to_tgt_rsp_req  ) r_tgt_rsp_fsm = TGT_RSP_CLEANUP;
+          else if ( r_read_to_tgt_rsp_req     )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_READ;
+            r_tgt_rsp_cpt = r_read_to_tgt_rsp_word.read();
+          }
+          break;
+        }
+        ////////////////////////
+        case TGT_RSP_WRITE_IDLE:  // cas requests have the highest priority
+        {
+          if      ( r_cas_to_tgt_rsp_req      ) r_tgt_rsp_fsm = TGT_RSP_CAS;
+          else if ( r_xram_rsp_to_tgt_rsp_req )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_XRAM;
+            r_tgt_rsp_cpt = r_xram_rsp_to_tgt_rsp_word.read();
+          }
+          else if ( r_init_rsp_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_INIT   ;
+          else if ( r_cleanup_to_tgt_rsp_req  ) r_tgt_rsp_fsm = TGT_RSP_CLEANUP;
+          else if ( r_read_to_tgt_rsp_req     )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_READ;
+            r_tgt_rsp_cpt = r_read_to_tgt_rsp_word.read();
+          }
+
+          else if ( r_write_to_tgt_rsp_req    ) r_tgt_rsp_fsm = TGT_RSP_WRITE;
+          break;
+        }
+        ///////////////////////
+        case TGT_RSP_CAS_IDLE:   // xram_rsp requests have the highest priority
+        {
+          if ( r_xram_rsp_to_tgt_rsp_req )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_XRAM;
+            r_tgt_rsp_cpt = r_xram_rsp_to_tgt_rsp_word.read();
+          }
+          else if ( r_init_rsp_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_INIT   ;
+          else if ( r_cleanup_to_tgt_rsp_req  ) r_tgt_rsp_fsm = TGT_RSP_CLEANUP;
+          else if ( r_read_to_tgt_rsp_req     )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_READ;
+            r_tgt_rsp_cpt = r_read_to_tgt_rsp_word.read();
+          }
+          else if ( r_write_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_WRITE;
+          else if ( r_cas_to_tgt_rsp_req   ) r_tgt_rsp_fsm = TGT_RSP_CAS  ;
+          break;
+        }
+        ///////////////////////
+        case TGT_RSP_XRAM_IDLE:   // init requests have the highest priority
+        {
+
+          if      ( r_init_rsp_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_INIT   ;
+          else if ( r_cleanup_to_tgt_rsp_req  ) r_tgt_rsp_fsm = TGT_RSP_CLEANUP;
+          else if ( r_read_to_tgt_rsp_req     )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_READ;
+            r_tgt_rsp_cpt = r_read_to_tgt_rsp_word.read();
+          }
+          else if ( r_write_to_tgt_rsp_req    ) r_tgt_rsp_fsm = TGT_RSP_WRITE;
+          else if ( r_cas_to_tgt_rsp_req      ) r_tgt_rsp_fsm = TGT_RSP_CAS  ;
+          else if ( r_xram_rsp_to_tgt_rsp_req )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_XRAM;
+            r_tgt_rsp_cpt = r_xram_rsp_to_tgt_rsp_word.read();
+          }
+          break;
+        }
+        ///////////////////////
+        case TGT_RSP_INIT_IDLE:   // cleanup requests have the highest priority
+        {
+          if      ( r_cleanup_to_tgt_rsp_req  ) r_tgt_rsp_fsm = TGT_RSP_CLEANUP;
+          else if ( r_read_to_tgt_rsp_req     )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_READ;
+            r_tgt_rsp_cpt = r_read_to_tgt_rsp_word.read();
+          }
+          else if ( r_write_to_tgt_rsp_req    ) r_tgt_rsp_fsm = TGT_RSP_WRITE;
+          else if ( r_cas_to_tgt_rsp_req      ) r_tgt_rsp_fsm = TGT_RSP_CAS  ;
+          else if ( r_xram_rsp_to_tgt_rsp_req )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_XRAM;
+            r_tgt_rsp_cpt = r_xram_rsp_to_tgt_rsp_word.read();
+          }
+          else if ( r_init_rsp_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_INIT;
+          break;
+        }
+        ///////////////////////
+        case TGT_RSP_CLEANUP_IDLE:    // read requests have the highest priority
+        {
+          if      ( r_read_to_tgt_rsp_req     )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_READ;
+            r_tgt_rsp_cpt = r_read_to_tgt_rsp_word.read();
+          }
+          else if ( r_write_to_tgt_rsp_req    ) r_tgt_rsp_fsm = TGT_RSP_WRITE;
+          else if ( r_cas_to_tgt_rsp_req      ) r_tgt_rsp_fsm = TGT_RSP_CAS  ;
+          else if ( r_xram_rsp_to_tgt_rsp_req )
+          {
+            r_tgt_rsp_fsm = TGT_RSP_XRAM;
+            r_tgt_rsp_cpt = r_xram_rsp_to_tgt_rsp_word.read();
+          }
+          else if ( r_init_rsp_to_tgt_rsp_req ) r_tgt_rsp_fsm = TGT_RSP_INIT   ;
+          else if ( r_cleanup_to_tgt_rsp_req  ) r_tgt_rsp_fsm = TGT_RSP_CLEANUP;
+          break;
+        }
+        //////////////////
+        case TGT_RSP_READ:    // send the response to a read
+        {
+            if ( p_vci_tgt.rspack )
+            {
+
+#if DEBUG_MEMC_TGT_RSP
+if( m_debug_tgt_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".TGT_RSP_READ> Read response"
+              << " / rsrcid = " << std::dec << r_read_to_tgt_rsp_srcid.read()
+              << " / rtrdid = " << r_read_to_tgt_rsp_trdid.read()
+              << " / rpktid = " << r_read_to_tgt_rsp_pktid.read()
+              << " / rdata = " << std::hex << r_read_to_tgt_rsp_data[r_tgt_rsp_cpt.read()].read()
+              << " / cpt = " << std::dec << r_tgt_rsp_cpt.read() << std::endl;
+}
+#endif
+                if ( r_tgt_rsp_cpt.read() == (r_read_to_tgt_rsp_word.read()+r_read_to_tgt_rsp_length-1) )
+                {
+                    r_tgt_rsp_fsm = TGT_RSP_READ_IDLE;
+                    r_read_to_tgt_rsp_req = false;
+                }
+                else
+                {
+                    r_tgt_rsp_cpt = r_tgt_rsp_cpt.read() + 1;
+                }
+            }
+            break;
+        }
+        ///////////////////
+        case TGT_RSP_WRITE:   // send the write acknowledge
+        {
+            if ( p_vci_tgt.rspack )
+            {
+
+#if DEBUG_MEMC_TGT_RSP
+if( m_debug_tgt_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".TGT_RSP_WRITE> Write response"
+              << " / rsrcid = " << std::dec << r_write_to_tgt_rsp_srcid.read()
+              << " / rtrdid = " << r_write_to_tgt_rsp_trdid.read()
+              << " / rpktid = " << r_write_to_tgt_rsp_pktid.read() << std::endl;
+}
+#endif
+                r_tgt_rsp_fsm = TGT_RSP_WRITE_IDLE;
+                r_write_to_tgt_rsp_req = false;
+            }
+            break;
+        }
+        ///////////////////
+        case TGT_RSP_CLEANUP:   // pas clair pour moi (AG)
+        {
+            if ( p_vci_tgt.rspack )
+            {
+
+#if DEBUG_MEMC_TGT_RSP
+if( m_debug_tgt_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".TGT_RSP_CLEANUP> Cleanup response"
+              << " / rsrcid = " << std::dec << r_cleanup_to_tgt_rsp_srcid.read()
+              << " / rtrdid = " << r_cleanup_to_tgt_rsp_trdid.read()
+              << " / rpktid = " << r_cleanup_to_tgt_rsp_pktid.read() << std::endl;
+}
+#endif
+                r_tgt_rsp_fsm = TGT_RSP_CLEANUP_IDLE;
+                r_cleanup_to_tgt_rsp_req = false;
+            }
+            break;
+        }
+        //////////////////
+        case TGT_RSP_CAS:    // send one atomic word response
+        {
+            if ( p_vci_tgt.rspack )
+            {
+
+#if DEBUG_MEMC_TGT_RSP
+if( m_debug_tgt_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".TGT_RSP_CAS> CAS response"
+              << " / rsrcid = " << std::dec << r_cas_to_tgt_rsp_srcid.read()
+              << " / rtrdid = " << r_cas_to_tgt_rsp_trdid.read()
+              << " / rpktid = " << r_cas_to_tgt_rsp_pktid.read() << std::endl;
+}
+#endif
+                r_tgt_rsp_fsm = TGT_RSP_CAS_IDLE;
+                r_cas_to_tgt_rsp_req = false;
+            }
+            break;
+        }
+
+        ///////////////////////
+        case TGT_RSP_XRAM:    // send the response after XRAM access
+        {
+            if ( p_vci_tgt.rspack )
+            {
+
+#if DEBUG_MEMC_TGT_RSP
+if( m_debug_tgt_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".TGT_RSP_XRAM> Response following XRAM access"
+              << " / rsrcid = " << std::dec << r_xram_rsp_to_tgt_rsp_srcid.read()
+              << " / rtrdid = " << r_xram_rsp_to_tgt_rsp_trdid.read()
+              << " / rpktid = " << r_xram_rsp_to_tgt_rsp_pktid.read()
+              << " / rdata = " << std::hex << r_xram_rsp_to_tgt_rsp_data[r_tgt_rsp_cpt.read()].read()
+              << " / cpt = " << std::dec << r_tgt_rsp_cpt.read() << std::endl;
+}
+#endif
+                if ( (r_tgt_rsp_cpt.read() ==
+                     (r_xram_rsp_to_tgt_rsp_word.read()+r_xram_rsp_to_tgt_rsp_length.read()-1))
+                   || r_xram_rsp_to_tgt_rsp_rerror.read() )
+                {
+                    r_tgt_rsp_fsm = TGT_RSP_XRAM_IDLE;
+                    r_xram_rsp_to_tgt_rsp_req = false;
+                }
+                else
+                {
+                    r_tgt_rsp_cpt = r_tgt_rsp_cpt.read() + 1;
+                }
+            }
+            break;
+        }
+        //////////////////
+        case TGT_RSP_INIT:    // send the write response after coherence transaction
+        {
+            if ( p_vci_tgt.rspack )
+            {
+
+#if DEBUG_MEMC_TGT_RSP
+if( m_debug_tgt_rsp_fsm )
+{
+    std::cout << "  <MEMC " << name() << ".TGT_RSP_INIT> Write response after coherence transaction"
+              << " / rsrcid = " << std::dec << r_init_rsp_to_tgt_rsp_srcid.read()
+              << " / rtrdid = " << r_init_rsp_to_tgt_rsp_trdid.read()
+              << " / rpktid = " << r_init_rsp_to_tgt_rsp_pktid.read() << std::endl;
+}
+#endif
+                r_tgt_rsp_fsm = TGT_RSP_INIT_IDLE;
+                r_init_rsp_to_tgt_rsp_req = false;
+            }
+            break;
+        }
+    } // end switch tgt_rsp_fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    ALLOC_UPT FSM
+    ////////////////////////////////////////////////////////////////////////////////////
+    // The ALLOC_UPT FSM allocates the access to the Update/Inval Table (UPT).
+    // with a round robin priority between three FSMs : INIT_RSP > WRITE > XRAM_RSP > CLEANUP
+    // - The WRITE FSM initiates update transactions and sets  new entry in UPT.
+    // - The XRAM_RSP FSM initiates inval transactions and sets  new entry in UPT.
+    // - The INIT_RSP FSM complete those trasactions and erase the UPT entry.
+    // - The CLEANUP  FSM decrement an entry in UPT.
+    // The resource is always allocated.
+    /////////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_alloc_upt_fsm.read() )
+    {
+
+      ////////////////////////
+      case ALLOC_UPT_INIT_RSP:
+        if (( r_init_rsp_fsm.read() != INIT_RSP_UPT_LOCK  ) &&
+            ( r_init_rsp_fsm.read() != INIT_RSP_UPT_CLEAR ))
+        {
+          if (( r_write_fsm.read() == WRITE_UPT_LOCK    ) ||
+              ( r_write_fsm.read() == WRITE_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_WRITE;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_INVAL_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_XRAM_RSP;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_CLEANUP;
+
+          else if (( r_cas_fsm.read() == CAS_UPT_LOCK    ) ||
+                   ( r_cas_fsm.read() == CAS_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_CAS;
+        }
+        break;
+
+        /////////////////////
+      case ALLOC_UPT_WRITE:
+        if (( r_write_fsm.read() != WRITE_UPT_LOCK    ) &&
+            ( r_write_fsm.read() != WRITE_BC_UPT_LOCK ))
+        {
+          if ( r_xram_rsp_fsm.read() == XRAM_RSP_INVAL_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_XRAM_RSP;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_CLEANUP;
+
+          else if (( r_cas_fsm.read() == CAS_UPT_LOCK    ) ||
+                   ( r_cas_fsm.read() == CAS_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_CAS;
+
+          else if ( r_init_rsp_fsm.read() == INIT_RSP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_INIT_RSP;
+        }
+        break;
+
+        ////////////////////////
+      case ALLOC_UPT_XRAM_RSP:
+        if (r_xram_rsp_fsm.read() != XRAM_RSP_INVAL_LOCK)
+        {
+          if ( r_cleanup_fsm.read() == CLEANUP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_CLEANUP;
+
+          else if (( r_cas_fsm.read() == CAS_UPT_LOCK    ) ||
+                   ( r_cas_fsm.read() == CAS_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_CAS;
+
+          else if ( r_init_rsp_fsm.read() == INIT_RSP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_INIT_RSP;
+
+          else if (( r_write_fsm.read() == WRITE_UPT_LOCK    )   ||
+                   ( r_write_fsm.read() == WRITE_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_WRITE;
+        }
+        break;
+
+        //////////////////////////
+      case ALLOC_UPT_CLEANUP:
+        if(r_cleanup_fsm.read() != CLEANUP_UPT_LOCK )
+        {
+          if (( r_cas_fsm.read() == CAS_UPT_LOCK    ) ||
+              ( r_cas_fsm.read() == CAS_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_CAS;
+
+          else if ( r_init_rsp_fsm.read() == INIT_RSP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_INIT_RSP;
+
+          else if (( r_write_fsm.read() == WRITE_UPT_LOCK    ) ||
+                   ( r_write_fsm.read() == WRITE_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_WRITE;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_INVAL_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_XRAM_RSP;
+        }
+        break;
+
+        //////////////////////////
+      case ALLOC_UPT_CAS:
+        if (( r_cas_fsm.read() != CAS_UPT_LOCK    ) &&
+            ( r_cas_fsm.read() != CAS_BC_UPT_LOCK ))
+        {
+          if ( r_init_rsp_fsm.read() == INIT_RSP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_INIT_RSP;
+
+          else if (( r_write_fsm.read() == WRITE_UPT_LOCK    ) ||
+                   ( r_write_fsm.read() == WRITE_BC_UPT_LOCK ))
+            r_alloc_upt_fsm = ALLOC_UPT_WRITE;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_INVAL_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_XRAM_RSP;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_UPT_LOCK )
+            r_alloc_upt_fsm = ALLOC_UPT_CLEANUP;
+        }
+        break;
+
+    } // end switch r_alloc_upt_fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    ALLOC_DIR FSM
+    ////////////////////////////////////////////////////////////////////////////////////
+    // The ALLOC_DIR FSM allocates the access to the directory and
+    // the data cache with a round robin priority between 5 user FSMs :
+    // The cyclic ordering is READ > WRITE > CAS > CLEANUP > XRAM_RSP
+    // The ressource is always allocated.
+    /////////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_alloc_dir_fsm.read() )
+    {
+      case ALLOC_DIR_RESET:
+        // Initializes the directory one SET each cycle. All the WAYS of a SET are
+        // initialize in parallel
+
+        r_alloc_dir_reset_cpt.write(r_alloc_dir_reset_cpt.read() + 1);
+
+        if (r_alloc_dir_reset_cpt.read() == (m_sets - 1)) {
+          m_cache_directory.init();
+
+          r_alloc_dir_fsm = ALLOC_DIR_READ;
+        }
+        break;
+
+      ////////////////////
+      case ALLOC_DIR_READ:
+        if ((( r_read_fsm.read()       != READ_DIR_REQ    )   &&
+             ( r_read_fsm.read()       != READ_DIR_LOCK   )   &&
+             ( r_read_fsm.read()       != READ_TRT_LOCK   )   &&
+             ( r_read_fsm.read()       != READ_HEAP_REQ   ))
+            ||
+            (( r_read_fsm.read()       == READ_TRT_LOCK   )   &&
+             ( r_alloc_trt_fsm.read()  == ALLOC_TRT_READ  )))
+        {
+          if (r_write_fsm.read() == WRITE_DIR_REQ)
+            r_alloc_dir_fsm = ALLOC_DIR_WRITE;
+
+          else if (r_cas_fsm.read() == CAS_DIR_REQ)
+            r_alloc_dir_fsm = ALLOC_DIR_CAS;
+
+          else if (r_cleanup_fsm.read() == CLEANUP_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CLEANUP;
+
+          else if (r_xram_rsp_fsm.read() == XRAM_RSP_DIR_LOCK)
+            r_alloc_dir_fsm = ALLOC_DIR_XRAM_RSP;
+        }
+        break;
+
+        /////////////////////
+      case ALLOC_DIR_WRITE:
+        if ((( r_write_fsm.read()      != WRITE_DIR_REQ       )  &&
+             ( r_write_fsm.read()      != WRITE_DIR_LOCK      )  &&
+             ( r_write_fsm.read()      != WRITE_DIR_READ      )  &&
+             ( r_write_fsm.read()      != WRITE_DIR_HIT       )  &&
+             ( r_write_fsm.read()      != WRITE_BC_TRT_LOCK   )  &&
+             ( r_write_fsm.read()      != WRITE_BC_UPT_LOCK   )  &&
+             ( r_write_fsm.read()      != WRITE_MISS_TRT_LOCK )  &&
+             ( r_write_fsm.read()      != WRITE_UPT_LOCK      )  &&
+             ( r_write_fsm.read()      != WRITE_UPT_HEAP_LOCK ))
+            ||
+            (( r_write_fsm.read()      == WRITE_UPT_HEAP_LOCK )  &&
+             ( r_alloc_heap_fsm.read() == ALLOC_HEAP_WRITE    ))
+            ||
+            (( r_write_fsm.read()      == WRITE_MISS_TRT_LOCK )  &&
+             ( r_alloc_trt_fsm.read()  == ALLOC_TRT_WRITE     )))
+        {
+          if ( r_cas_fsm.read() == CAS_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CAS;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CLEANUP;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_DIR_LOCK )
+            r_alloc_dir_fsm = ALLOC_DIR_XRAM_RSP;
+
+          else if ( r_read_fsm.read() == READ_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_READ;
+        }
+        break;
+
+        ////////////////////
+        case ALLOC_DIR_CAS:
+        if ((( r_cas_fsm.read()        != CAS_DIR_REQ       )  &&
+             ( r_cas_fsm.read()        != CAS_DIR_LOCK      )  &&
+             ( r_cas_fsm.read()        != CAS_DIR_HIT_READ  )  &&
+             ( r_cas_fsm.read()        != CAS_DIR_HIT_WRITE )  &&
+             ( r_cas_fsm.read()        != CAS_BC_TRT_LOCK   )  &&
+             ( r_cas_fsm.read()        != CAS_BC_UPT_LOCK   )  &&
+             ( r_cas_fsm.read()        != CAS_MISS_TRT_LOCK )  &&
+             ( r_cas_fsm.read()        != CAS_UPT_LOCK      )  &&
+             ( r_cas_fsm.read()        != CAS_UPT_HEAP_LOCK ))
+            ||
+            (( r_cas_fsm.read()        == CAS_UPT_HEAP_LOCK )  &&
+             ( r_alloc_heap_fsm.read() == ALLOC_HEAP_CAS    ))
+            ||
+            (( r_cas_fsm.read()        == CAS_MISS_TRT_LOCK )  &&
+             ( r_alloc_trt_fsm.read()  == ALLOC_TRT_CAS     )))
+        {
+          if ( r_cleanup_fsm.read() == CLEANUP_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CLEANUP;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_DIR_LOCK )
+            r_alloc_dir_fsm = ALLOC_DIR_XRAM_RSP;
+
+          else if ( r_read_fsm.read() == READ_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_READ;
+
+          else if ( r_write_fsm.read() == WRITE_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_WRITE;
+        }
+        break;
+
+        ///////////////////////
+        case ALLOC_DIR_CLEANUP:
+        if (( r_cleanup_fsm.read() != CLEANUP_DIR_REQ   ) &&
+            ( r_cleanup_fsm.read() != CLEANUP_DIR_LOCK  ) &&
+            ( r_cleanup_fsm.read() != CLEANUP_HEAP_REQ  ) &&
+            ( r_cleanup_fsm.read() != CLEANUP_HEAP_LOCK ))
+        {
+          if ( r_xram_rsp_fsm.read() == XRAM_RSP_DIR_LOCK )
+            r_alloc_dir_fsm = ALLOC_DIR_XRAM_RSP;
+
+          else if ( r_read_fsm.read() == READ_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_READ;
+
+          else if ( r_write_fsm.read() == WRITE_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_WRITE;
+
+          else if ( r_cas_fsm.read() == CAS_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CAS;
+        }
+        break;
+
+        ////////////////////////
+        case ALLOC_DIR_XRAM_RSP:
+        if (( r_xram_rsp_fsm.read() != XRAM_RSP_DIR_LOCK   ) &&
+            ( r_xram_rsp_fsm.read() != XRAM_RSP_TRT_COPY   ) &&
+            ( r_xram_rsp_fsm.read() != XRAM_RSP_INVAL_LOCK ))
+        {
+          if ( r_read_fsm.read() == READ_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_READ;
+
+          else if ( r_write_fsm.read() == WRITE_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_WRITE;
+
+          else if ( r_cas_fsm.read() == CAS_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CAS;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_DIR_REQ )
+            r_alloc_dir_fsm = ALLOC_DIR_CLEANUP;
+        }
+        break;
+
+    } // end switch alloc_dir_fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    ALLOC_TRT FSM
+    ////////////////////////////////////////////////////////////////////////////////////
+    // The ALLOC_TRT fsm allocates the access to the Transaction Table (write buffer)
+    // with a round robin priority between 4 user FSMs :
+    // The cyclic priority is READ > WRITE > CAS > XRAM_RSP
+    // The ressource is always allocated.
+    ///////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_alloc_trt_fsm.read() )
+    {
+      ////////////////////
+      case ALLOC_TRT_READ:
+        if ( r_read_fsm.read() != READ_TRT_LOCK )
+        {
+          if (( r_write_fsm.read() == WRITE_MISS_TRT_LOCK ) ||
+              ( r_write_fsm.read() == WRITE_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_WRITE;
+
+          else if (( r_cas_fsm.read() == CAS_MISS_TRT_LOCK ) ||
+                   ( r_cas_fsm.read() == CAS_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_CAS;
+
+          else if (( r_xram_rsp_fsm.read()  == XRAM_RSP_DIR_LOCK  ) &&
+                   ( r_alloc_dir_fsm.read() == ALLOC_DIR_XRAM_RSP ))
+            r_alloc_trt_fsm = ALLOC_TRT_XRAM_RSP;
+
+          else if (( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_ERASE ) ||
+                   ( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_READ  ))
+            r_alloc_trt_fsm = ALLOC_TRT_IXR_RSP;
+        }
+        break;
+
+      /////////////////////
+      case ALLOC_TRT_WRITE:
+        if (( r_write_fsm.read() != WRITE_MISS_TRT_LOCK ) &&
+            ( r_write_fsm.read() != WRITE_BC_TRT_LOCK   ) &&
+            ( r_write_fsm.read() != WRITE_BC_UPT_LOCK   ))
+        {
+          if (( r_cas_fsm.read() == CAS_MISS_TRT_LOCK ) ||
+              ( r_cas_fsm.read() == CAS_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_CAS;
+
+          else if (( r_xram_rsp_fsm.read()  == XRAM_RSP_DIR_LOCK  ) &&
+                   ( r_alloc_dir_fsm.read() == ALLOC_DIR_XRAM_RSP ))
+            r_alloc_trt_fsm = ALLOC_TRT_XRAM_RSP;
+
+          else if (( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_ERASE ) ||
+                   ( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_READ  ))
+            r_alloc_trt_fsm = ALLOC_TRT_IXR_RSP;
+
+          else if ( r_read_fsm.read() == READ_TRT_LOCK )
+            r_alloc_trt_fsm = ALLOC_TRT_READ;
+        }
+        break;
+
+      ////////////////////
+      case ALLOC_TRT_CAS:
+        if (( r_cas_fsm.read() != CAS_MISS_TRT_LOCK ) &&
+            ( r_cas_fsm.read() != CAS_BC_TRT_LOCK   ) &&
+            ( r_cas_fsm.read() != CAS_BC_UPT_LOCK   ))
+        {
+          if (( r_xram_rsp_fsm.read()  == XRAM_RSP_DIR_LOCK  ) &&
+              ( r_alloc_dir_fsm.read() == ALLOC_DIR_XRAM_RSP ))
+            r_alloc_trt_fsm = ALLOC_TRT_XRAM_RSP;
+
+          else if (( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_ERASE ) ||
+                   ( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_READ  ))
+            r_alloc_trt_fsm = ALLOC_TRT_IXR_RSP;
+
+          else if ( r_read_fsm.read() == READ_TRT_LOCK )
+            r_alloc_trt_fsm = ALLOC_TRT_READ;
+
+          else if (( r_write_fsm.read() == WRITE_MISS_TRT_LOCK ) ||
+                   ( r_write_fsm.read() == WRITE_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_WRITE;
+        }
+        break;
+
+      ////////////////////////
+      case ALLOC_TRT_XRAM_RSP:
+        if ((( r_xram_rsp_fsm.read()  != XRAM_RSP_DIR_LOCK   )  ||
+             ( r_alloc_dir_fsm.read() != ALLOC_DIR_XRAM_RSP  )) &&
+             ( r_xram_rsp_fsm.read()  != XRAM_RSP_TRT_COPY   )  &&
+             ( r_xram_rsp_fsm.read()  != XRAM_RSP_DIR_UPDT   )  &&
+             ( r_xram_rsp_fsm.read()  != XRAM_RSP_INVAL_LOCK ))
+        {
+          if (( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_ERASE ) ||
+              ( r_ixr_rsp_fsm.read() == IXR_RSP_TRT_READ  ))
+            r_alloc_trt_fsm = ALLOC_TRT_IXR_RSP;
+
+          else if ( r_read_fsm.read() == READ_TRT_LOCK )
+            r_alloc_trt_fsm = ALLOC_TRT_READ;
+
+          else if (( r_write_fsm.read() == WRITE_MISS_TRT_LOCK ) ||
+                   ( r_write_fsm.read() == WRITE_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_WRITE;
+
+          else if (( r_cas_fsm.read() == CAS_MISS_TRT_LOCK ) ||
+                   ( r_cas_fsm.read() == CAS_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_CAS;
+        }
+        break;
+
+      ////////////////////////
+      case ALLOC_TRT_IXR_RSP:
+        if (( r_ixr_rsp_fsm.read() != IXR_RSP_TRT_ERASE ) &&
+            ( r_ixr_rsp_fsm.read() != IXR_RSP_TRT_READ  ))
+        {
+          if ( r_read_fsm.read() == READ_TRT_LOCK )
+            r_alloc_trt_fsm = ALLOC_TRT_READ;
+
+          else if (( r_write_fsm.read() == WRITE_MISS_TRT_LOCK ) ||
+                   ( r_write_fsm.read() == WRITE_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_WRITE;
+
+          else if (( r_cas_fsm.read() == CAS_MISS_TRT_LOCK ) ||
+                   ( r_cas_fsm.read() == CAS_BC_TRT_LOCK   ))
+            r_alloc_trt_fsm = ALLOC_TRT_CAS;
+
+          else if (( r_xram_rsp_fsm.read()  == XRAM_RSP_DIR_LOCK  ) &&
+                   ( r_alloc_dir_fsm.read() == ALLOC_DIR_XRAM_RSP ))
+            r_alloc_trt_fsm = ALLOC_TRT_XRAM_RSP;
+        }
+        break;
+
+    } // end switch alloc_trt_fsm
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    ALLOC_HEAP FSM
+    ////////////////////////////////////////////////////////////////////////////////////
+    // The ALLOC_HEAP FSM allocates the access to the heap
+    // with a round robin priority between 5 user FSMs :
+    // The cyclic ordering is READ > WRITE > CAS > CLEANUP > XRAM_RSP
+    // The ressource is always allocated.
+    /////////////////////////////////////////////////////////////////////////////////////
+
+    switch ( r_alloc_heap_fsm.read() )
+    {
+        ////////////////////
+        case ALLOC_HEAP_RESET:
+          // Initializes the heap one ENTRY each cycle.
+
+          r_alloc_heap_reset_cpt.write(r_alloc_heap_reset_cpt.read() + 1);
+
+          if(r_alloc_heap_reset_cpt.read() == (m_heap_size-1)) {
+            m_heap.init();
+
+            r_alloc_heap_fsm = ALLOC_HEAP_READ;
+          }
+          break;
+
+        ////////////////////
+        case ALLOC_HEAP_READ:
+        if (( r_read_fsm.read() != READ_HEAP_REQ   ) &&
+            ( r_read_fsm.read() != READ_HEAP_LOCK  ) &&
+            ( r_read_fsm.read() != READ_HEAP_ERASE ))
+        {
+          if ( r_write_fsm.read() == WRITE_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_WRITE;
+
+          else if ( r_cas_fsm.read() == CAS_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_CAS;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_CLEANUP;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_XRAM_RSP;
+        }
+        break;
+
+        /////////////////////
+        case ALLOC_HEAP_WRITE:
+        if (( r_write_fsm.read() != WRITE_UPT_HEAP_LOCK ) &&
+            ( r_write_fsm.read() != WRITE_UPT_REQ       ) &&
+            ( r_write_fsm.read() != WRITE_UPT_NEXT      ))
+        {
+          if ( r_cas_fsm.read() == CAS_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_CAS;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_CLEANUP;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_XRAM_RSP;
+
+          else if ( r_read_fsm.read() == READ_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_READ;
+        }
+        break;
+
+        ////////////////////
+        case ALLOC_HEAP_CAS:
+        if (( r_cas_fsm.read() != CAS_UPT_HEAP_LOCK ) &&
+            ( r_cas_fsm.read() != CAS_UPT_REQ       ) &&
+            ( r_cas_fsm.read() != CAS_UPT_NEXT      ))
+        {
+          if ( r_cleanup_fsm.read() == CLEANUP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_CLEANUP;
+
+          else if ( r_xram_rsp_fsm.read() == XRAM_RSP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_XRAM_RSP;
+
+          else if ( r_read_fsm.read() == READ_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_READ;
+
+          else if ( r_write_fsm.read() == WRITE_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_WRITE;
+        }
+        break;
+
+        ///////////////////////
+        case ALLOC_HEAP_CLEANUP:
+        if (( r_cleanup_fsm.read() != CLEANUP_HEAP_REQ    ) &&
+            ( r_cleanup_fsm.read() != CLEANUP_HEAP_LOCK   ) &&
+            ( r_cleanup_fsm.read() != CLEANUP_HEAP_SEARCH ) &&
+            ( r_cleanup_fsm.read() != CLEANUP_HEAP_CLEAN  ))
+        {
+          if ( r_xram_rsp_fsm.read() == XRAM_RSP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_XRAM_RSP;
+
+          else if ( r_read_fsm.read() == READ_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_READ;
+
+          else if ( r_write_fsm.read() == WRITE_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_WRITE;
+
+          else if ( r_cas_fsm.read() == CAS_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_CAS;
+        }
+        break;
+
+        ////////////////////////
+        case ALLOC_HEAP_XRAM_RSP:
+        if (( r_xram_rsp_fsm.read() != XRAM_RSP_HEAP_REQ   ) &&
+            ( r_xram_rsp_fsm.read() != XRAM_RSP_HEAP_ERASE ))
+        {
+          if  ( r_read_fsm.read() == READ_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_READ;
+
+          else if ( r_write_fsm.read() == WRITE_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_WRITE;
+
+          else if ( r_cas_fsm.read() == CAS_UPT_HEAP_LOCK )
+            r_alloc_heap_fsm = ALLOC_HEAP_CAS;
+
+          else if ( r_cleanup_fsm.read() == CLEANUP_HEAP_REQ )
+            r_alloc_heap_fsm = ALLOC_HEAP_CLEANUP;
+
+        }
+        break;
+
+    } // end switch alloc_heap_fsm
+
+
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    TGT_CMD to READ FIFO
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    if ( cmd_read_fifo_put ) {
+      if ( cmd_read_fifo_get ) {
+        m_cmd_read_addr_fifo.put_and_get((addr_t)(p_vci_tgt.address.read()));
+        m_cmd_read_length_fifo.put_and_get(p_vci_tgt.plen.read()>>2);
+        m_cmd_read_srcid_fifo.put_and_get(p_vci_tgt.srcid.read());
+        m_cmd_read_trdid_fifo.put_and_get(p_vci_tgt.trdid.read());
+        m_cmd_read_pktid_fifo.put_and_get(p_vci_tgt.pktid.read());
+      } else {
+        m_cmd_read_addr_fifo.simple_put((addr_t)(p_vci_tgt.address.read()));
+        m_cmd_read_length_fifo.simple_put(p_vci_tgt.plen.read()>>2);
+        m_cmd_read_srcid_fifo.simple_put(p_vci_tgt.srcid.read());
+        m_cmd_read_trdid_fifo.simple_put(p_vci_tgt.trdid.read());
+        m_cmd_read_pktid_fifo.simple_put(p_vci_tgt.pktid.read());
+      }
+    } else {
+      if ( cmd_read_fifo_get ) {
+        m_cmd_read_addr_fifo.simple_get();
+        m_cmd_read_length_fifo.simple_get();
+        m_cmd_read_srcid_fifo.simple_get();
+        m_cmd_read_trdid_fifo.simple_get();
+        m_cmd_read_pktid_fifo.simple_get();
+      }
+    }
+    /////////////////////////////////////////////////////////////////////
+    //    TGT_CMD to WRITE FIFO
+    /////////////////////////////////////////////////////////////////////
+
+    if ( cmd_write_fifo_put ) {
+      if ( cmd_write_fifo_get ) {
+        m_cmd_write_addr_fifo.put_and_get((addr_t)(p_vci_tgt.address.read()));
+        m_cmd_write_eop_fifo.put_and_get(p_vci_tgt.eop.read());
+        m_cmd_write_srcid_fifo.put_and_get(p_vci_tgt.srcid.read());
+        m_cmd_write_trdid_fifo.put_and_get(p_vci_tgt.trdid.read());
+        m_cmd_write_pktid_fifo.put_and_get(p_vci_tgt.pktid.read());
+        m_cmd_write_data_fifo.put_and_get(p_vci_tgt.wdata.read());
+        m_cmd_write_be_fifo.put_and_get(p_vci_tgt.be.read());
+      } else {
+        m_cmd_write_addr_fifo.simple_put((addr_t)(p_vci_tgt.address.read()));
+        m_cmd_write_eop_fifo.simple_put(p_vci_tgt.eop.read());
+        m_cmd_write_srcid_fifo.simple_put(p_vci_tgt.srcid.read());
+        m_cmd_write_trdid_fifo.simple_put(p_vci_tgt.trdid.read());
+        m_cmd_write_pktid_fifo.simple_put(p_vci_tgt.pktid.read());
+        m_cmd_write_data_fifo.simple_put(p_vci_tgt.wdata.read());
+        m_cmd_write_be_fifo.simple_put(p_vci_tgt.be.read());
+      }
+    } else {
+      if ( cmd_write_fifo_get ) {
+        m_cmd_write_addr_fifo.simple_get();
+        m_cmd_write_eop_fifo.simple_get();
+        m_cmd_write_srcid_fifo.simple_get();
+        m_cmd_write_trdid_fifo.simple_get();
+        m_cmd_write_pktid_fifo.simple_get();
+        m_cmd_write_data_fifo.simple_get();
+        m_cmd_write_be_fifo.simple_get();
+      }
+    }
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    TGT_CMD to CAS FIFO
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    if ( cmd_cas_fifo_put ) {
+      if ( cmd_cas_fifo_get ) {
+        m_cmd_cas_addr_fifo.put_and_get((addr_t)(p_vci_tgt.address.read()));
+        m_cmd_cas_eop_fifo.put_and_get(p_vci_tgt.eop.read());
+        m_cmd_cas_srcid_fifo.put_and_get(p_vci_tgt.srcid.read());
+        m_cmd_cas_trdid_fifo.put_and_get(p_vci_tgt.trdid.read());
+        m_cmd_cas_pktid_fifo.put_and_get(p_vci_tgt.pktid.read());
+        m_cmd_cas_wdata_fifo.put_and_get(p_vci_tgt.wdata.read());
+      } else {
+        m_cmd_cas_addr_fifo.simple_put((addr_t)(p_vci_tgt.address.read()));
+        m_cmd_cas_eop_fifo.simple_put(p_vci_tgt.eop.read());
+        m_cmd_cas_srcid_fifo.simple_put(p_vci_tgt.srcid.read());
+        m_cmd_cas_trdid_fifo.simple_put(p_vci_tgt.trdid.read());
+        m_cmd_cas_pktid_fifo.simple_put(p_vci_tgt.pktid.read());
+        m_cmd_cas_wdata_fifo.simple_put(p_vci_tgt.wdata.read());
+      }
+    } else {
+      if ( cmd_cas_fifo_get ) {
+        m_cmd_cas_addr_fifo.simple_get();
+        m_cmd_cas_eop_fifo.simple_get();
+        m_cmd_cas_srcid_fifo.simple_get();
+        m_cmd_cas_trdid_fifo.simple_get();
+        m_cmd_cas_pktid_fifo.simple_get();
+        m_cmd_cas_wdata_fifo.simple_get();
+      }
+    }
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    WRITE to INIT_CMD FIFO
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    if ( write_to_init_cmd_fifo_put ) {
+      if ( write_to_init_cmd_fifo_get ) {
+        m_write_to_init_cmd_inst_fifo.put_and_get(write_to_init_cmd_fifo_inst);
+        m_write_to_init_cmd_srcid_fifo.put_and_get(write_to_init_cmd_fifo_srcid);
+#if L1_MULTI_CACHE
+        m_write_to_init_cmd_cache_id_fifo.put_and_get(write_to_init_cmd_fifo_cache_id);
+#endif
+      } else {
+        m_write_to_init_cmd_inst_fifo.simple_put(write_to_init_cmd_fifo_inst);
+        m_write_to_init_cmd_srcid_fifo.simple_put(write_to_init_cmd_fifo_srcid);
+#if L1_MULTI_CACHE
+        m_write_to_init_cmd_cache_id_fifo.simple_put(write_to_init_cmd_fifo_cache_id);
+#endif
+      }
+    } else {
+      if ( write_to_init_cmd_fifo_get ) {
+        m_write_to_init_cmd_inst_fifo.simple_get();
+        m_write_to_init_cmd_srcid_fifo.simple_get();
+#if L1_MULTI_CACHE
+        m_write_to_init_cmd_cache_id_fifo.simple_get();
+#endif
+      }
+    }
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    XRAM_RSP to INIT_CMD FIFO
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    if ( xram_rsp_to_init_cmd_fifo_put ) {
+      if ( xram_rsp_to_init_cmd_fifo_get ) {
+        m_xram_rsp_to_init_cmd_inst_fifo.put_and_get(xram_rsp_to_init_cmd_fifo_inst);
+        m_xram_rsp_to_init_cmd_srcid_fifo.put_and_get(xram_rsp_to_init_cmd_fifo_srcid);
+#if L1_MULTI_CACHE
+        m_xram_rsp_to_init_cmd_cache_id_fifo.put_and_get(xram_rsp_to_init_cmd_fifo_cache_id);
+#endif
+      } else {
+        m_xram_rsp_to_init_cmd_inst_fifo.simple_put(xram_rsp_to_init_cmd_fifo_inst);
+        m_xram_rsp_to_init_cmd_srcid_fifo.simple_put(xram_rsp_to_init_cmd_fifo_srcid);
+#if L1_MULTI_CACHE
+        m_xram_rsp_to_init_cmd_cache_id_fifo.simple_put(xram_rsp_to_init_cmd_fifo_cache_id);
+#endif
+      }
+    } else {
+      if ( xram_rsp_to_init_cmd_fifo_get ) {
+        m_xram_rsp_to_init_cmd_inst_fifo.simple_get();
+        m_xram_rsp_to_init_cmd_srcid_fifo.simple_get();
+#if L1_MULTI_CACHE
+        m_xram_rsp_to_init_cmd_cache_id_fifo.simple_get();
+#endif
+      }
+    }
+    ////////////////////////////////////////////////////////////////////////////////////
+    //    CAS to INIT_CMD FIFO
+    ////////////////////////////////////////////////////////////////////////////////////
+
+    if ( cas_to_init_cmd_fifo_put ) {
+      if ( cas_to_init_cmd_fifo_get ) {
+        m_cas_to_init_cmd_inst_fifo.put_and_get(cas_to_init_cmd_fifo_inst);
+        m_cas_to_init_cmd_srcid_fifo.put_and_get(cas_to_init_cmd_fifo_srcid);
+#if L1_MULTI_CACHE
+        m_cas_to_init_cmd_cache_id_fifo.put_and_get(cas_to_init_cmd_fifo_cache_id);
+#endif
+      } else {
+          m_cas_to_init_cmd_inst_fifo.simple_put(cas_to_init_cmd_fifo_inst);
+          m_cas_to_init_cmd_srcid_fifo.simple_put(cas_to_init_cmd_fifo_srcid);
+#if L1_MULTI_CACHE
+          m_cas_to_init_cmd_cache_id_fifo.simple_put(cas_to_init_cmd_fifo_cache_id);
+#endif
+      }
+    } else {
+        if ( cas_to_init_cmd_fifo_get ) {
+            m_cas_to_init_cmd_inst_fifo.simple_get();
+            m_cas_to_init_cmd_srcid_fifo.simple_get();
+#if L1_MULTI_CACHE
+            m_cas_to_init_cmd_cache_id_fifo.simple_get();
+#endif
+      }
+    }
+
+    m_cpt_cycles++;
+
+} // end transition()
+
+/////////////////////////////
+tmpl(void)::genMoore()
+/////////////////////////////
+{
+    ////////////////////////////////////////////////////////////
+    // Command signals on the p_vci_ixr port
+    ////////////////////////////////////////////////////////////
+
+    p_vci_ixr.be      = 0xF;
+    p_vci_ixr.pktid   = 0;
+    p_vci_ixr.srcid   = m_srcid_ixr;
+    p_vci_ixr.cons    = false;
+    p_vci_ixr.wrap    = false;
+    p_vci_ixr.contig  = true;
+    p_vci_ixr.clen    = 0;
+    p_vci_ixr.cfixed  = false;
+
+    if ( r_ixr_cmd_fsm.read() == IXR_CMD_READ_NLINE ) {
+      p_vci_ixr.cmd     = vci_param::CMD_READ;
+      p_vci_ixr.cmdval  = true;
+      p_vci_ixr.address = (addr_t)(r_read_to_ixr_cmd_nline.read()*m_words*4);
+      p_vci_ixr.plen    = m_words*4;
+      p_vci_ixr.wdata   = 0x00000000;
+      p_vci_ixr.trdid   = r_read_to_ixr_cmd_trdid.read();
+      p_vci_ixr.eop     = true;
+    }
+    else if ( r_ixr_cmd_fsm.read() == IXR_CMD_CAS_NLINE ) {
+      if(r_cas_to_ixr_cmd_write.read()){
+        p_vci_ixr.cmd     = vci_param::CMD_WRITE;
+        p_vci_ixr.cmdval  = true;
+        p_vci_ixr.address = (addr_t)((r_cas_to_ixr_cmd_nline.read()*m_words+r_ixr_cmd_cpt.read())*4);
+        p_vci_ixr.plen    = m_words*4;
+        p_vci_ixr.wdata   = r_cas_to_ixr_cmd_data[r_ixr_cmd_cpt.read()].read();
+        p_vci_ixr.trdid   = r_cas_to_ixr_cmd_trdid.read();
+        p_vci_ixr.eop     = (r_ixr_cmd_cpt == (m_words-1));
+      } else {
+        p_vci_ixr.cmd     = vci_param::CMD_READ;
+        p_vci_ixr.cmdval  = true;
+        p_vci_ixr.address = (addr_t)(r_cas_to_ixr_cmd_nline.read()*m_words*4);
+        p_vci_ixr.plen    = m_words*4;
+        p_vci_ixr.wdata   = 0x00000000;
+        p_vci_ixr.trdid   = r_cas_to_ixr_cmd_trdid.read();
+        p_vci_ixr.eop     = true;
+      }
+    }
+    else if ( r_ixr_cmd_fsm.read() == IXR_CMD_WRITE_NLINE ) {
+      if(r_write_to_ixr_cmd_write.read()){
+        p_vci_ixr.cmd     = vci_param::CMD_WRITE;
+        p_vci_ixr.cmdval  = true;
+        p_vci_ixr.address = (addr_t)((r_write_to_ixr_cmd_nline.read()*m_words+r_ixr_cmd_cpt.read())*4);
+        p_vci_ixr.plen    = m_words*4;
+        p_vci_ixr.wdata   = r_write_to_ixr_cmd_data[r_ixr_cmd_cpt.read()].read();
+        p_vci_ixr.trdid   = r_write_to_ixr_cmd_trdid.read();
+        p_vci_ixr.eop     = (r_ixr_cmd_cpt == (m_words-1));
+      } else {
+        p_vci_ixr.cmd     = vci_param::CMD_READ;
+        p_vci_ixr.cmdval  = true;
+        p_vci_ixr.address = (addr_t)(r_write_to_ixr_cmd_nline.read()*m_words*4);
+        p_vci_ixr.plen    = m_words*4;
+        p_vci_ixr.wdata   = 0x00000000;
+        p_vci_ixr.trdid   = r_write_to_ixr_cmd_trdid.read();
+        p_vci_ixr.eop     = true;
+      }
+    }
+    else if ( r_ixr_cmd_fsm.read() == IXR_CMD_XRAM_DATA ) {
+      p_vci_ixr.cmd     = vci_param::CMD_WRITE;
+      p_vci_ixr.cmdval  = true;
+      p_vci_ixr.address = (addr_t)((r_xram_rsp_to_ixr_cmd_nline.read()*m_words+r_ixr_cmd_cpt.read())*4);
+      p_vci_ixr.plen    = m_words*4;
+      p_vci_ixr.wdata   = r_xram_rsp_to_ixr_cmd_data[r_ixr_cmd_cpt.read()].read();
+      p_vci_ixr.trdid   = r_xram_rsp_to_ixr_cmd_trdid.read();
+      p_vci_ixr.eop     = (r_ixr_cmd_cpt == (m_words-1));
+    } else {
+      p_vci_ixr.cmdval  = false;
+      p_vci_ixr.address = 0;
+      p_vci_ixr.plen    = 0;
+      p_vci_ixr.wdata   = 0;
+      p_vci_ixr.trdid   = 0;
+      p_vci_ixr.eop = false;
+    }
+
+    ////////////////////////////////////////////////////
+    // Response signals on the p_vci_ixr port
+    ////////////////////////////////////////////////////
+
+    if ( ((r_alloc_trt_fsm.read() == ALLOC_TRT_IXR_RSP) &&
+          (r_ixr_rsp_fsm.read() == IXR_RSP_TRT_READ)) ||
+        (r_ixr_rsp_fsm.read() == IXR_RSP_ACK) ) p_vci_ixr.rspack = true;
+    else                                        p_vci_ixr.rspack = false;
+
+    ////////////////////////////////////////////////////
+    // Command signals on the p_vci_tgt port
+    ////////////////////////////////////////////////////
+
+    switch ((tgt_cmd_fsm_state_e)r_tgt_cmd_fsm.read()) {
+      case TGT_CMD_IDLE:
+        p_vci_tgt.cmdack  = false;
+        break;
+      case TGT_CMD_READ:
+        p_vci_tgt.cmdack  = m_cmd_read_addr_fifo.wok();
+        break;
+      case TGT_CMD_WRITE:
+        p_vci_tgt.cmdack  = m_cmd_write_addr_fifo.wok();
+        break;
+      case TGT_CMD_CAS:
+        p_vci_tgt.cmdack  = m_cmd_cas_addr_fifo.wok();
+        break;
+      default:
+        p_vci_tgt.cmdack  = false;
+        break;
+    }
+
+    ////////////////////////////////////////////////////
+    // Response signals on the p_vci_tgt port
+    ////////////////////////////////////////////////////
+    switch ( r_tgt_rsp_fsm.read() ) {
+
+      case TGT_RSP_READ_IDLE:
+      case TGT_RSP_WRITE_IDLE:
+      case TGT_RSP_CAS_IDLE:
+      case TGT_RSP_XRAM_IDLE:
+      case TGT_RSP_INIT_IDLE:
+      case TGT_RSP_CLEANUP_IDLE:
+        p_vci_tgt.rspval  = false;
+        p_vci_tgt.rsrcid  = 0;
+        p_vci_tgt.rdata   = 0;
+        p_vci_tgt.rpktid  = 0;
+        p_vci_tgt.rtrdid  = 0;
+        p_vci_tgt.rerror  = 0;
+        p_vci_tgt.reop    = false;
+        break;
+      case TGT_RSP_READ:
+        p_vci_tgt.rspval   = true;
+        if( ((r_read_to_tgt_rsp_pktid.read() & 0x7) == TYPE_LL)
+            && (r_tgt_rsp_cpt.read() == (r_read_to_tgt_rsp_word.read()+r_read_to_tgt_rsp_length-1)) )
+          p_vci_tgt.rdata  = r_read_to_tgt_rsp_data[r_tgt_rsp_cpt.read()-1].read();
+        else if ((r_read_to_tgt_rsp_pktid.read() & 0x7) == TYPE_LL)
+          p_vci_tgt.rdata  = r_read_to_tgt_rsp_ll_key.read();
+        else
+          p_vci_tgt.rdata  = r_read_to_tgt_rsp_data[r_tgt_rsp_cpt.read()].read();
+        p_vci_tgt.rsrcid   = r_read_to_tgt_rsp_srcid.read();
+        p_vci_tgt.rtrdid   = r_read_to_tgt_rsp_trdid.read();
+        p_vci_tgt.rpktid   = r_read_to_tgt_rsp_pktid.read();
+        p_vci_tgt.rerror   = 0;
+        p_vci_tgt.reop     = ( r_tgt_rsp_cpt.read() == (r_read_to_tgt_rsp_word.read()+r_read_to_tgt_rsp_length-1) );
+        break;
+      case TGT_RSP_WRITE:
+        /*if( ((r_write_to_tgt_rsp_pktid.read() & 0x7) == TYPE_SC) )
+            {
+              std::cout << "SC RSP / rsrcid = " << r_write_to_tgt_rsp_srcid.read() << " / rdata = " << r_write_to_tgt_rsp_sc_fail.read() << std::endl;
+            }*/
+        p_vci_tgt.rspval   = true;
+        if( ((r_write_to_tgt_rsp_pktid.read() & 0x7) == TYPE_SC) && r_write_to_tgt_rsp_sc_fail.read() )
+          p_vci_tgt.rdata  = 1;
+        else
+          p_vci_tgt.rdata  = 0;
+        p_vci_tgt.rsrcid   = r_write_to_tgt_rsp_srcid.read();
+        p_vci_tgt.rtrdid   = r_write_to_tgt_rsp_trdid.read();
+        p_vci_tgt.rpktid   = r_write_to_tgt_rsp_pktid.read();
+        //p_vci_tgt.rerror   = 0x2 & ( (1 << vci_param::E) - 1);
+        p_vci_tgt.rerror   = 0;
+        p_vci_tgt.reop     = true;
+        break;
+      case TGT_RSP_CLEANUP:
+        p_vci_tgt.rspval   = true;
+        p_vci_tgt.rdata    = 0;
+        p_vci_tgt.rsrcid   = r_cleanup_to_tgt_rsp_srcid.read();
+        p_vci_tgt.rtrdid   = r_cleanup_to_tgt_rsp_trdid.read();
+        p_vci_tgt.rpktid   = r_cleanup_to_tgt_rsp_pktid.read();
+        p_vci_tgt.rerror   = 0; // Can be a CAS rsp
+        p_vci_tgt.reop     = true;
+        break;
+      case TGT_RSP_CAS:
+        p_vci_tgt.rspval   = true;
+        p_vci_tgt.rdata    = r_cas_to_tgt_rsp_data.read();
+        p_vci_tgt.rsrcid   = r_cas_to_tgt_rsp_srcid.read();
+        p_vci_tgt.rtrdid   = r_cas_to_tgt_rsp_trdid.read();
+        p_vci_tgt.rpktid   = r_cas_to_tgt_rsp_pktid.read();
+        p_vci_tgt.rerror   = 0;
+        p_vci_tgt.reop     = true;
+        break;
+      case TGT_RSP_XRAM:
+        p_vci_tgt.rspval   = true;
+        if( ((r_xram_rsp_to_tgt_rsp_pktid.read() & 0x7) == TYPE_LL)
+            && (r_tgt_rsp_cpt.read() == (r_xram_rsp_to_tgt_rsp_word.read()+r_xram_rsp_to_tgt_rsp_length-1)) )
+          p_vci_tgt.rdata  = r_xram_rsp_to_tgt_rsp_ll_key.read();
+        else
+          p_vci_tgt.rdata  = r_xram_rsp_to_tgt_rsp_data[r_tgt_rsp_cpt.read()].read();
+        p_vci_tgt.rsrcid   = r_xram_rsp_to_tgt_rsp_srcid.read();
+        p_vci_tgt.rtrdid   = r_xram_rsp_to_tgt_rsp_trdid.read();
+        p_vci_tgt.rpktid   = r_xram_rsp_to_tgt_rsp_pktid.read();
+        p_vci_tgt.rerror   = r_xram_rsp_to_tgt_rsp_rerror.read();
+        p_vci_tgt.reop     = (( r_tgt_rsp_cpt.read()
+              == (r_xram_rsp_to_tgt_rsp_word.read()+r_xram_rsp_to_tgt_rsp_length.read()-1))
+            || r_xram_rsp_to_tgt_rsp_rerror.read());
+        break;
+      case TGT_RSP_INIT:
+        p_vci_tgt.rspval   = true;
+        p_vci_tgt.rdata    = 0; // Can be a CAS or SC rsp
+        p_vci_tgt.rsrcid   = r_init_rsp_to_tgt_rsp_srcid.read();
+        p_vci_tgt.rtrdid   = r_init_rsp_to_tgt_rsp_trdid.read();
+        p_vci_tgt.rpktid   = r_init_rsp_to_tgt_rsp_pktid.read();
+        p_vci_tgt.rerror   = 0;
+        p_vci_tgt.reop     = true;
+        break;
+    } // end switch r_tgt_rsp_fsm
+
+    ///////////////////////////////////////////////////
+    // Command signals on the p_vci_ini port
+    ///////////////////////////////////////////////////
+
+    p_vci_ini.cmd     = vci_param::CMD_WRITE;
+    p_vci_ini.srcid   = m_srcid_ini;
+    p_vci_ini.cons    = true;
+    p_vci_ini.wrap    = false;
+    p_vci_ini.contig  = false;
+    p_vci_ini.clen    = 0;
+    p_vci_ini.cfixed  = false;
+
+    vci_addr_t vci_ini_address = 0;
+    switch ( r_init_cmd_fsm.read() ) {
+
+      case INIT_CMD_UPDT_IDLE:
+      case INIT_CMD_INVAL_IDLE:
+      case INIT_CMD_CAS_UPDT_IDLE:
+        p_vci_ini.cmdval  = false;
+        p_vci_ini.address = 0;
+        p_vci_ini.wdata   = 0;
+        p_vci_ini.be      = 0;
+        p_vci_ini.plen    = 0;
+        p_vci_ini.trdid   = 0;
+        p_vci_ini.pktid   = 0;
+        p_vci_ini.eop     = false;
+        break;
+      case INIT_CMD_INVAL_NLINE:
+      {
+        vci_ini_address = (vci_addr_t)
+            m_xram_rsp_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = m_xram_rsp_to_init_cmd_inst_fifo.rok();
+        if(m_xram_rsp_to_init_cmd_inst_fifo.rok()){
+          if(m_xram_rsp_to_init_cmd_inst_fifo.read()) {
+              p_vci_ini.address = (addr_t) (vci_ini_address+4);
+          } else {
+              p_vci_ini.address = (addr_t) (vci_ini_address);
+          }
+        } else p_vci_ini.address = 0; // prevent segmentation faults by reading an empty fifo
+        p_vci_ini.wdata   = (uint32_t)r_xram_rsp_to_init_cmd_nline.read();
+        p_vci_ini.be      = ((r_xram_rsp_to_init_cmd_nline.read() >> 32) & 0x3);
+        p_vci_ini.plen    = 4;
+        p_vci_ini.trdid   = r_xram_rsp_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_xram_rsp_to_init_cmd_cache_id_fifo.read();
+#endif
+        p_vci_ini.eop     = true;
+        break;
+      }
+      case INIT_CMD_XRAM_BRDCAST:
+        p_vci_ini.cmdval  = true;
+        p_vci_ini.address = m_broadcast_address;
+        p_vci_ini.wdata   = (uint32_t)r_xram_rsp_to_init_cmd_nline.read();
+        p_vci_ini.be      = ((r_xram_rsp_to_init_cmd_nline.read() >> 32) & 0x3);
+        p_vci_ini.plen    = 4;
+        p_vci_ini.trdid   = r_xram_rsp_to_init_cmd_trdid.read();
+        p_vci_ini.pktid   = 0;
+        p_vci_ini.eop     = true;
+        break;
+
+      case INIT_CMD_WRITE_BRDCAST:
+        p_vci_ini.cmdval  = true;
+        p_vci_ini.address = m_broadcast_address;
+        p_vci_ini.wdata   = (addr_t)r_write_to_init_cmd_nline.read();
+        p_vci_ini.be      = ((r_write_to_init_cmd_nline.read() >> 32) & 0x3);
+        p_vci_ini.plen    = 4 ;
+        p_vci_ini.eop     = true;
+        p_vci_ini.trdid   = r_write_to_init_cmd_trdid.read();
+        p_vci_ini.pktid   = 0;
+        break;
+      case INIT_CMD_UPDT_NLINE:
+        vci_ini_address = (vci_addr_t)
+            m_write_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = m_write_to_init_cmd_inst_fifo.rok();
+        if(m_write_to_init_cmd_inst_fifo.rok()){
+          if(m_write_to_init_cmd_inst_fifo.read()) {
+            p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+          } else {
+            p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+          }
+        } else {
+          p_vci_ini.address = 0;
+        }
+        p_vci_ini.wdata   = (uint32_t)r_write_to_init_cmd_nline.read();
+        p_vci_ini.be      = ((r_write_to_init_cmd_nline.read() >> 32 ) & 0x3);
+        p_vci_ini.plen    = 4 * (r_write_to_init_cmd_count.read() + 2);
+        p_vci_ini.eop     = false;
+        p_vci_ini.trdid   = r_write_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_write_to_init_cmd_cache_id_fifo.read();
+#endif
+        break;
+      case INIT_CMD_UPDT_INDEX:
+        vci_ini_address = (vci_addr_t)
+            m_write_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = true;
+        if(m_write_to_init_cmd_inst_fifo.read()) {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+        } else {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+        }
+        p_vci_ini.wdata   = r_write_to_init_cmd_index.read();
+        p_vci_ini.be      = 0xF;
+        p_vci_ini.plen    = 4 * (r_write_to_init_cmd_count.read() + 2);
+        p_vci_ini.trdid   = r_write_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_write_to_init_cmd_cache_id_fifo.read();
+#endif
+        p_vci_ini.eop     = false;
+        break;
+      case INIT_CMD_UPDT_DATA:
+        vci_ini_address = (vci_addr_t)
+            m_write_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = true;
+        if(m_write_to_init_cmd_inst_fifo.read()) {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+        } else {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+        }
+        p_vci_ini.wdata   = r_write_to_init_cmd_data[r_init_cmd_cpt.read() +
+          r_write_to_init_cmd_index.read()].read();
+        p_vci_ini.be      = r_write_to_init_cmd_be[r_init_cmd_cpt.read() +
+            r_write_to_init_cmd_index.read()].read()  ;
+        p_vci_ini.plen    = 4 * (r_write_to_init_cmd_count.read() + 2);
+        p_vci_ini.trdid   = r_write_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_write_to_init_cmd_cache_id_fifo.read();
+#endif
+        p_vci_ini.eop     = ( r_init_cmd_cpt.read() == (r_write_to_init_cmd_count.read()-1) );
+        break;
+
+      case INIT_CMD_CAS_BRDCAST:
+        p_vci_ini.cmdval  = true;
+        p_vci_ini.address = m_broadcast_address;
+        p_vci_ini.wdata   = (addr_t)r_cas_to_init_cmd_nline.read();
+        p_vci_ini.be      = ((r_cas_to_init_cmd_nline.read() >> 32) & 0x3);
+        p_vci_ini.plen    = 4 ;
+        p_vci_ini.eop     = true;
+        p_vci_ini.trdid   = r_cas_to_init_cmd_trdid.read();
+        p_vci_ini.pktid   = 0;
+        break;
+      case INIT_CMD_CAS_UPDT_NLINE:
+        vci_ini_address = (vci_addr_t)
+            m_cas_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = m_cas_to_init_cmd_inst_fifo.rok();
+        if(m_cas_to_init_cmd_inst_fifo.rok()){
+          if( m_cas_to_init_cmd_inst_fifo.read() ) {
+            p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+          } else {
+            p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+          }
+        } else {
+          p_vci_ini.address = 0;
+        }
+        p_vci_ini.wdata   = (uint32_t)r_cas_to_init_cmd_nline.read();
+        p_vci_ini.be      = ((r_cas_to_init_cmd_nline.read() >> 32 ) & 0x3);
+        if(r_cas_to_init_cmd_is_long.read()){
+            p_vci_ini.plen    = 4 * 4;
+        } else {
+            p_vci_ini.plen    = 4 * 3;
+        }
+        p_vci_ini.eop     = false;
+        p_vci_ini.trdid   = r_cas_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_cas_to_init_cmd_cache_id_fifo.read();
+#endif
+        break;
+      case INIT_CMD_CAS_UPDT_INDEX:
+        vci_ini_address = (vci_addr_t)
+            m_cas_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = true;
+        if( m_cas_to_init_cmd_inst_fifo.read() ) {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+        } else {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+        }
+        p_vci_ini.wdata   = r_cas_to_init_cmd_index.read();
+        p_vci_ini.be      = 0xF;
+        if(r_cas_to_init_cmd_is_long.read()){
+            p_vci_ini.plen    = 4 * 4;
+        } else {
+            p_vci_ini.plen    = 4 * 3;
+        }
+        p_vci_ini.trdid   = r_cas_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_cas_to_init_cmd_cache_id_fifo.read();
+#endif
+        p_vci_ini.eop     = false;
+        break;
+      case INIT_CMD_CAS_UPDT_DATA:
+        vci_ini_address = (vci_addr_t)
+            m_cas_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = true;
+        if( m_cas_to_init_cmd_inst_fifo.read() ) {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+        } else {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+        }
+        p_vci_ini.wdata   = r_cas_to_init_cmd_wdata.read();
+        p_vci_ini.be      = 0xF;
+        p_vci_ini.trdid   = r_cas_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_cas_to_init_cmd_cache_id_fifo.read();
+#endif
+        if(r_cas_to_init_cmd_is_long.read()){
+            p_vci_ini.plen    = 4 * 4;
+            p_vci_ini.eop     = false;
+        } else {
+            p_vci_ini.plen    = 4 * 3;
+            p_vci_ini.eop     = true;
+        }
+        break;
+      case INIT_CMD_CAS_UPDT_DATA_HIGH:
+        vci_ini_address = (vci_addr_t)
+            m_cas_to_init_cmd_srcid_fifo.read() << (vci_param::N - vci_param::S);
+
+        p_vci_ini.cmdval  = true;
+        if( m_cas_to_init_cmd_inst_fifo.read() ) {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 12);
+        } else {
+          p_vci_ini.address = (addr_t)(vci_ini_address + 8);
+        }
+        p_vci_ini.wdata   = r_cas_to_init_cmd_wdata_high.read();
+        p_vci_ini.be      = 0xF;
+        p_vci_ini.plen    = 4 * 4;
+        p_vci_ini.trdid   = r_cas_to_init_cmd_trdid.read();
+#if L1_MULTI_CACHE
+        p_vci_ini.pktid   = m_cas_to_init_cmd_cache_id_fifo.read();
+#endif
+        p_vci_ini.eop     = true;
+        break;
+
+    } // end switch r_init_cmd_fsm
+
+    //////////////////////////////////////////////////////
+    // Response signals on the p_vci_ini port
+    //////////////////////////////////////////////////////
+
+    if ( r_init_rsp_fsm.read() == INIT_RSP_IDLE ) p_vci_ini.rspack  = true;
+    else                                          p_vci_ini.rspack  = false;
+
+    //////////////////////////////////////////////////////
+    // Response signals on the p_vci_tgt_cleanup port
+    //////////////////////////////////////////////////////
+    p_vci_tgt_cleanup.rspval = false;
+    p_vci_tgt_cleanup.rsrcid = 0;
+    p_vci_tgt_cleanup.rdata  = 0;
+    p_vci_tgt_cleanup.rpktid = 0;
+    p_vci_tgt_cleanup.rtrdid = 0;
+    p_vci_tgt_cleanup.rerror = 0;
+    p_vci_tgt_cleanup.reop   = false;
+    p_vci_tgt_cleanup.cmdack = false ;
+
+    switch(r_cleanup_fsm.read()){
+      case CLEANUP_IDLE:
+        {
+          p_vci_tgt_cleanup.cmdack = true ;
+          break;
+        }
+      case CLEANUP_RSP:
+        {
+          /////////////////////////////////////////////////////////////////////
+          // Returning L1 cache SET index in RDATA.
+          // The maximum SET index width of a L1 cache must be 16 bits.
+          p_vci_tgt_cleanup.rspval = true;
+          p_vci_tgt_cleanup.rdata  = r_cleanup_nline.read() & 0xFFFF;
+          p_vci_tgt_cleanup.rsrcid = r_cleanup_srcid.read();
+          p_vci_tgt_cleanup.rpktid = r_cleanup_pktid.read();
+          p_vci_tgt_cleanup.rtrdid = r_cleanup_trdid.read();
+          p_vci_tgt_cleanup.rerror = 0x2 & ( (1 << vci_param::E) - 1);
+          p_vci_tgt_cleanup.reop   = 1;
+          break;
+        }
+
+    }
+
+} // end genMoore()
+
+}} // end name space
+
+// Local Variables:
+// tab-width: 2
+// c-basic-offset: 2
+// c-file-offsets:((innamespace . 0)(inline-open . 0))
+// indent-tabs-mode: nil
+// End:
+
+// vim: filetype=cpp:expandtab:shiftwidth=2:tabstop=2:softtabstop=2
