vl53l1_api_preset_modes.c

Go to the documentation of this file.

/*
* Copyright (c) 2017, STMicroelectronics - All Rights Reserved
*
* This file is part of VL53L1 Core and is dual licensed,
* either 'STMicroelectronics
* Proprietary license'
* or 'BSD 3-clause "New" or "Revised" License' , at your option.
*
********************************************************************************
*
* 'STMicroelectronics Proprietary license'
*
********************************************************************************
*
* License terms: STMicroelectronics Proprietary in accordance with licensing
* terms at www.st.com/sla0081
*
* STMicroelectronics confidential
* Reproduction and Communication of this document is strictly prohibited unless
* specifically authorized in writing by STMicroelectronics.
*
*
********************************************************************************
*
* Alternatively, VL53L1 Core may be distributed under the terms of
* 'BSD 3-clause "New" or "Revised" License', in which case the following
* provisions apply instead of the ones mentioned above :
*
********************************************************************************
*
* License terms: BSD 3-clause "New" or "Revised" License.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
*
* 1. Redistributions of source code must retain the above copyright notice, this
* list of conditions and the following disclaimer.
*
* 2. Redistributions in binary form must reproduce the above copyright notice,
* this list of conditions and the following disclaimer in the documentation
* and/or other materials provided with the distribution.
*
* 3. Neither the name of the copyright holder nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
*
********************************************************************************
*
*/
 
