| [3537] | 1 | #include "sopnamsp.h" | 
|---|
|  | 2 | #include "machdefs.h" | 
|---|
|  | 3 | #include <stdio.h> | 
|---|
|  | 4 | #include <stdlib.h> | 
|---|
|  | 5 | #include <iostream> | 
|---|
|  | 6 | #include <math.h> | 
|---|
|  | 7 |  | 
|---|
|  | 8 | #include <typeinfo> | 
|---|
|  | 9 |  | 
|---|
|  | 10 | #include <vector> | 
|---|
|  | 11 | #include <string> | 
|---|
|  | 12 |  | 
|---|
|  | 13 | #include "tvector.h" | 
|---|
|  | 14 | #include "piacmd.h" | 
|---|
|  | 15 | #include "nobjmgr.h" | 
|---|
|  | 16 | #include "pistdimgapp.h" | 
|---|
|  | 17 |  | 
|---|
|  | 18 |  | 
|---|
|  | 19 | //  Module pour lire les fichiers generes par Monique pour Acq-BAORadio | 
|---|
|  | 20 |  | 
|---|
|  | 21 | //  Declaration de la fonction d'activation et de desactivation du module | 
|---|
|  | 22 | extern "C" { | 
|---|
|  | 23 | void BAORadio_init(); | 
|---|
|  | 24 | void BAORadio_end(); | 
|---|
|  | 25 | } | 
|---|
|  | 26 |  | 
|---|
|  | 27 |  | 
|---|
|  | 28 | //  Une classe commande-executor, permettant d'enregistrer de | 
|---|
|  | 29 | //  nouvelles commandes a piapp | 
|---|
|  | 30 | class BAORadioExecutor : public CmdExecutor { | 
|---|
|  | 31 | public: | 
|---|
|  | 32 | BAORadioExecutor(); | 
|---|
|  | 33 | virtual       ~BAORadioExecutor(); | 
|---|
|  | 34 | // Execute s'occupe de l'execution effective des commandes | 
|---|
|  | 35 | virtual int   Execute(string& keyw, vector<string>& args, string& toks); | 
|---|
|  | 36 | }; | 
|---|
|  | 37 |  | 
|---|
|  | 38 | /* --Methode-- */ | 
|---|
|  | 39 | BAORadioExecutor::BAORadioExecutor() | 
|---|
|  | 40 | { | 
|---|
|  | 41 |  | 
|---|
|  | 42 | PIACmd * mpiac; | 
|---|
|  | 43 | NamedObjMgr omg; | 
|---|
|  | 44 | mpiac = omg.GetImgApp()->CmdInterpreter(); | 
|---|
|  | 45 |  | 
|---|
|  | 46 | // On enregistre deux nouvelles commandes | 
|---|
|  | 47 | string hgrp = "BAORadioCmd"; | 
|---|
|  | 48 | // commande excmd1 | 
|---|
|  | 49 | string kw = "brrdfile"; | 
|---|
|  | 50 | string usage = "brrdfile: Lecture fichier AcqBAORadio \n" ; | 
|---|
|  | 51 | usage += "Usage: brrdfile size fileName [objName] \n"; | 
|---|
|  | 52 | usage += " Defaut objName= data"; | 
|---|
|  | 53 | mpiac->RegisterCommand(kw, usage, this, hgrp); | 
|---|
|  | 54 |  | 
|---|
|  | 55 | } | 
|---|
|  | 56 |  | 
|---|
|  | 57 | /* --Methode-- */ | 
|---|
|  | 58 | BAORadioExecutor::~BAORadioExecutor() | 
|---|
|  | 59 | { | 
|---|
|  | 60 |  | 
|---|
|  | 61 | } | 
|---|
|  | 62 |  | 
|---|
|  | 63 |  | 
|---|
|  | 64 | static inline void bswap4(void* p) | 
|---|
|  | 65 | { | 
|---|
|  | 66 | uint_4 tmp = *(uint_4*)p; | 
|---|
|  | 67 | *(uint_4*)p = ((tmp >> 24) & 0x000000FF) | | 
|---|
|  | 68 | ((tmp >> 8)  & 0x0000FF00) | | 
|---|
|  | 69 | ((tmp & 0x0000FF00) << 8)  | | 
|---|
|  | 70 | ((tmp & 0x000000FF) << 24); | 
|---|
|  | 71 | } | 
|---|
|  | 72 |  | 
|---|
|  | 73 |  | 
|---|
|  | 74 |  | 
|---|
|  | 75 | /* --Methode-- */ | 
|---|
|  | 76 | int BAORadioExecutor::Execute(string& kw, vector<string>& tokens, string&) | 
|---|
|  | 77 | { | 
|---|
|  | 78 |  | 
|---|
|  | 79 | NamedObjMgr omg; | 
|---|
|  | 80 | if (kw == "brrdfile") { | 
|---|
|  | 81 | if (tokens.size() < 2) { | 
|---|
|  | 82 | cout << "Usage: brrdfile size fileName [objName]" << endl; | 
|---|
|  | 83 | return(0); | 
|---|
|  | 84 | } | 
|---|
|  | 85 | sa_size_t sz = atoi(tokens[0].c_str()); | 
|---|
|  | 86 | string filename = tokens[1]; | 
|---|
|  | 87 | string objname = "data"; | 
|---|
|  | 88 | if (tokens.size() > 2) objname = tokens[2]; | 
|---|
|  | 89 |  | 
|---|
|  | 90 | cout << " brrdfile : reading from file " << filename | 
|---|
|  | 91 | << " Size=" << sz << endl; | 
|---|
|  | 92 | TVector<int_2> data(sz); | 
|---|
|  | 93 | TVector<r_8> ddata(sz); | 
|---|
|  | 94 | FILE *fip = NULL; | 
|---|
|  | 95 | fip = fopen(filename.c_str(),"rb"); | 
|---|
|  | 96 | if (fip == NULL) { | 
|---|
|  | 97 | cout << " brrdfile : ERROR opening file" << endl; | 
|---|
|  | 98 | return 1; | 
|---|
|  | 99 | } | 
|---|
|  | 100 | uint_1* buff = new uint_1[sz/4+1]; | 
|---|
|  | 101 | fread(buff, 1, (size_t)(sz), fip); | 
|---|
|  | 102 | uint_4* first = (uint_4*)(buff); | 
|---|
|  | 103 | uint_4* second = (uint_4*)(buff+4); | 
|---|
|  | 104 | cout << " brrdfile, first uint_4= " << hex << (*first) | 
|---|
|  | 105 | << " second= " << (*second) << dec << endl; | 
|---|
|  | 106 | //  uint_1* buff = (uint_1 *)buff4; | 
|---|
|  | 107 | //  for(sa_size_t ka=0; ka<sz/4; ka++) bswap4(buff4+ka); | 
|---|
|  | 108 | for(sa_size_t ka=0; ka<sz; ka+=4) { | 
|---|
|  | 109 | if (ka>=sz-3)  break; | 
|---|
|  | 110 | for(sa_size_t kb=0; kb<4; kb++) | 
|---|
|  | 111 | data(ka+kb) = (int_2)buff[ka+3-kb]; | 
|---|
|  | 112 | } | 
|---|
|  | 113 | //  for(sa_size_t k=0; k<sz; k++) data(k) = (int_2)buff[k]; | 
|---|
|  | 114 | fclose(fip); | 
|---|
|  | 115 | delete[] buff; | 
|---|
|  | 116 | omg.AddObj(data, objname); | 
|---|
|  | 117 | ddata = data; | 
|---|
|  | 118 | objname += "_f"; | 
|---|
|  | 119 | omg.AddObj(ddata, objname); | 
|---|
|  | 120 | } | 
|---|
|  | 121 | /* | 
|---|
|  | 122 | else if (kw == "excmd2") { | 
|---|
|  | 123 | } | 
|---|
|  | 124 | */ | 
|---|
|  | 125 | return(0); | 
|---|
|  | 126 |  | 
|---|
|  | 127 | } | 
|---|
|  | 128 |  | 
|---|
|  | 129 | static BAORadioExecutor * baoradioex = NULL; | 
|---|
|  | 130 | /* Nouvelle-Fonction */ | 
|---|
|  | 131 | void BAORadio_init() | 
|---|
|  | 132 | { | 
|---|
|  | 133 | // Fonction d'initialisation du module | 
|---|
|  | 134 | // Appele par le gestionnaire de modules de piapp (PIACmd::LoadModule()) | 
|---|
|  | 135 | if (baoradioex) delete baoradioex; | 
|---|
|  | 136 | baoradioex = new BAORadioExecutor; | 
|---|
|  | 137 | } | 
|---|
|  | 138 |  | 
|---|
|  | 139 | /* Nouvelle-Fonction */ | 
|---|
|  | 140 | void BAORadio_end() | 
|---|
|  | 141 | { | 
|---|
|  | 142 | // Desactivation du module | 
|---|
|  | 143 | if (baoradioex) delete baoradioex; | 
|---|
|  | 144 | baoradioex = NULL; | 
|---|
|  | 145 | } | 
|---|
|  | 146 |  | 
|---|