WXK
2023-11-28 62cbabbd7c0fc280d6679f3447140b32291a786e
decadriver/deca_device.c
@@ -155,9 +155,10 @@
#define XTRIM_ADDRESS  (0x1E)
uint8_t module_power;
uint32_t power_temp,power_input;
uint8_t module_power;
int dwt_initialise(uint16_t config)
{
   uint32_t power_temp,power_input;
    uint8_t plllockdetect = EC_CTRL_PLLLCK;
    uint16_t otp_addr = 0;
    uint32_t ldo_tune = 0;
@@ -179,24 +180,29 @@
    }
    _dwt_enableclocks(FORCE_SYS_XTI); // NOTE: set system clock to XTI - this is necessary to make sure the values read by _dwt_otpread are reliable
    dw1000local.deviceID =  dwt_readdevid() ;
      if(module_power>36)
      {
         power_temp =(module_power-36);
      }else{
         power_temp = ((6-(module_power/6))<<5)|(module_power%6);
      }
   power_input= power_temp<<24|power_temp<<16|power_temp<<8|power_temp;
   dwt_write32bitreg(TX_POWER_ID, power_input);
      dw1000local.deviceID =  dwt_readdevid() ;
    dw1000local.deviceID =  dwt_readdevid();
    module_power=67;
   if(module_power>67)
         {module_power=67;}
         if(module_power<0)
         {module_power=0;}
         if(module_power>36)
         {
            power_temp =(module_power-36);
         }else{
            power_temp = ((6-(module_power/6))<<5)|(module_power%6);
         }
    power_input= power_temp<<24|power_temp<<16|power_temp<<8|power_temp;
     dwt_write32bitreg(TX_POWER_ID, power_input);
    // Configure the CPLL lock detect
    dwt_writetodevice(EXT_SYNC_ID, EC_CTRL_OFFSET, 1, &plllockdetect);
    dwt_writetodevice(EXT_SYNC_ID, EC_CTRL_OFFSET, 1, &plllockdetect);
    // Read OTP revision number
    otp_addr = _dwt_otpread(XTRIM_ADDRESS) & 0xffff;        // Read 32 bit value, XTAL trim val is in low octet-0 (5 bits)
    dw1000local.otprev = (otp_addr >> 8) & 0xff;         // OTP revision is next byte
    // Load LDO tune from OTP and kick it if there is a value actually programmed.
    ldo_tune = _dwt_otpread(LDOTUNE_ADDRESS);
      dw1000local.deviceID =  dwt_readdevid() ;
    if((ldo_tune & 0xFF) != 0)
    {
        uint8_t ldok = OTP_SF_LDO_KICK;
@@ -204,7 +210,7 @@
        dwt_writetodevice(OTP_IF_ID, OTP_SF, 1, &ldok); // Set load LDE kick bit
        dw1000local.sleep_mode |= AON_WCFG_ONW_LLDO; // LDO tune must be kicked at wake-up
    }
 dw1000local.deviceID =  dwt_readdevid() ;
    // Load Part and Lot ID from OTP
    dw1000local.partID = _dwt_otpread(PARTID_ADDRESS);
    dw1000local.lotID = _dwt_otpread(LOTID_ADDRESS);
@@ -232,20 +238,20 @@
    }
    _dwt_enableclocks(ENABLE_ALL_SEQ); // Enable clocks for sequencing
  dw1000local.deviceID =  dwt_readdevid() ;
    // Read system register / store local copy
    dw1000local.sysCFGreg = dwt_read32bitreg(SYS_CFG_ID) ; // Read sysconfig register
   {
      uint32_t reg;
      reg = dwt_read32bitreg(GPIO_CTRL_ID);
      reg |= 0x00014000;
      reg |= 0x00050000;
      dwt_write32bitreg(GPIO_CTRL_ID,reg);
      dwt_write16bitoffsetreg(PMSC_ID,PMSC_TXFINESEQ_OFFSET ,PMSC_TXFINESEQ_DIS_MASK);
   }
//   CheckCPUID();
    dw1000local.deviceID =  dwt_readdevid() ;
//    dw1000local.sysCFGreg = dwt_read32bitreg(SYS_CFG_ID) ; // Read sysconfig register
//   {
//      uint32_t reg;
//      reg = dwt_read32bitreg(GPIO_CTRL_ID);
//      reg |= 0x00014000;
//      reg |= 0x00050000;
//      dwt_write32bitreg(GPIO_CTRL_ID,reg);
//      dwt_write16bitoffsetreg(PMSC_ID,PMSC_TXFINESEQ_OFFSET ,PMSC_TXFINESEQ_DIS_MASK);
//
//
//}
    return DWT_SUCCESS ;
} // end dwt_initialise()