AMiRo-OS

/*

AMiRo-LLD is a compilation of low-level hardware drivers for the Autonomous Mini Robot (AMiRo) platform.

Copyright (C) 2016..2018  Thomas Schöpping et al.

This program 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, either version 3 of the License, or

(at your option) any later version.

This program 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 this program.  If not, see <http://www.gnu.org/licenses/>.

*/

/*! ------------------------------------------------------------------------------------------------------------------

 * @file    deca_device.c

 * @brief   Decawave device configuration and control functions

 *

 * @attention

 *

 * Copyright 2013 (c) Decawave Ltd, Dublin, Ireland.

 *

 * All rights reserved.

 *

 */

#include <alld_DW1000.h>

#if (defined(AMIROLLD_CFG_DW1000) && (AMIROLLD_CFG_DW1000 == 1)) || defined(__DOXYGEN__)

#include <v1/alld_dw1000_regs_v1.h>

#include <aos_thread.h>

#include <assert.h>

#include <string.h>

#include <stdlib.h>

#include <math.h>

// HW dependent implementation (see bottom of file)

static int writetospi(uint16_t headerLength,

               const        uint8_t *headerBuffer,

               uint32_t bodyLength,

               const        uint8_t *bodyBuffer);

static int readfromspi(uint16_t headerLength,

                const uint8_t *headerBuffer,

                uint32_t readlength,

                uint8_t *readBuffer);

// Defines for enable_clocks function

#define FORCE_SYS_XTI  0

#define ENABLE_ALL_SEQ 1

#define FORCE_SYS_PLL  2

#define READ_ACC_ON    7

#define READ_ACC_OFF   8

#define FORCE_OTP_ON   11

#define FORCE_OTP_OFF  12

#define FORCE_TX_PLL   13

#define FORCE_LDE      14

// Defines for ACK request bitmask in DATA and MAC COMMAND frame control (first byte) - Used to detect AAT bit wrongly set.

#define FCTRL_ACK_REQ_MASK 0x20

// Frame control maximum length in bytes.

#define FCTRL_LEN_MAX 2

typedef struct {

    uint32_t lo32;

    uint16_t target[NUM_PRF];

} agc_cfg_struct ;

extern const agc_cfg_struct agc_config ;

//SFD threshold settings for 110k, 850k, 6.8Mb standard and non-standard

extern const uint16_t sftsh[NUM_BR][NUM_SFD];

extern const uint16_t dtune1[NUM_PRF];

#define XMLPARAMS_VERSION   (1.17f)

extern const uint32_t fs_pll_cfg[NUM_CH];

extern const uint8_t fs_pll_tune[NUM_CH];

extern const uint8_t rx_config[NUM_BW];

extern const uint32_t tx_config[NUM_CH];

extern const uint8_t dwnsSFDlen[NUM_BR]; //length of SFD for each of the bitrates

extern const uint32_t digital_bb_config[NUM_PRF][NUM_PACS];

//extern const uint8_t chan_idx[NUM_CH_SUPPORTED]; // move to header file

extern const double txpwr_compensation[NUM_CH];

#define PEAK_MULTPLIER  (0x60) //3 -> (0x3 * 32) & 0x00E0

#define N_STD_FACTOR    (13)

#define LDE_PARAM1      (PEAK_MULTPLIER | N_STD_FACTOR)

#define LDE_PARAM3_16 (0x1607)

#define LDE_PARAM3_64 (0x0607)

#define MIXER_GAIN_STEP (0.5)

#define DA_ATTN_STEP    (2.5)

// #define DWT_API_ERROR_CHECK     // define so API checks config input parameters

//-----------------------------------------

// map the channel number to the index in the configuration arrays below

// 0th element is chan 1, 1st is chan 2, 2nd is chan 3, 3rd is chan 4, 4th is chan 5, 5th is chan 7

const uint8_t chan_idx[NUM_CH_SUPPORTED] = {0, 0, 1, 2, 3, 4, 0, 5};

//-----------------------------------------

const uint32_t tx_config[NUM_CH] =

{

    RF_TXCTRL_CH1,

    RF_TXCTRL_CH2,

    RF_TXCTRL_CH3,

    RF_TXCTRL_CH4,

    RF_TXCTRL_CH5,

    RF_TXCTRL_CH7,

};

//Frequency Synthesiser - PLL configuration

const uint32_t fs_pll_cfg[NUM_CH] =

{

    FS_PLLCFG_CH1,

    FS_PLLCFG_CH2,

    FS_PLLCFG_CH3,

    FS_PLLCFG_CH4,

    FS_PLLCFG_CH5,

    FS_PLLCFG_CH7

};

//Frequency Synthesiser - PLL tuning

const uint8_t fs_pll_tune[NUM_CH] =

{

    FS_PLLTUNE_CH1,

    FS_PLLTUNE_CH2,

    FS_PLLTUNE_CH3,

    FS_PLLTUNE_CH4,

    FS_PLLTUNE_CH5,

    FS_PLLTUNE_CH7

};

//bandwidth configuration

const uint8_t rx_config[NUM_BW] =

{

    RF_RXCTRLH_NBW,

    RF_RXCTRLH_WBW

};

const agc_cfg_struct agc_config =

{

    AGC_TUNE2_VAL,

    { AGC_TUNE1_16M , AGC_TUNE1_64M }  //adc target

};

//DW non-standard SFD length for 110k, 850k and 6.81M

const uint8_t dwnsSFDlen[NUM_BR] =

