daq_mtd.cxx

#include <assert.h>
#include <sys/types.h>
#include <errno.h>

#include <rtsLog.h>
#include <rtsSystems.h>

#include <SFS/sfs_index.h>

#include <DAQ_READER/daqReader.h>
#include <DAQ_READER/daq_dta.h>

#include "daq_mtd.h"






const char *daq_mtd::help_string = "\
\n\
MTD Help: \n\
Supported Banks: \n\
        raw     returns=ptr of start of DDL data; c1=sector[1..1]; c2=rdo[1..4]; \n\
        legacy  returns=ptr to struct mtd_t; \n\
\n\
\n\
" ;

class daq_det_mtd_factory : public daq_det_factory
{
public:
        daq_det_mtd_factory() {
                daq_det_factory::det_factories[MTD_ID] = this ;
        }

        daq_det *create() {
                return new daq_mtd ;
        }
} ;

static daq_det_mtd_factory mtd_factory ;



daq_mtd::daq_mtd(daqReader *rts_caller) 
{
        rts_id = MTD_ID ;
        name = rts2name(rts_id) ;
        sfs_name = "mtd" ;
        caller = rts_caller ;
        if(caller) caller->insert(this, rts_id) ;

        raw = new daq_dta ;
        legacy = new daq_dta ;


        
        LOG(DBG,"%s: constructor: caller %p",name,rts_caller) ;
        return ;
}

daq_mtd::~daq_mtd() 
{
        LOG(DBG,"%s: DEstructor",name) ;

        delete raw ;
        delete legacy ;

        return ;
}



daq_dta *daq_mtd::get(const char *bank, int sec, int row, int pad, void *p1, void *p2) 
{
        Make() ;

        if(present==0) return 0 ;

        LOG(DBG,"%s: looking for bank %s",name,bank) ;

        if(strcmp(bank,"*")==0) bank = "legacy" ;
                


        if(strcasecmp(bank,"raw")==0) {
                if((present & DET_PRESENT_SFS)==0) return 0 ;           // no DDL
                return handle_raw(sec,row) ;            // actually sec, rdo; r1 is the number of bytes
        }
        else if(strcasecmp(bank,"legacy")==0) {
                if((present & DET_PRESENT_SFS)==0) return 0 ;   // no legacy
                return handle_legacy() ;
        }
        else {
                LOG(ERR,"%s: unknown bank type \"%s\"",name,bank) ;
        }

        return 0 ;
}


daq_dta *daq_mtd::handle_legacy()
{
        assert(caller) ;

        legacy->create(1,"mtd_t",rts_id,DAQ_DTA_STRUCT(mtd_t)) ;
        

        mtd_t *mtd_p = (mtd_t *) legacy->request(1) ;   // need ONE mtd_t object

        
        memset(mtd_p->ddl_words,0,sizeof(mtd_p->ddl_words)) ;   // zap it!
        
        mtd_p->mode = 1 ;       // backward TOF compatibility
        mtd_p->channels = 0 ;           // signal that we have NO old data...
        mtd_p->max_channels = 0 ;       // stale but compatible with old mtdReadaer...

                
        for(int r=1;r<=MAX_RDO;r++) {
                daq_dta *dd = handle_raw(0,r) ;
                if(dd && dd->iterate()) {
                        u_int *tmp = (u_int *)dd->Void ;

                        u_int words = dd->ncontent/4 ;  // mtd wants words...

                        LOG(DBG,"MTD: RDO %d: bytes %d (max %d)",r,dd->ncontent,sizeof(mtd_p->ddl[0])) ;

                        if(words > (sizeof(mtd_p->ddl[0])/4)) {
                                LOG(ERR,"MTD: Huge event in RDO %d: %d words -- clipping to %d words",
                                    r,words,sizeof(mtd_p->ddl[0])/4) ;

                                words = sizeof(mtd_p->ddl[0])/4 ;
                        }
                                   
                                   
                        mtd_p->ddl_words[r-1] = words ;

                                
                        for(u_int i=0;i<words;i++) {    //words!
                                mtd_p->ddl[r-1][i] = l2h32(*tmp) ;
                                tmp++ ;
                        }

                }

        }


        legacy->finalize(1,1,0,0) ;     // 1 entry; sector 1, row 0, pad 0
        legacy->rewind() ;

        return legacy ;
}


