charles macneill / VL53L1CB

Initial release. Mbed library for VL53L1CB

src/vl53l1_zone_presets.c@0:3d72bef69191, 2020-11-06 (annotated)

Committer:
charlesmn
Date:
Fri Nov 06 12:15:24 2020 +0000
Revision:
0:3d72bef69191
Initial release. Mbed library for VL53L1CB

Who changed what in which revision?

UserRevisionLine numberNew contents of line
charlesmn 0:3d72bef69191 1
charlesmn 0:3d72bef69191 2 /*******************************************************************************
charlesmn 0:3d72bef69191 3 * Copyright (c) 2020, STMicroelectronics - All Rights Reserved
charlesmn 0:3d72bef69191 4
charlesmn 0:3d72bef69191 5 This file is part of VL53L1 Core and is dual licensed,
charlesmn 0:3d72bef69191 6 either 'STMicroelectronics
charlesmn 0:3d72bef69191 7 Proprietary license'
charlesmn 0:3d72bef69191 8 or 'BSD 3-clause "New" or "Revised" License' , at your option.
charlesmn 0:3d72bef69191 9
charlesmn 0:3d72bef69191 10 ********************************************************************************
charlesmn 0:3d72bef69191 11
charlesmn 0:3d72bef69191 12 'STMicroelectronics Proprietary license'
charlesmn 0:3d72bef69191 13
charlesmn 0:3d72bef69191 14 ********************************************************************************
charlesmn 0:3d72bef69191 15
charlesmn 0:3d72bef69191 16 License terms: STMicroelectronics Proprietary in accordance with licensing
charlesmn 0:3d72bef69191 17 terms at www.st.com/sla0081
charlesmn 0:3d72bef69191 18
charlesmn 0:3d72bef69191 19 STMicroelectronics confidential
charlesmn 0:3d72bef69191 20 Reproduction and Communication of this document is strictly prohibited unless
charlesmn 0:3d72bef69191 21 specifically authorized in writing by STMicroelectronics.
charlesmn 0:3d72bef69191 22
charlesmn 0:3d72bef69191 23
charlesmn 0:3d72bef69191 24 ********************************************************************************
charlesmn 0:3d72bef69191 25
charlesmn 0:3d72bef69191 26 Alternatively, VL53L1 Core may be distributed under the terms of
charlesmn 0:3d72bef69191 27 'BSD 3-clause "New" or "Revised" License', in which case the following
charlesmn 0:3d72bef69191 28 provisions apply instead of the ones
charlesmn 0:3d72bef69191 29 mentioned above :
charlesmn 0:3d72bef69191 30
charlesmn 0:3d72bef69191 31 ********************************************************************************
charlesmn 0:3d72bef69191 32
charlesmn 0:3d72bef69191 33 License terms: BSD 3-clause "New" or "Revised" License.
charlesmn 0:3d72bef69191 34
charlesmn 0:3d72bef69191 35 Redistribution and use in source and binary forms, with or without
charlesmn 0:3d72bef69191 36 modification, are permitted provided that the following conditions are met:
charlesmn 0:3d72bef69191 37
charlesmn 0:3d72bef69191 38 1. Redistributions of source code must retain the above copyright notice, this
charlesmn 0:3d72bef69191 39 list of conditions and the following disclaimer.
charlesmn 0:3d72bef69191 40
charlesmn 0:3d72bef69191 41 2. Redistributions in binary form must reproduce the above copyright notice,
charlesmn 0:3d72bef69191 42 this list of conditions and the following disclaimer in the documentation
charlesmn 0:3d72bef69191 43 and/or other materials provided with the distribution.
charlesmn 0:3d72bef69191 44
charlesmn 0:3d72bef69191 45 3. Neither the name of the copyright holder nor the names of its contributors
charlesmn 0:3d72bef69191 46 may be used to endorse or promote products derived from this software
charlesmn 0:3d72bef69191 47 without specific prior written permission.
charlesmn 0:3d72bef69191 48
charlesmn 0:3d72bef69191 49 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
charlesmn 0:3d72bef69191 50 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
charlesmn 0:3d72bef69191 51 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
charlesmn 0:3d72bef69191 52 DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
charlesmn 0:3d72bef69191 53 FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
charlesmn 0:3d72bef69191 54 DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
charlesmn 0:3d72bef69191 55 SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
charlesmn 0:3d72bef69191 56 CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
charlesmn 0:3d72bef69191 57 OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
charlesmn 0:3d72bef69191 58 OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
charlesmn 0:3d72bef69191 59
charlesmn 0:3d72bef69191 60
charlesmn 0:3d72bef69191 61 ********************************************************************************
charlesmn 0:3d72bef69191 62
charlesmn 0:3d72bef69191 63 */
charlesmn 0:3d72bef69191 64
charlesmn 0:3d72bef69191 65
charlesmn 0:3d72bef69191 66
charlesmn 0:3d72bef69191 67
charlesmn 0:3d72bef69191 68 #include "vl53l1_ll_def.h"
charlesmn 0:3d72bef69191 69 #include "vl53l1_ll_device.h"
charlesmn 0:3d72bef69191 70 #include "vl53l1_platform_log.h"
charlesmn 0:3d72bef69191 71 #include "vl53l1_zone_presets.h"
charlesmn 0:3d72bef69191 72
charlesmn 0:3d72bef69191 73
charlesmn 0:3d72bef69191 74 #define LOG_FUNCTION_START(fmt, ...) \
charlesmn 0:3d72bef69191 75 _LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
charlesmn 0:3d72bef69191 76 #define LOG_FUNCTION_END(status, ...) \
charlesmn 0:3d72bef69191 77 _LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
charlesmn 0:3d72bef69191 78 #define LOG_FUNCTION_END_FMT(status, fmt, ...) \
charlesmn 0:3d72bef69191 79 _LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE,\
charlesmn 0:3d72bef69191 80 status, fmt, ##__VA_ARGS__)
charlesmn 0:3d72bef69191 81
charlesmn 0:3d72bef69191 82
charlesmn 0:3d72bef69191 83 VL53L1_Error VL53L1_init_zone_config_structure(
charlesmn 0:3d72bef69191 84 uint8_t x_off,
charlesmn 0:3d72bef69191 85 uint8_t x_inc,
charlesmn 0:3d72bef69191 86 uint8_t x_zones,
charlesmn 0:3d72bef69191 87 uint8_t y_off,
charlesmn 0:3d72bef69191 88 uint8_t y_inc,
charlesmn 0:3d72bef69191 89 uint8_t y_zones,
charlesmn 0:3d72bef69191 90 uint8_t width,
charlesmn 0:3d72bef69191 91 uint8_t height,
charlesmn 0:3d72bef69191 92 VL53L1_zone_config_t *pdata)
charlesmn 0:3d72bef69191 93 {
charlesmn 0:3d72bef69191 94
charlesmn 0:3d72bef69191 95
charlesmn 0:3d72bef69191 96 VL53L1_Error status = VL53L1_ERROR_NONE;
charlesmn 0:3d72bef69191 97
charlesmn 0:3d72bef69191 98 uint8_t x = 0;
charlesmn 0:3d72bef69191 99 uint8_t y = 0;
charlesmn 0:3d72bef69191 100 uint16_t i = 0;
charlesmn 0:3d72bef69191 101
charlesmn 0:3d72bef69191 102 LOG_FUNCTION_START("");
charlesmn 0:3d72bef69191 103
charlesmn 0:3d72bef69191 104 pdata->max_zones = VL53L1_MAX_USER_ZONES;
charlesmn 0:3d72bef69191 105
charlesmn 0:3d72bef69191 106 i = 0;
charlesmn 0:3d72bef69191 107
charlesmn 0:3d72bef69191 108 for (x = 0 ; x < x_zones ; x++) {
charlesmn 0:3d72bef69191 109 for (y = 0 ; y < y_zones ; y++) {
charlesmn 0:3d72bef69191 110
charlesmn 0:3d72bef69191 111 if (i < VL53L1_MAX_USER_ZONES) {
charlesmn 0:3d72bef69191 112
charlesmn 0:3d72bef69191 113 pdata->active_zones = (uint8_t)i;
charlesmn 0:3d72bef69191 114 pdata->user_zones[i].height = height;
charlesmn 0:3d72bef69191 115 pdata->user_zones[i].width = width;
charlesmn 0:3d72bef69191 116 pdata->user_zones[i].x_centre =
charlesmn 0:3d72bef69191 117 x_off + (x * x_inc);
charlesmn 0:3d72bef69191 118 pdata->user_zones[i].y_centre =
charlesmn 0:3d72bef69191 119 y_off + (y * y_inc);
charlesmn 0:3d72bef69191 120 }
charlesmn 0:3d72bef69191 121
charlesmn 0:3d72bef69191 122 i++;
charlesmn 0:3d72bef69191 123 }
charlesmn 0:3d72bef69191 124 }
charlesmn 0:3d72bef69191 125
charlesmn 0:3d72bef69191 126 status = VL53L1_init_zone_config_histogram_bins(pdata);
charlesmn 0:3d72bef69191 127
charlesmn 0:3d72bef69191 128
charlesmn 0:3d72bef69191 129 LOG_FUNCTION_END(status);
charlesmn 0:3d72bef69191 130
charlesmn 0:3d72bef69191 131 return status;
charlesmn 0:3d72bef69191 132 }
charlesmn 0:3d72bef69191 133
charlesmn 0:3d72bef69191 134
charlesmn 0:3d72bef69191 135 VL53L1_Error VL53L1_zone_preset_xtalk_planar(
charlesmn 0:3d72bef69191 136 VL53L1_general_config_t *pgeneral,
charlesmn 0:3d72bef69191 137 VL53L1_zone_config_t *pzone_cfg)
charlesmn 0:3d72bef69191 138 {
charlesmn 0:3d72bef69191 139
charlesmn 0:3d72bef69191 140
charlesmn 0:3d72bef69191 141 VL53L1_Error status = VL53L1_ERROR_NONE;
charlesmn 0:3d72bef69191 142
charlesmn 0:3d72bef69191 143 LOG_FUNCTION_START("");
charlesmn 0:3d72bef69191 144
charlesmn 0:3d72bef69191 145
charlesmn 0:3d72bef69191 146 pgeneral->global_config__stream_divider = 0x05;
charlesmn 0:3d72bef69191 147
charlesmn 0:3d72bef69191 148
charlesmn 0:3d72bef69191 149 pzone_cfg->active_zones = 0x04;
charlesmn 0:3d72bef69191 150
charlesmn 0:3d72bef69191 151 pzone_cfg->user_zones[0].height = 15;
charlesmn 0:3d72bef69191 152 pzone_cfg->user_zones[0].width = 7;
charlesmn 0:3d72bef69191 153 pzone_cfg->user_zones[0].x_centre = 4;
charlesmn 0:3d72bef69191 154 pzone_cfg->user_zones[0].y_centre = 8;
charlesmn 0:3d72bef69191 155
charlesmn 0:3d72bef69191 156 pzone_cfg->user_zones[1].height = 15;
charlesmn 0:3d72bef69191 157 pzone_cfg->user_zones[1].width = 7;
charlesmn 0:3d72bef69191 158 pzone_cfg->user_zones[1].x_centre = 12;
charlesmn 0:3d72bef69191 159 pzone_cfg->user_zones[1].y_centre = 8;
charlesmn 0:3d72bef69191 160
charlesmn 0:3d72bef69191 161 pzone_cfg->user_zones[2].height = 7;
charlesmn 0:3d72bef69191 162 pzone_cfg->user_zones[2].width = 15;
charlesmn 0:3d72bef69191 163 pzone_cfg->user_zones[2].x_centre = 8;
charlesmn 0:3d72bef69191 164 pzone_cfg->user_zones[2].y_centre = 4;
charlesmn 0:3d72bef69191 165
charlesmn 0:3d72bef69191 166 pzone_cfg->user_zones[3].height = 7;
charlesmn 0:3d72bef69191 167 pzone_cfg->user_zones[3].width = 15;
charlesmn 0:3d72bef69191 168 pzone_cfg->user_zones[3].x_centre = 8;
charlesmn 0:3d72bef69191 169 pzone_cfg->user_zones[3].y_centre = 12;
charlesmn 0:3d72bef69191 170
charlesmn 0:3d72bef69191 171
charlesmn 0:3d72bef69191 172
charlesmn 0:3d72bef69191 173 pzone_cfg->user_zones[4].height = 15;
charlesmn 0:3d72bef69191 174 pzone_cfg->user_zones[4].width = 15;
charlesmn 0:3d72bef69191 175 pzone_cfg->user_zones[4].x_centre = 8;
charlesmn 0:3d72bef69191 176 pzone_cfg->user_zones[4].y_centre = 8;
charlesmn 0:3d72bef69191 177
charlesmn 0:3d72bef69191 178 status = VL53L1_init_zone_config_histogram_bins(pzone_cfg);
charlesmn 0:3d72bef69191 179
charlesmn 0:3d72bef69191 180
charlesmn 0:3d72bef69191 181 LOG_FUNCTION_END(status);
charlesmn 0:3d72bef69191 182
charlesmn 0:3d72bef69191 183 return status;
charlesmn 0:3d72bef69191 184 }
charlesmn 0:3d72bef69191 185
charlesmn 0:3d72bef69191 186
charlesmn 0:3d72bef69191 187 VL53L1_Error VL53L1_init_zone_config_histogram_bins(
charlesmn 0:3d72bef69191 188 VL53L1_zone_config_t *pdata)
charlesmn 0:3d72bef69191 189 {
charlesmn 0:3d72bef69191 190
charlesmn 0:3d72bef69191 191
charlesmn 0:3d72bef69191 192 VL53L1_Error status = VL53L1_ERROR_NONE;
charlesmn 0:3d72bef69191 193
charlesmn 0:3d72bef69191 194 uint8_t i;
charlesmn 0:3d72bef69191 195
charlesmn 0:3d72bef69191 196 LOG_FUNCTION_START("");
charlesmn 0:3d72bef69191 197
charlesmn 0:3d72bef69191 198 for (i = 0; i < pdata->max_zones; i++)
charlesmn 0:3d72bef69191 199 pdata->bin_config[i] = VL53L1_ZONECONFIG_BINCONFIG__LOWAMB;
charlesmn 0:3d72bef69191 200
charlesmn 0:3d72bef69191 201 LOG_FUNCTION_END(status);
charlesmn 0:3d72bef69191 202
charlesmn 0:3d72bef69191 203 return status;
charlesmn 0:3d72bef69191 204 }
charlesmn 0:3d72bef69191 205
charlesmn 0:3d72bef69191 206