Line data    Source code

       1              : #include "wibmod/WIB1/WIB.hh"
       2              : #include <unistd.h> // usleep
       3              : 
       4              : #include "wibmod/WIB1/WIBException.hh"
       5              : 
       6              : #define COURSE_DATARATE_SIZE 232
       7              : static float courseDataRates[COURSE_DATARATE_SIZE] = {5.3745e+06,5.3741e+06,5.4793e+06,5.5912e+06,5.7111e+06,5.8391e+06,5.9760e+06,6.1215e+06,6.2780e+06,6.4565e+06,6.6391e+06,6.8372e+06,7.0520e+06,7.2868e+06,7.5424e+06,7.8220e+06,7.6663e+06,7.6659e+06,7.8217e+06,7.9880e+06,8.1667e+06,8.3570e+06,8.5616e+06,8.7805e+06,9.0166e+06,9.2849e+06,9.5608e+06,9.8591e+06,1.0183e+07,1.0535e+07,1.0918e+07,1.1332e+07,1.0749e+07,1.0748e+07,1.0959e+07,1.1182e+07,1.1422e+07,1.1678e+07,1.1952e+07,1.2243e+07,1.2556e+07,1.2913e+07,1.3278e+07,1.3674e+07,1.4104e+07,1.4574e+07,1.5085e+07, 
       8              : 1.5644e+07,1.5333e+07,1.5332e+07,1.5643e+07,1.5976e+07,1.6333e+07,1.6714e+07,1.7123e+07,1.7561e+07,1.8033e+07,1.8570e+07,1.9122e+07,1.9718e+07,2.0367e+07,2.1070e+07,2.1835e+07,2.2664e+07,2.1498e+07,2.1496e+07,2.1917e+07,2.2365e+07,2.2844e+07,2.3357e+07,2.3904e+07,2.4486e+07,2.5112e+07,2.5826e+07,2.6556e+07,2.7349e+07,2.8208e+07,2.9147e+07,3.0170e+07,3.1288e+07,3.0665e+07,3.0664e+07,3.1287e+07,3.1952e+07,3.2667e+07,3.3428e+07,3.4246e+07,3.5122e+07,3.6066e+07,3.7140e+07,3.8243e+07,3.9436e+07,4.0733e+07,4.2140e+07, 
       9              : 4.3671e+07,4.5328e+07,4.2996e+07,4.2993e+07,4.3834e+07,4.4729e+07,4.5688e+07,4.6713e+07,4.7808e+07,4.8972e+07,5.0224e+07,5.1652e+07,5.3113e+07,5.4698e+07,5.6416e+07,5.8295e+07,6.0339e+07,6.2576e+07,6.1331e+07,6.1328e+07,6.2574e+07,6.3904e+07,6.5334e+07,6.6856e+07,6.8493e+07,7.0244e+07,7.2133e+07,7.4279e+07,7.6486e+07,7.8872e+07,8.1467e+07,8.4279e+07,8.7341e+07,9.0657e+07,8.5991e+07,8.5986e+07,8.7668e+07,8.9458e+07,9.1377e+07,9.3426e+07,9.5616e+07,9.7944e+07,1.0045e+08,1.0330e+08,1.0623e+08,1.0940e+08,1.1283e+08, 
      10              : 1.1659e+08,1.2068e+08,1.2515e+08,1.2266e+08,1.2266e+08,1.2515e+08,1.2781e+08,1.3067e+08,1.3371e+08,1.3699e+08,1.4049e+08,1.4427e+08,1.4856e+08,1.5297e+08,1.5774e+08,1.6293e+08,1.6856e+08,1.7468e+08,1.8131e+08,1.7198e+08,1.7197e+08,1.7534e+08,1.7892e+08,1.8275e+08,1.8685e+08,1.9123e+08,1.9589e+08,2.0089e+08,2.0661e+08,2.1245e+08,2.1879e+08,2.2566e+08,2.3318e+08,2.4136e+08,2.5030e+08,2.4532e+08,2.4531e+08,2.5029e+08,2.5562e+08,2.6134e+08,2.6742e+08,2.7397e+08,2.8098e+08,2.8853e+08,2.9712e+08,3.0594e+08,3.1549e+08, 
      11              : 3.2587e+08,3.3712e+08,3.4936e+08,3.6263e+08,3.4397e+08,3.4394e+08,3.5067e+08,3.5783e+08,3.6551e+08,3.7370e+08,3.8247e+08, 
      12              : 3.9177e+08,4.0179e+08,4.1322e+08,4.2490e+08,4.3758e+08,4.5133e+08,4.6636e+08,4.8272e+08,5.0061e+08,4.9064e+08,4.9062e+08, 
      13              : 5.0059e+08,5.1123e+08,5.2267e+08,5.3485e+08,5.4794e+08,5.6195e+08,5.7706e+08,5.9423e+08,6.1189e+08,6.3098e+08,6.5173e+08, 
      14              :                                      6.7423e+08,6.9873e+08,7.2525e+08,6.8793e+08,6.8789e+08,7.0135e+08,7.1567e+08,7.3102e+08,7.4741e+08,7.6493e+08,7.8355e+08};
      15              : 
      16              : 
      17            0 : void WIB::WriteDTS_CDS(uint16_t address,uint32_t value,uint8_t byte_count,bool ignore_error){
      18            0 :   WriteI2C("DTS.CDS.I2C",address,value,byte_count,ignore_error);
      19            0 : }
      20            0 : uint32_t WIB::ReadDTS_CDS(uint16_t address,uint8_t byte_count){
      21            0 :   return ReadI2C("DTS.CDS.I2C",address,byte_count);
      22              : }
      23              : 
      24            0 : float WIB::ConfigureDTSCDS(uint8_t source){
      25            0 :   if(source > 1){
      26            0 :     BUException::WIB_BAD_ARGS e;
      27            0 :     e.Append("Bad DTS CDS clock source");
      28            0 :     throw e;
      29            0 :   }
      30              : 
      31              :   //Set timing system source (FP:0 BP:1)
      32            0 :   WriteWithRetry("DTS.CDS.INPUT_SELECT",source);
      33              : 
      34              :   //Reset the I2C firmware
      35            0 :   WriteWithRetry("DTS.CDS.I2C.RESET",1);
      36              :   //Reset the CDS chip (ADN2814)  
      37            0 :   WriteDTS_CDS(0x9,0x20,1);
      38            0 :   usleep(500000);
      39              : 
      40              :   //Reset the I2C firmware
      41            0 :   WriteWithRetry("DTS.CDS.I2C.RESET",1);
      42              :   //Un reset
      43            0 :   WriteDTS_CDS(0x9,0x00,1,true);
      44              :   //Reset the I2C firmware
      45            0 :   WriteWithRetry("DTS.CDS.I2C.RESET",1);
      46            0 :   usleep(1000000);
      47              : 
      48              :   //read bits 8 downto 1 from reg 3
      49            0 :   uint16_t dataRateLookup = uint16_t(ReadDTS_CDS(0x3,1)) << 1;
      50              :   //Read bit 0 from reg 4
      51            0 :   dataRateLookup |= uint16_t(ReadDTS_CDS(0x4,1))&0x1;
      52            0 :   if(dataRateLookup >=COURSE_DATARATE_SIZE){
      53              :     return -1;
      54              :   }
      55            0 :   return courseDataRates[dataRateLookup];
      56              : }