daq_dta *daq_mtd::handle_raw(int sec, int rdo)
{
        char str[128] ;
        int tot_bytes ;
        int min_rdo, max_rdo ;
        int min_sec, max_sec ;
        struct {
                int sec ;
                int rb ;
                u_int bytes ;
        } obj[MAX_SEC*MAX_RDO] ;

        // sanity
        sec = 1 ;       // nothing else for now...
        min_sec = max_sec = sec ;

        if(rdo==-1) {
                min_rdo = 1 ;
                max_rdo = MAX_RDO ;
        }
        else if((rdo<1) || (rdo>MAX_RDO)) return 0 ;
        else {
                min_rdo = max_rdo = rdo ;
        }

        // bring in the bacon from the SFS file....
        assert(caller) ;

        // calc total bytes
        tot_bytes = 0 ;
        int o_cou = 0 ;
        for(int s=min_sec;s<=max_sec;s++) {
        for(int r=min_rdo;r<=max_rdo;r++) {
        
                sprintf(str,"%s/sec%02d/rb%02d/raw",sfs_name, s, r) ;
                char *full_name = caller->get_sfs_name(str) ;
        
                LOG(DBG,"%s: trying sfs on \"%s\"",name,str) ;
                if(full_name == 0) continue ;

                int size = caller->sfs->fileSize(full_name) ;   // this is bytes

                LOG(DBG,"Got %d",size) ;

                if(size <= 0) {
                        LOG(DBG,"%s: %s: not found in this event",name,str) ;
                        continue ;
                }
                else {
                        obj[o_cou].sec = s ;
                        obj[o_cou].rb = r ;
                        obj[o_cou].bytes = size ;

                        o_cou++ ;
        
                        tot_bytes += size ;
                        LOG(DBG,"%s: %s: reading in \"%s\": bytes %d",name,str,"raw", size) ;
                }
        }
        }

        raw->create(tot_bytes,"mtd_raw",rts_id,DAQ_DTA_STRUCT(u_char)) ;

        for(int i=0;i<o_cou;i++) {

                sprintf(str,"%s/sec%02d/rb%02d/raw",sfs_name, obj[i].sec, obj[i].rb) ;
                char *full_name = caller->get_sfs_name(str) ;
                if(full_name == 0) continue ;

                char *st = (char *) raw->request(obj[i].bytes) ;

                int ret = caller->sfs->read(full_name, st, obj[i].bytes) ;

                if(ret != (int)obj[i].bytes) {
                        LOG(ERR,"%s: %s: read failed, expect %d, got %d [%s]",name,str,
                                obj[i].bytes,ret,strerror(errno)) ;
                }

                else {
                        LOG(NOTE,"%s: %s read %d bytes",name,str,ret) ;

                }

                raw->finalize(obj[i].bytes,obj[i].sec,obj[i].rb,0) ;

        }

        raw->rewind() ;
        return raw ;
}


// knows how to get the token out of an event...
int daq_mtd::get_token(char *addr, int words)
{
        int cou ;
        struct daq_trg_word trg[128] ;

        cou = get_l2(addr,words,trg,1) ;

        if(cou==0) return -1000 ;       // special marker...
        if(trg[0].t==0) return -ENOSYS ;

        return trg[0].t ;
}