#include "vl53l1_ll_def.h"
#include "vl53l1_platform_log.h"
#include "vl53l1_register_structs.h"
#include "vl53l1_register_settings.h"
#include "vl53l1_core.h"
#include "vl53l1_api_preset_modes.h"
#include "vl53l1_tuning_parm_defaults.h"
 
 
#define LOG_FUNCTION_START(fmt, ...) \
        _LOG_FUNCTION_START(VL53L1_TRACE_MODULE_API, fmt, ##__VA_ARGS__)
#define LOG_FUNCTION_END(status, ...) \
        _LOG_FUNCTION_END(VL53L1_TRACE_MODULE_API, status, ##__VA_ARGS__)
#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
        _LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_API, status, fmt, ##__VA_ARGS__)
 
 
#ifndef VL53L1_NOCALIB
VL53L1_Error VL53L1_init_refspadchar_config_struct(
        VL53L1_refspadchar_config_t   *pdata)
{
        /*
         * Initializes Ref SPAD Char data structures preset mode
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Reference SPAD Char Configuration
         *
         * vcsel_period              = 0x0B   - 24 clock VCSEL period
         * timeout_us                = 1000   - Set 1000us phase cal timeout
         * target_count_rate_mcps    = 0x0A00 - 9.7 -> 20.0 Mcps
         * min_count_rate_limit_mcps = 0x0500 - 9.7 -> 10.0 Mcps
         * max_count_rate_limit_mcps = 0x1400 - 9.7 -> 40.0 Mcps
         */
 
        pdata->device_test_mode =
                        VL53L1_TUNINGPARM_REFSPADCHAR_DEVICE_TEST_MODE_DEFAULT;
        pdata->vcsel_period              =
                        VL53L1_TUNINGPARM_REFSPADCHAR_VCSEL_PERIOD_DEFAULT;
        pdata->timeout_us                =
                        VL53L1_TUNINGPARM_REFSPADCHAR_PHASECAL_TIMEOUT_US_DEFAULT;
        pdata->target_count_rate_mcps    =
                        VL53L1_TUNINGPARM_REFSPADCHAR_TARGET_COUNT_RATE_MCPS_DEFAULT;
        pdata->min_count_rate_limit_mcps =
                        VL53L1_TUNINGPARM_REFSPADCHAR_MIN_COUNTRATE_LIMIT_MCPS_DEFAULT;
        pdata->max_count_rate_limit_mcps =
                        VL53L1_TUNINGPARM_REFSPADCHAR_MAX_COUNTRATE_LIMIT_MCPS_DEFAULT;
 
        LOG_FUNCTION_END(status);
 
        return status;
}
#endif
 
 
#ifndef VL53L1_NOCALIB
VL53L1_Error VL53L1_init_ssc_config_struct(
        VL53L1_ssc_config_t   *pdata)
{
        /*
         * Initializes SPAD Self Check (SSC) data structure
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* SPAD Select Check Configuration */
 
        /* 0 - store RTN count rates
         * 1 - store REF count rates
         */
        pdata->array_select = VL53L1_DEVICESSCARRAY_RTN;
 
        /* VCSEL period register value  0x12 (18) -> 38 VCSEL clocks */
        pdata->vcsel_period =
                        VL53L1_TUNINGPARM_SPADMAP_VCSEL_PERIOD_DEFAULT;
 
        /* VCSEL pulse start */
        pdata->vcsel_start  =
                        VL53L1_TUNINGPARM_SPADMAP_VCSEL_START_DEFAULT;
 
        /* VCSEL pulse width */
        pdata->vcsel_width  = 0x02;
 
        /* SSC timeout [us] */
        pdata->timeout_us   = 36000;
 
        /* SSC rate limit [Mcps]
         * - 9.7 for VCSEL ON
         * - 1.15 for VCSEL OFF
         */
        pdata->rate_limit_mcps =
                        VL53L1_TUNINGPARM_SPADMAP_RATE_LIMIT_MCPS_DEFAULT;
 
        LOG_FUNCTION_END(status);
 
        return status;
}
#endif
 
 
VL53L1_Error VL53L1_init_xtalk_config_struct(
        VL53L1_customer_nvm_managed_t *pnvm,
        VL53L1_xtalk_config_t   *pdata)
{
        /*
         * Initializes Xtalk Config structure
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Xtalk default configuration
         *
         * algo__crosstalk_compensation_plane_offset_kcps
         *  = pdev->customer.algo__crosstalk_compensation_plane_offset_kcps
         * algo__crosstalk_compensation_x_plane_gradient_kcps
         *  = pdev->customer.algo__crosstalk_compensation_x_plane_gradient_kcps
         * algo__crosstalk_compensation_y_plane_gradient_kcps
         *  = pdev->customer.algo__crosstalk_compensation_y_plane_gradient_kcps
         *
         */
 
        /* Store xtalk data into golden copy */
 
        pdata->algo__crosstalk_compensation_plane_offset_kcps      =
                pnvm->algo__crosstalk_compensation_plane_offset_kcps;
        pdata->algo__crosstalk_compensation_x_plane_gradient_kcps  =
                pnvm->algo__crosstalk_compensation_x_plane_gradient_kcps;
        pdata->algo__crosstalk_compensation_y_plane_gradient_kcps  =
                pnvm->algo__crosstalk_compensation_y_plane_gradient_kcps;
 
        /* Store NVM defaults for later use */
 
        pdata->nvm_default__crosstalk_compensation_plane_offset_kcps      =
                (uint32_t)pnvm->algo__crosstalk_compensation_plane_offset_kcps;
        pdata->nvm_default__crosstalk_compensation_x_plane_gradient_kcps  =
                pnvm->algo__crosstalk_compensation_x_plane_gradient_kcps;
        pdata->nvm_default__crosstalk_compensation_y_plane_gradient_kcps  =
                pnvm->algo__crosstalk_compensation_y_plane_gradient_kcps;
 
        pdata->lite_mode_crosstalk_margin_kcps                     =
                        VL53L1_TUNINGPARM_LITE_XTALK_MARGIN_KCPS_DEFAULT;
 
        /* Default for Range Ignore Threshold Mult = 2.0 */
 
        pdata->crosstalk_range_ignore_threshold_mult =
                        VL53L1_TUNINGPARM_LITE_RIT_MULT_DEFAULT;
 
        if ((pdata->algo__crosstalk_compensation_plane_offset_kcps == 0x00)
                && (pdata->algo__crosstalk_compensation_x_plane_gradient_kcps == 0x00)
                && (pdata->algo__crosstalk_compensation_y_plane_gradient_kcps == 0x00))
                pdata->global_crosstalk_compensation_enable = 0x00;
        else
                pdata->global_crosstalk_compensation_enable = 0x01;
 
 
        if ((status == VL53L1_ERROR_NONE) &&
                (pdata->global_crosstalk_compensation_enable == 0x01)) {
                pdata->crosstalk_range_ignore_threshold_rate_mcps =
                        VL53L1_calc_range_ignore_threshold(
                                pdata->algo__crosstalk_compensation_plane_offset_kcps,
                                pdata->algo__crosstalk_compensation_x_plane_gradient_kcps,
                                pdata->algo__crosstalk_compensation_y_plane_gradient_kcps,
                                pdata->crosstalk_range_ignore_threshold_mult);
        } else {
                pdata->crosstalk_range_ignore_threshold_rate_mcps = 0;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
#ifndef VL53L1_NOCALIB
VL53L1_Error VL53L1_init_offset_cal_config_struct(
        VL53L1_offsetcal_config_t   *pdata)
{
        /*
         * Initializes Offset Calibration Config structure
         * - for use with VL53L1_run_offset_calibration()
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Preset Timeout and DSS defaults */
 
        pdata->dss_config__target_total_rate_mcps          =
                        VL53L1_TUNINGPARM_OFFSET_CAL_DSS_RATE_MCPS_DEFAULT;
        /* 20.0 Mcps */
        pdata->phasecal_config_timeout_us                  =
                        VL53L1_TUNINGPARM_OFFSET_CAL_PHASECAL_TIMEOUT_US_DEFAULT;
        /* 1000 us */
        pdata->range_config_timeout_us                     =
                        VL53L1_TUNINGPARM_OFFSET_CAL_RANGE_TIMEOUT_US_DEFAULT;
        /* 13000 us */
        pdata->mm_config_timeout_us                        =
                        VL53L1_TUNINGPARM_OFFSET_CAL_MM_TIMEOUT_US_DEFAULT;
        /* 13000 us - Added as part of Patch_AddedOffsetCalMMTuningParm_11791 */
 
        /* Init number of averaged samples */
 
        pdata->pre_num_of_samples                          =
                        VL53L1_TUNINGPARM_OFFSET_CAL_PRE_SAMPLES_DEFAULT;
        pdata->mm1_num_of_samples                          =
                        VL53L1_TUNINGPARM_OFFSET_CAL_MM1_SAMPLES_DEFAULT;
        pdata->mm2_num_of_samples                          =
                        VL53L1_TUNINGPARM_OFFSET_CAL_MM2_SAMPLES_DEFAULT;
 
        LOG_FUNCTION_END(status);
 
        return status;
}
#endif
 
VL53L1_Error VL53L1_init_tuning_parm_storage_struct(
        VL53L1_tuning_parm_storage_t   *pdata)
{
        /*
         * Initializes  Tuning Param storage structure
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Default configuration
         *
         * - Custom overwrite possible from vl53l1_set_tuning_parms()
         * - via tuning file input
         */
 
        pdata->tp_tuning_parm_version              =
                        VL53L1_TUNINGPARM_VERSION_DEFAULT;
        pdata->tp_tuning_parm_key_table_version    =
                        VL53L1_TUNINGPARM_KEY_TABLE_VERSION_DEFAULT;
        pdata->tp_tuning_parm_lld_version          =
                        VL53L1_TUNINGPARM_LLD_VERSION_DEFAULT;
        pdata->tp_init_phase_rtn_lite_long         =
                        VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_LONG_RANGE_DEFAULT;
        pdata->tp_init_phase_rtn_lite_med          =
                        VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_MED_RANGE_DEFAULT;
        pdata->tp_init_phase_rtn_lite_short        =
                        VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_SHORT_RANGE_DEFAULT;
        pdata->tp_init_phase_ref_lite_long         =
                        VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_LONG_RANGE_DEFAULT;
        pdata->tp_init_phase_ref_lite_med          =
                        VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_MED_RANGE_DEFAULT;
        pdata->tp_init_phase_ref_lite_short        =
                        VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_SHORT_RANGE_DEFAULT;
        pdata->tp_consistency_lite_phase_tolerance =
                        VL53L1_TUNINGPARM_CONSISTENCY_LITE_PHASE_TOLERANCE_DEFAULT;
        pdata->tp_phasecal_target                  =
                        VL53L1_TUNINGPARM_PHASECAL_TARGET_DEFAULT;
        pdata->tp_cal_repeat_rate                  =
                        VL53L1_TUNINGPARM_LITE_CAL_REPEAT_RATE_DEFAULT;
        pdata->tp_lite_min_clip                    =
                        VL53L1_TUNINGPARM_LITE_MIN_CLIP_MM_DEFAULT;
        pdata->tp_lite_long_sigma_thresh_mm        =
                        VL53L1_TUNINGPARM_LITE_LONG_SIGMA_THRESH_MM_DEFAULT;
        pdata->tp_lite_med_sigma_thresh_mm         =
                        VL53L1_TUNINGPARM_LITE_MED_SIGMA_THRESH_MM_DEFAULT;
        pdata->tp_lite_short_sigma_thresh_mm       =
                        VL53L1_TUNINGPARM_LITE_SHORT_SIGMA_THRESH_MM_DEFAULT;
        pdata->tp_lite_long_min_count_rate_rtn_mcps  =
                        VL53L1_TUNINGPARM_LITE_LONG_MIN_COUNT_RATE_RTN_MCPS_DEFAULT;
        pdata->tp_lite_med_min_count_rate_rtn_mcps   =
                        VL53L1_TUNINGPARM_LITE_MED_MIN_COUNT_RATE_RTN_MCPS_DEFAULT;
        pdata->tp_lite_short_min_count_rate_rtn_mcps =
                        VL53L1_TUNINGPARM_LITE_SHORT_MIN_COUNT_RATE_RTN_MCPS_DEFAULT;
        pdata->tp_lite_sigma_est_pulse_width_ns      =
                        VL53L1_TUNINGPARM_LITE_SIGMA_EST_PULSE_WIDTH_DEFAULT;
        pdata->tp_lite_sigma_est_amb_width_ns        =
                        VL53L1_TUNINGPARM_LITE_SIGMA_EST_AMB_WIDTH_NS_DEFAULT;
        pdata->tp_lite_sigma_ref_mm                  =
                        VL53L1_TUNINGPARM_LITE_SIGMA_REF_MM_DEFAULT;
        pdata->tp_lite_seed_cfg                      =
                        VL53L1_TUNINGPARM_LITE_SEED_CONFIG_DEFAULT;
        pdata->tp_timed_seed_cfg                     =
                        VL53L1_TUNINGPARM_TIMED_SEED_CONFIG_DEFAULT;
        pdata->tp_lite_quantifier                    =
                        VL53L1_TUNINGPARM_LITE_QUANTIFIER_DEFAULT;
        pdata->tp_lite_first_order_select            =
                        VL53L1_TUNINGPARM_LITE_FIRST_ORDER_SELECT_DEFAULT;
 
        /* Preset Mode Configurations */
        /* - New parms added as part of Patch_TuningParmPresetModeAddition_11839 */
 
        pdata->tp_dss_target_lite_mcps               =
                        VL53L1_TUNINGPARM_LITE_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT;
        pdata->tp_dss_target_timed_mcps              =
                        VL53L1_TUNINGPARM_TIMED_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT;
        pdata->tp_phasecal_timeout_lite_us           =
                        VL53L1_TUNINGPARM_LITE_PHASECAL_CONFIG_TIMEOUT_US;
        pdata->tp_phasecal_timeout_timed_us          =
                        VL53L1_TUNINGPARM_TIMED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
        pdata->tp_mm_timeout_lite_us                 =
                        VL53L1_TUNINGPARM_LITE_MM_CONFIG_TIMEOUT_US_DEFAULT;
        pdata->tp_mm_timeout_timed_us                =
                        VL53L1_TUNINGPARM_TIMED_MM_CONFIG_TIMEOUT_US_DEFAULT;
        pdata->tp_range_timeout_lite_us              =
                        VL53L1_TUNINGPARM_LITE_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
        pdata->tp_range_timeout_timed_us             =
                        VL53L1_TUNINGPARM_TIMED_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
 
        /* Added for Patch_LowPowerAutoMode */
 
        pdata->tp_mm_timeout_lpa_us =
                        VL53L1_TUNINGPARM_LOWPOWERAUTO_MM_CONFIG_TIMEOUT_US_DEFAULT;
        pdata->tp_range_timeout_lpa_us =
                        VL53L1_TUNINGPARM_LOWPOWERAUTO_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
 
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
 
VL53L1_Error VL53L1_preset_mode_standard_ranging(
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
         * Initializes static and dynamic data structures fordevice preset mode
         * VL53L1_DEVICEPRESETMODE_STANDARD_RANGING
         *
         *  - streaming
         *  - single sigma delta
         *  - back to back
         *
         *  PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Static Configuration */
 
        /* dss_config__target_total_rate_mcps = 20.0 Mcps 9.7 fp */
        pstatic->dss_config__target_total_rate_mcps               = 0x0A00;
        pstatic->debug__ctrl                                      = 0x00;
        pstatic->test_mode__ctrl                                  = 0x00;
        pstatic->clk_gating__ctrl                                 = 0x00;
        pstatic->nvm_bist__ctrl                                   = 0x00;
        pstatic->nvm_bist__num_nvm_words                          = 0x00;
        pstatic->nvm_bist__start_address                          = 0x00;
        pstatic->host_if__status                                  = 0x00;
        pstatic->pad_i2c_hv__config                               = 0x00;
        pstatic->pad_i2c_hv__extsup_config                        = 0x00;
 
        /*
         *  0 - gpio__extsup_hv
         *  1 - gpio__vmodeint_hv
         */
        pstatic->gpio_hv_pad__ctrl                                = 0x00;
 
        /*
         * Set interrupt active low
         *
         *  3:0 - gpio__mux_select_hv
         *    4 - gpio__mux_active_high_hv
         */
        pstatic->gpio_hv_mux__ctrl  = \
                        VL53L1_DEVICEINTERRUPTPOLARITY_ACTIVE_LOW | \
                        VL53L1_DEVICEGPIOMODE_OUTPUT_RANGE_AND_ERROR_INTERRUPTS;
 
        pstatic->gpio__tio_hv_status                              = 0x02;
        pstatic->gpio__fio_hv_status                              = 0x00;
        pstatic->ana_config__spad_sel_pswidth                     = 0x02;
        pstatic->ana_config__vcsel_pulse_width_offset             = 0x08;
        pstatic->ana_config__fast_osc__config_ctrl                = 0x00;
 
        pstatic->sigma_estimator__effective_pulse_width_ns        =
                        ptuning_parms->tp_lite_sigma_est_pulse_width_ns;
        pstatic->sigma_estimator__effective_ambient_width_ns      =
                        ptuning_parms->tp_lite_sigma_est_amb_width_ns;
        pstatic->sigma_estimator__sigma_ref_mm                    =
                        ptuning_parms->tp_lite_sigma_ref_mm;
        /* Minimum allowable value of 1 - 0 disables the feature */
        pstatic->algo__crosstalk_compensation_valid_height_mm     = 0x01;
        pstatic->spare_host_config__static_config_spare_0         = 0x00;
        pstatic->spare_host_config__static_config_spare_1         = 0x00;
 
        pstatic->algo__range_ignore_threshold_mcps                = 0x0000;
 
        /* set RIT distance to 20 mm */
        pstatic->algo__range_ignore_valid_height_mm               = 0xff;
        pstatic->algo__range_min_clip                             =
                        ptuning_parms->tp_lite_min_clip;
        /*
         * Phase consistency check limit - format 1.3 fp
         * 0x02 -> 0.25
         * 0x08 -> 1.00
         */
        pstatic->algo__consistency_check__tolerance               =
                        ptuning_parms->tp_consistency_lite_phase_tolerance;
        pstatic->spare_host_config__static_config_spare_2         = 0x00;
        pstatic->sd_config__reset_stages_msb                      = 0x00;
        pstatic->sd_config__reset_stages_lsb                      = 0x00;
 
        pgeneral->gph_config__stream_count_update_value           = 0x00;
        pgeneral->global_config__stream_divider                   = 0x00;
        pgeneral->system__interrupt_config_gpio =
                        VL53L1_INTERRUPT_CONFIG_NEW_SAMPLE_READY;
        pgeneral->cal_config__vcsel_start                         = 0x0B;
 
        /*
         * Set VHV / Phase Cal repeat rate to 1 every
         * 60 * 60 ranges (once every minute @ 60Hz)
         * 0 - disables
         * 12-bit value -> 4095 max
         */
        pgeneral->cal_config__repeat_rate                         =
                        ptuning_parms->tp_cal_repeat_rate;
        pgeneral->global_config__vcsel_width                      = 0x02;
        /* 13 macro periods gives a timeout of 1ms */
        pgeneral->phasecal_config__timeout_macrop                 = 0x0D;
        /* Phase cal target phase 2.0625 - 4.4 fp -> 0x21*/
        pgeneral->phasecal_config__target                         =
                        ptuning_parms->tp_phasecal_target;
        pgeneral->phasecal_config__override                       = 0x00;
        pgeneral->dss_config__roi_mode_control =
                        VL53L1_DEVICEDSSMODE__TARGET_RATE;
        /* format for threshold high and low is 9.7 fp */
        pgeneral->system__thresh_rate_high                        = 0x0000;
        pgeneral->system__thresh_rate_low                         = 0x0000;
        /* The format for manual effective spads is 8.8 -> 0x8C00 = 140.00 */
        pgeneral->dss_config__manual_effective_spads_select       = 0x8C00;
        pgeneral->dss_config__manual_block_select                 = 0x00;
 
        /*
         * Aperture attenuation value - format 0.8
         *
         * Nominal:  5x   -> 0.200000 * 256 = 51 = 0x33
         * Measured: 4.6x -> 0.217391 * 256 = 56 = 0x38
         */
        pgeneral->dss_config__aperture_attenuation                = 0x38;
        pgeneral->dss_config__max_spads_limit                     = 0xFF;
        pgeneral->dss_config__min_spads_limit                     = 0x01;
 
        /* Timing Configuration */
 
        /* Default timing of 2ms */
        ptiming->mm_config__timeout_macrop_a_hi                   = 0x00;
        ptiming->mm_config__timeout_macrop_a_lo                   = 0x1a;
        ptiming->mm_config__timeout_macrop_b_hi                   = 0x00;
        ptiming->mm_config__timeout_macrop_b_lo                   = 0x20;
        /* Setup for 30ms default */
        ptiming->range_config__timeout_macrop_a_hi                = 0x01;
        ptiming->range_config__timeout_macrop_a_lo                = 0xCC;
        /* register value 11 gives a 24 VCSEL period */
        ptiming->range_config__vcsel_period_a                     = 0x0B;
        /* Setup for 30ms default */
        ptiming->range_config__timeout_macrop_b_hi                = 0x01;
        ptiming->range_config__timeout_macrop_b_lo                = 0xF5;
        /* register value  09 gives a 20 VCSEL period */
        ptiming->range_config__vcsel_period_b                     = 0x09;
        /*
         * Sigma thresh register - format 14.2
         *
         * 0x003C -> 15.0 mm
         * 0x0050 -> 20.0 mm
         */
        ptiming->range_config__sigma_thresh                       =
                        ptuning_parms->tp_lite_med_sigma_thresh_mm;
        /*
         *  Rate Limit - format 9.7fp
         *  0x0020 -> 0.250 Mcps
         *  0x0080 -> 1.000 Mcps
         */
        ptiming->range_config__min_count_rate_rtn_limit_mcps      =
                        ptuning_parms->tp_lite_med_min_count_rate_rtn_mcps;
 
        /* Phase limit register formats = 5.3
         * low   = 0x08 ->  1.0
         * high  = 0x78 -> 15.0 -> 3.0m
         */
        ptiming->range_config__valid_phase_low                    = 0x08;
        ptiming->range_config__valid_phase_high                   = 0x78;
        ptiming->system__intermeasurement_period                  = 0x00000000;
        ptiming->system__fractional_enable                        = 0x00;
 
        /* Dynamic Configuration */
 
        pdynamic->system__grouped_parameter_hold_0                 = 0x01;
 
        pdynamic->system__thresh_high                              = 0x0000;
        pdynamic->system__thresh_low                               = 0x0000;
        pdynamic->system__enable_xtalk_per_quadrant                = 0x00;
        pdynamic->system__seed_config =
                        ptuning_parms->tp_lite_seed_cfg;
 
        /* Timing A */
        pdynamic->sd_config__woi_sd0                               = 0x0B;
        /* Timing B */
        pdynamic->sd_config__woi_sd1                               = 0x09;
 
        pdynamic->sd_config__initial_phase_sd0                     =
                        ptuning_parms->tp_init_phase_rtn_lite_med;
        pdynamic->sd_config__initial_phase_sd1                     =
                        ptuning_parms->tp_init_phase_ref_lite_med;;
 
        pdynamic->system__grouped_parameter_hold_1                 = 0x01;
 
        /*
         *  Quantifier settings
         *
         *  sd_config__first_order_select
         *     bit 0 - return sigma delta
         *     bit 1 - reference sigma delta
         *
         *  sd_config__first_order_select = 0x03 (1st order)
         *
         *      sd_config__quantifier options
         *        0
         *        1 ->   64
         *        2 ->  128
         *        3 ->  256
         *
         *  sd_config__first_order_select = 0x00 (2nd order)
         *
         *      sd_config__quantifier options
         *        0
         *        1  ->  256
         *        2  -> 1024
         *        3  -> 4095
         *
         *  Setting below 2nd order, Quantifier = 1024
         */
 
        pdynamic->sd_config__first_order_select =
                        ptuning_parms->tp_lite_first_order_select;
        pdynamic->sd_config__quantifier         =
                        ptuning_parms->tp_lite_quantifier;
 
        /* Below defaults will be overwritten by zone_cfg
         * Spad no = 199 (0xC7)
         * Spad no =  63 (0x3F)
         */
        pdynamic->roi_config__user_roi_centre_spad              = 0xC7;
        /* 16x16 ROI */
        pdynamic->roi_config__user_roi_requested_global_xy_size = 0xFF;
 
 
        pdynamic->system__sequence_config                          = \
                        VL53L1_SEQUENCE_VHV_EN | \
                        VL53L1_SEQUENCE_PHASECAL_EN | \
                        VL53L1_SEQUENCE_DSS1_EN | \
                        VL53L1_SEQUENCE_DSS2_EN | \
                        VL53L1_SEQUENCE_MM2_EN | \
                        VL53L1_SEQUENCE_RANGE_EN;
 
        pdynamic->system__grouped_parameter_hold                   = 0x02;
 
        /* System control */
 
 
        psystem->system__stream_count_ctrl                         = 0x00;
        psystem->firmware__enable                                  = 0x01;
        psystem->system__interrupt_clear                           = \
                        VL53L1_CLEAR_RANGE_INT;
 
        psystem->system__mode_start                                = \
                        VL53L1_DEVICESCHEDULERMODE_STREAMING | \
                        VL53L1_DEVICEREADOUTMODE_SINGLE_SD | \
                        VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
 
VL53L1_Error VL53L1_preset_mode_standard_ranging_short_range(
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
         * Initializes static and dynamic data structures for
         * device preset mode
         *
         * VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_SHORT_RANGE
         * (up to 1.4 metres)
         *
         * PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration followed by
         * overrides for the  short range configuration
         */
 
        status = VL53L1_preset_mode_standard_ranging(
                pstatic,
                pgeneral,
                ptiming,
                pdynamic,
                psystem,
                ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Timing Configuration
                 *
                 * vcsel_period_a    = 7 -> 16 period
                 * vcsel_period_b    = 5 -> 12 period
                 * sigma_thresh                  = 0x003C -> 14.2fp -> 15.0 mm
                 * min_count_rate_rtn_limit_mcps = 0x0080 ->  9.7fp ->  1.0 Mcps
                 * valid_phase_low               = 0x08 -> 5.3fp -> 1.0
                 * valid_phase_high              = 0x38 -> 5.3fp -> 7.0 -> 1.4m
                 */
 
                ptiming->range_config__vcsel_period_a                = 0x07;
                ptiming->range_config__vcsel_period_b                = 0x05;
                ptiming->range_config__sigma_thresh                  =
                                ptuning_parms->tp_lite_short_sigma_thresh_mm;
                ptiming->range_config__min_count_rate_rtn_limit_mcps =
                                ptuning_parms->tp_lite_short_min_count_rate_rtn_mcps;
                ptiming->range_config__valid_phase_low               = 0x08;
                ptiming->range_config__valid_phase_high              = 0x38;
 
                /* Dynamic Configuration
                 * SD0 -> Timing A
                 * SD1 -> Timing B
                 */
 
                pdynamic->sd_config__woi_sd0                         = 0x07;
                pdynamic->sd_config__woi_sd1                         = 0x05;
                pdynamic->sd_config__initial_phase_sd0               =
                                ptuning_parms->tp_init_phase_rtn_lite_short;
                pdynamic->sd_config__initial_phase_sd1               =
                                ptuning_parms->tp_init_phase_ref_lite_short;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
 
VL53L1_Error VL53L1_preset_mode_standard_ranging_long_range(
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
         * Initializes static and dynamic data structures for
         * device preset mode
         *
         * VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_LONG_RANGE
         * (up to 4.8 metres)
         *
         *  PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration with
         * overrides for long range configuration
         */
 
        status = VL53L1_preset_mode_standard_ranging(
                pstatic,
                pgeneral,
                ptiming,
                pdynamic,
                psystem,
                ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Timing Configuration
                 *
                 * vcsel_period_a    = 15 -> 32 period
                 * vcsel_period_b    = 13 -> 28 period
                 * sigma_thresh                  = 0x003C -> 14.2fp -> 15.0 mm
                 * min_count_rate_rtn_limit_mcps = 0x0080 ->  9.7fp ->  1.0 Mcps
                 * valid_phase_low               = 0x08 -> 5.3fp ->  1.0
                 * valid_phase_high              = 0xB8 -> 5.3fp -> 23.0 -> 4.6m
                 */
 
                ptiming->range_config__vcsel_period_a                = 0x0F;
                ptiming->range_config__vcsel_period_b                = 0x0D;
                ptiming->range_config__sigma_thresh                  =
                                ptuning_parms->tp_lite_long_sigma_thresh_mm;
                ptiming->range_config__min_count_rate_rtn_limit_mcps =
                                ptuning_parms->tp_lite_long_min_count_rate_rtn_mcps;
                ptiming->range_config__valid_phase_low               = 0x08;
                ptiming->range_config__valid_phase_high              = 0xB8;
 
                /* Dynamic Configuration
                 * SD0 -> Timing A
                 * SD1 -> Timing B
                 */
 
                pdynamic->sd_config__woi_sd0                         = 0x0F;
                pdynamic->sd_config__woi_sd1                         = 0x0D;
                pdynamic->sd_config__initial_phase_sd0               =
                                ptuning_parms->tp_init_phase_rtn_lite_long;
                pdynamic->sd_config__initial_phase_sd1               =
                                ptuning_parms->tp_init_phase_ref_lite_long;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
 
#ifndef VL53L1_NOCALIB
VL53L1_Error VL53L1_preset_mode_standard_ranging_mm1_cal(
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
         * Initializes static and dynamic data structures for
         * device preset mode
         *
         * VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM1_CAL
         *
         * PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration with
         * overrides for long range configuration
         */
 
        status = VL53L1_preset_mode_standard_ranging(
                pstatic,
                pgeneral,
                ptiming,
                pdynamic,
                psystem,
                ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                pgeneral->dss_config__roi_mode_control =
                                VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
 
                pdynamic->system__sequence_config  = \
                                VL53L1_SEQUENCE_VHV_EN | \
                                VL53L1_SEQUENCE_PHASECAL_EN | \
                                VL53L1_SEQUENCE_DSS1_EN | \
                                VL53L1_SEQUENCE_DSS2_EN | \
                                VL53L1_SEQUENCE_MM1_EN;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
 
VL53L1_Error VL53L1_preset_mode_standard_ranging_mm2_cal(
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
         * Initializes static and dynamic data structures for
         * device preset mode
         *
         * VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM2_CAL
         *
         * PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
         */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration with
         * overrides for long range configuration
         */
 
        status = VL53L1_preset_mode_standard_ranging(
                pstatic,
                pgeneral,
                ptiming,
                pdynamic,
                psystem,
                ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                pgeneral->dss_config__roi_mode_control =
                                VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
 
                pdynamic->system__sequence_config  = \
                                VL53L1_SEQUENCE_VHV_EN | \
                                VL53L1_SEQUENCE_PHASECAL_EN | \
                                VL53L1_SEQUENCE_DSS1_EN | \
                                VL53L1_SEQUENCE_DSS2_EN | \
                                VL53L1_SEQUENCE_MM2_EN;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
#endif
 
 
VL53L1_Error VL53L1_preset_mode_timed_ranging(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
        * Initializes static and dynamic data structures for
        * device preset mode
        *
        * VL53L1_DEVICEPRESETMODE_TIMED_RANGING
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *
        *  PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_standard_ranging(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Dynamic Configuration */
 
                /* Disable GPH  */
                pdynamic->system__grouped_parameter_hold = 0x00;
 
                /* Re-Configure timing budget default for 13ms */
                ptiming->range_config__timeout_macrop_a_hi                = 0x00;
                ptiming->range_config__timeout_macrop_a_lo                = 0xB1;
                /* Setup for 13ms default */
                ptiming->range_config__timeout_macrop_b_hi                = 0x00;
                ptiming->range_config__timeout_macrop_b_lo                = 0xD4;
 
                /* Timing Configuration */
 
                ptiming->system__intermeasurement_period = 0x00000600;
                pdynamic->system__seed_config =
                                ptuning_parms->tp_timed_seed_cfg;
 
                /* System control */
 
                /* Configure Timed/Psuedo-solo mode */
                psystem->system__mode_start =
                                VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO | \
                                VL53L1_DEVICEREADOUTMODE_SINGLE_SD     | \
                                VL53L1_DEVICEMEASUREMENTMODE_TIMED;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
VL53L1_Error VL53L1_preset_mode_timed_ranging_short_range(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
        * Initializes static and dynamic data structures for
        * device preset mode
        *
        * VL53L1_DEVICEPRESETMODE_TIMED_RANGING_SHORT_RANGE
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *
        *  PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_standard_ranging_short_range(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Dynamic Configuration */
 
                /* Disable GPH  */
                pdynamic->system__grouped_parameter_hold = 0x00;
 
 
                /* Timing Configuration */
 
                /* Re-Configure timing budget default for 13ms */
                ptiming->range_config__timeout_macrop_a_hi                = 0x01;
                ptiming->range_config__timeout_macrop_a_lo                = 0x84;
                /* Setup for 13ms default */
                ptiming->range_config__timeout_macrop_b_hi                = 0x01;
                ptiming->range_config__timeout_macrop_b_lo                = 0xB1;
 
                ptiming->system__intermeasurement_period = 0x00000600;
                pdynamic->system__seed_config =
                                ptuning_parms->tp_timed_seed_cfg;
 
                /* System control */
 
                /* Configure Timed/Psuedo-solo mode */
                psystem->system__mode_start =
                                VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO | \
                                VL53L1_DEVICEREADOUTMODE_SINGLE_SD     | \
                                VL53L1_DEVICEMEASUREMENTMODE_TIMED;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
VL53L1_Error VL53L1_preset_mode_timed_ranging_long_range(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
        * Initializes static and dynamic data structures for
        * device preset mode
        *
        * VL53L1_DEVICEPRESETMODE_TIMED_RANGING_LONG_RANGE
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *
        *  PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_standard_ranging_long_range(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Dynamic Configuration */
 
                /* Disable GPH  */
                pdynamic->system__grouped_parameter_hold = 0x00;
 
 
                /* Timing Configuration */
 
                /* Re-Configure timing budget default for 13ms */
                ptiming->range_config__timeout_macrop_a_hi                = 0x00;
                ptiming->range_config__timeout_macrop_a_lo                = 0x97;
                /* Setup for 13ms default */
                ptiming->range_config__timeout_macrop_b_hi                = 0x00;
                ptiming->range_config__timeout_macrop_b_lo                = 0xB1;
 
                ptiming->system__intermeasurement_period = 0x00000600;
                pdynamic->system__seed_config =
                                ptuning_parms->tp_timed_seed_cfg;
 
                /* System control */
 
                /* Configure Timed/Psuedo-solo mode */
                psystem->system__mode_start =
                                VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO | \
                                VL53L1_DEVICEREADOUTMODE_SINGLE_SD     | \
                                VL53L1_DEVICEMEASUREMENTMODE_TIMED;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
/* Start Patch_LowPowerAutoMode */
VL53L1_Error VL53L1_preset_mode_low_power_auto_ranging(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms,
        VL53L1_low_power_auto_data_t *plpadata)
{
        /*
        * Initializes static and dynamic data structures for
        * device preset mode
        *
        * VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_MEDIUM_RANGE
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *  - special low power auto mode for Presence application
        *
        *  PLEASE NOTE THE SETTINGS BELOW ARE PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_timed_ranging(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now setup the low power auto mode */
 
        if (status == VL53L1_ERROR_NONE) {
                status = VL53L1_config_low_power_auto_mode(
                                pgeneral,
                                pdynamic,
                                plpadata
                                );
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
VL53L1_Error VL53L1_preset_mode_low_power_auto_short_ranging(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms,
        VL53L1_low_power_auto_data_t *plpadata)
{
        /*
        * Initializes static and dynamic data structures for
        * device preset mode
        *
        * VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_SHORT_RANGE
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *  - special low power auto mode for Presence application
        *
        *  PLEASE NOTE THE SETTINGS BELOW ARE PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_timed_ranging_short_range(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now setup the low power auto mode */
 
        if (status == VL53L1_ERROR_NONE) {
                status = VL53L1_config_low_power_auto_mode(
                                pgeneral,
                                pdynamic,
                                plpadata
                                );
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
VL53L1_Error VL53L1_preset_mode_low_power_auto_long_ranging(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms,
        VL53L1_low_power_auto_data_t *plpadata)
{
        /*
        * Initializes static and dynamic data structures for
        * device preset mode
        *
        * VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_LONG_RANGE
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *  - special low power auto mode for Presence application
        *
        *  PLEASE NOTE THE SETTINGS BELOW ARE PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_timed_ranging_long_range(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now setup the low power auto mode */
 
        if (status == VL53L1_ERROR_NONE) {
                status = VL53L1_config_low_power_auto_mode(
                                pgeneral,
                                pdynamic,
                                plpadata
                                );
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
/* End Patch_LowPowerAutoMode */
 
VL53L1_Error VL53L1_preset_mode_singleshot_ranging(
 
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        /*
        * Initializes static and dynamic data structures for device preset mode
        * VL53L1_DEVICEPRESETMODE_TIMED_RANGING
        *
        *  - pseudo-solo
        *  - single sigma delta
        *  - timed
        *
        *  PLEASE NOTE THE SETTINGS BELOW AT PROVISIONAL AND WILL CHANGE!
        */
 
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_standard_ranging(
                pstatic,
                pgeneral,
                ptiming,
                pdynamic,
                psystem,
                ptuning_parms);
 
        /* now override standard ranging specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Dynamic Configuration */
 
                /* Disable GPH  */
                pdynamic->system__grouped_parameter_hold = 0x00;
 
                /* Timing Configuration */
 
                /* Re-Configure timing budget default for 13ms */
                ptiming->range_config__timeout_macrop_a_hi                = 0x00;
                ptiming->range_config__timeout_macrop_a_lo                = 0xB1;
                /* Setup for 13ms default */
                ptiming->range_config__timeout_macrop_b_hi                = 0x00;
                ptiming->range_config__timeout_macrop_b_lo                = 0xD4;
 
                pdynamic->system__seed_config =
                                ptuning_parms->tp_timed_seed_cfg;
 
                /* System control */
 
                /* Configure Timed/Psuedo-solo mode */
                psystem->system__mode_start = \
                                VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO | \
                                VL53L1_DEVICEREADOUTMODE_SINGLE_SD     | \
                                VL53L1_DEVICEMEASUREMENTMODE_SINGLESHOT;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}
 
 
VL53L1_Error VL53L1_preset_mode_olt(
        VL53L1_static_config_t    *pstatic,
        VL53L1_general_config_t   *pgeneral,
        VL53L1_timing_config_t    *ptiming,
        VL53L1_dynamic_config_t   *pdynamic,
        VL53L1_system_control_t   *psystem,
        VL53L1_tuning_parm_storage_t *ptuning_parms)
{
        VL53L1_Error  status = VL53L1_ERROR_NONE;
 
        LOG_FUNCTION_START("");
 
        /* Call standard ranging configuration */
 
        status = VL53L1_preset_mode_standard_ranging(
                                        pstatic,
                                        pgeneral,
                                        ptiming,
                                        pdynamic,
                                        psystem,
                                        ptuning_parms);
 
        /* now override OLT specific registers */
 
        if (status == VL53L1_ERROR_NONE) {
 
                /* Disables requirement for host handshake */
                psystem->system__stream_count_ctrl  = 0x01;
        }
 
        LOG_FUNCTION_END(status);
 
        return status;
}