{

    DW_NS_SFD_LEN_110K,

    DW_NS_SFD_LEN_850K,

    DW_NS_SFD_LEN_6M8

};

// SFD Threshold

const uint16_t sftsh[NUM_BR][NUM_SFD] =

{

    {

        DRX_TUNE0b_110K_STD,

        DRX_TUNE0b_110K_NSTD

    },

    {

        DRX_TUNE0b_850K_STD,

        DRX_TUNE0b_850K_NSTD

    },

    {

        DRX_TUNE0b_6M8_STD,

        DRX_TUNE0b_6M8_NSTD

    }

};

const uint16_t dtune1[NUM_PRF] =

{

    DRX_TUNE1a_PRF16,

    DRX_TUNE1a_PRF64

};

const uint32_t digital_bb_config[NUM_PRF][NUM_PACS] =

{

    {

        DRX_TUNE2_PRF16_PAC8,

        DRX_TUNE2_PRF16_PAC16,

        DRX_TUNE2_PRF16_PAC32,

        DRX_TUNE2_PRF16_PAC64

    },

    {

        DRX_TUNE2_PRF64_PAC8,

        DRX_TUNE2_PRF64_PAC16,

        DRX_TUNE2_PRF64_PAC32,

        DRX_TUNE2_PRF64_PAC64

    }

};

const uint16_t lde_replicaCoeff[PCODES] =

{

    0, // No preamble code 0

    LDE_REPC_PCODE_1,

    LDE_REPC_PCODE_2,

    LDE_REPC_PCODE_3,

    LDE_REPC_PCODE_4,

    LDE_REPC_PCODE_5,

    LDE_REPC_PCODE_6,

    LDE_REPC_PCODE_7,

    LDE_REPC_PCODE_8,

    LDE_REPC_PCODE_9,

    LDE_REPC_PCODE_10,

    LDE_REPC_PCODE_11,

    LDE_REPC_PCODE_12,

    LDE_REPC_PCODE_13,

    LDE_REPC_PCODE_14,

    LDE_REPC_PCODE_15,

    LDE_REPC_PCODE_16,

    LDE_REPC_PCODE_17,

    LDE_REPC_PCODE_18,

    LDE_REPC_PCODE_19,

    LDE_REPC_PCODE_20,

    LDE_REPC_PCODE_21,

    LDE_REPC_PCODE_22,

    LDE_REPC_PCODE_23,

    LDE_REPC_PCODE_24

};

const double txpwr_compensation[NUM_CH] = {

    0.0,

    0.035,

    0.0,

    0.0,

    0.065,

    0.0

};

#define NUM_16M_OFFSET  (37)

#define NUM_16M_OFFSETWB  (68)

#define NUM_64M_OFFSET  (26)

#define NUM_64M_OFFSETWB  (59)

const uint8_t chan_idxnb[NUM_CH_SUPPORTED] = {0, 0, 1, 2, 0, 3, 0, 0}; //only channels 1,2,3 and 5 are in the narrow band tables

const uint8_t chan_idxwb[NUM_CH_SUPPORTED] = {0, 0, 0, 0, 0, 0, 0, 1}; //only channels 4 and 7 are in in the wide band tables

//---------------------------------------------------------------------------------------------------------------------------

// Range Bias Correction TABLES of range values in integer units of 25 CM, for 8-bit unsigned storage, MUST END IN 255 !!!!!!

//---------------------------------------------------------------------------------------------------------------------------

// offsets to nearest centimeter for index 0, all rest are +1 cm per value

#define CM_OFFSET_16M_NB    (-23)   // for normal band channels at 16 MHz PRF

#define CM_OFFSET_16M_WB    (-28)   // for wider  band channels at 16 MHz PRF

#define CM_OFFSET_64M_NB    (-17)   // for normal band channels at 64 MHz PRF

#define CM_OFFSET_64M_WB    (-30)   // for wider  band channels at 64 MHz PRF

//---------------------------------------------------------------------------------------------------------------------------

// range25cm16PRFnb: Range Bias Correction table for narrow band channels at 16 MHz PRF, NB: !!!! each MUST END IN 255 !!!!

//---------------------------------------------------------------------------------------------------------------------------

const uint8_t range25cm16PRFnb[4][NUM_16M_OFFSET] =

{

    // ch 1 - range25cm16PRFnb

    {

           1,

           3,

           4,

           5,

           7,

           9,

          11,

          12,

          13,

          15,

          18,

          20,

          23,

          25,

          28,

          30,

          33,

          36,

          40,

          43,

          47,

          50,

          54,

          58,

          63,

          66,

          71,

          76,

          82,

          89,

          98,

         109,

         127,

         155,

         222,

         255,

         255

    },

    // ch 2 - range25cm16PRFnb

    {

           1,

           2,

           4,

           5,

           6,

           8,

           9,

          10,

          12,

          13,

          15,

          18,

          20,

          22,

          24,

          27,

          29,

          32,

          35,

          38,

          41,

          44,

          47,

          51,

          55,

          58,

          62,

          66,

          71,

          78,

          85,

          96,

         111,

         135,

         194,

         240,

         255

    },

    // ch 3 - range25cm16PRFnb

    {

           1,

           2,

           3,

           4,

           5,

           7,

           8,

           9,

          10,

          12,

          14,

          16,

          18,

          20,

          22,

          24,

          26,

          28,

          31,

          33,

          36,

          39,

          42,

          45,

          49,

          52,

          55,

          59,

          63,

          69,

          76,