// knows how to get a/the L2 command out of the event: SAME AS TOF!
int daq_mtd::get_l2(char *addr, int words, struct daq_trg_word *trg, int rdo)
{
        u_int *w ;
        int cou = 0 ;
        int t_cou = 0 ;
        int in_words = words ;

        int err = 0 ;
        int trg_start ;

        w = (u_int *)addr ;
        words-- ;       // point to last datum now...

        // this will be DBG...
        LOG(DBG,"First words 0x%08X 0x%08X 0x%08X, last words 0x%08X 0x%08X 0x%08X [+0x%08X], %u",
            w[0],w[1],w[2],w[words-2],w[words-1],w[words],w[words+1],words+1) ;


        // prompt token is in word 0!
        // unless it just reads 0xA0000000, in which case this is purely trigger data -- no
        //    content!

        trg[t_cou].t = w[0] & 0xFFF ;
        trg[t_cou].daq = (w[0]>>12) & 0xF ;
        trg[t_cou].trg = (w[0]>>16) & 0xF ;
        trg[t_cou].rhic = 0 ;
        trg[t_cou].rhic_delta = 0 ;
        t_cou++ ;

//      LOG(TERR,"MTD event: words %d: 0x%08X 0x%08X 0x%08X 0x%08X 0x%08X",
//          in_words,w[0],w[1],w[2],w[3],w[4]) ;


        LOG(NOTE,"prompt: T %4d, trg %d, daq %d [0x%08X]: words %d",trg[0].t,trg[0].trg,trg[0].daq,w[0],in_words) ;

        if(in_words < 2) {      // absolute minimum
                err |= 1 ;
                LOG(ERR,"[%d] bad word count %d < 2",rdo,in_words);
        }


        if(w[0] == 0xA0000000) {        // trigger only
                trg[0].t = 4097;        // trigger only contrib...
        }
        else {
                if(in_words < 3) {      // minimum if not trigger-only
                        err |= 1 ;
                        LOG(ERR,"[%d] bad word count %d <= 3",rdo,in_words);
                }

                if(trg[0].t == 0) {
                        err |= 2 ;
                        LOG(ERR,"[%d] token 0",rdo);
                        trg[0].t = 4097 ;
                }

                if(trg[0].trg != 4) {   // we will allow only 4!
                        err |= 2 ;
                        LOG(ERR,"[%d] bad trg_cmd %d != 4",rdo,trg[0].trg);
                }

                if(w[1] != 0xDEADFACE) {
                        err |= 1 ;
                        LOG(ERR,"[%d] bad DEADFACE 0x%08X",rdo,w[1]);
                }


        }

        if((w[0] >> 20) != 0xA00) {
                err  |= 1 ;
                LOG(ERR,"[%d] bad first word 0x%08X doesn't start with 0xA00",rdo,w[0]);
                trg[0].t = 4097 ;
        }

        
        // move backwards to the start of the trigger block and just count at first
        while(words) {
                if((w[words] >> 28)==0xA) {     // trigger stuff
                        words-- ;
                        cou++ ;
                }
                else {  // stop when non 0xA reached...
                        break ;
                }
        }

        if(cou==0) {
                err |= 1 ;
                LOG(ERR,"[%d] No Trigger FIFO contribution??",rdo);             
        }

        words++ ;       // move forward to start of trigger

        trg_start = words ;     // mark the word where trigger starts
        
        // words now points to the first trigger of the FIFO block
        for(int i=0;i<cou;i++) {
                int l_err = 0 ;

                trg[t_cou].t = w[words+i] & 0xFFF ;
                trg[t_cou].daq = (w[words+i]>>12) & 0xF ;
                trg[t_cou].trg = (w[words+i]>>16) & 0xF ;
                trg[t_cou].rhic = i+1 ;
                trg[t_cou].rhic_delta = i+1 ;

                if(trg[t_cou].t == 0) l_err = 1 ;       // token 0 

                // we will take OUT all the non-L2 components here...
                switch(trg[t_cou].trg) {
                case 4 :        // normal
                        continue ;      // don't put it in!
                case 13 :       // abort
                case 15 :       // accept
                        break ;
                default :               // take out ALL other L0 commands!
                        l_err = 1 ;
                        break ;
                }

                if(l_err) {
                        LOG(ERR,"[%d] bad FIFO trg (%d.): T %4d, trg %d, daq %d [0x%08X]",rdo,words+i,trg[t_cou].t,trg[t_cou].trg,trg[t_cou].daq,w[words+i]);
                        err |= 2 ;
                        continue ;      // don't use it!
                }

                t_cou++ ;

                if(t_cou >=120) {
                        err |= 2 ;
                        LOG(ERR,"[%d] Too many trigger contributions %d >= 120",rdo,t_cou) ;
                        break ;
                }
        }


        if(err) {
                LOG(ERR,"[%d] Bad Event: T %4d: words %d, trg_words %d (start at %d) : 0x%08X 0x%08X 0x%08X",
                    rdo,trg[0].t,in_words,cou,trg_start,w[0],w[1],w[2]) ;

                //for(int i=0;i<cou;i++) {
                //      LOG(ERR,"[%d]   trigger %d: %d/%d: 0x%08X",rdo,i,cou,w[trg_start+i]) ;
                //}
        }

        if(err & 1) {   // critical -- blow the whole event
                return -1 ;
        }

        return t_cou ;
}