From 0b2cdbc8ba2abcb21b3ddaf1611a4d1fbcaf2f90 Mon Sep 17 00:00:00 2001 From: Mysteo91 Date: Mon, 31 Jul 2023 10:42:03 +0300 Subject: [PATCH] ---vl6180dr --- main_prog/CMakeLists.txt | 6 +- main_prog/Drivers/BSP/custom/custom.c | 556 ++++ main_prog/Drivers/BSP/custom/custom.h | 273 ++ main_prog/Drivers/BSP/custom/custom_errno.h | 58 + .../Drivers/BSP/vl6180/Release_Notes.html | 1244 +++++++++ .../colorschememapping.xml | 2 + .../vl6180/Release_Notes_files/filelist.xml | 6 + .../vl6180/Release_Notes_files/image001.png | Bin 0 -> 18616 bytes .../vl6180/Release_Notes_files/image003.png | Bin 0 -> 12834 bytes .../vl6180/Release_Notes_files/themedata.thmx | Bin 0 -> 3138 bytes main_prog/Drivers/BSP/vl6180/vl6180_api.c | 2366 +++++++++++++++++ main_prog/Drivers/BSP/vl6180/vl6180_api.h | 866 ++++++ main_prog/Drivers/BSP/vl6180/vl6180_cfg.h | 104 + main_prog/Drivers/BSP/vl6180/vl6180_def.h | 677 +++++ main_prog/vl6180/App/custom_bus.h | 139 + main_prog/vl6180/App/custom_conf.h | 82 + main_prog/vl6180/App/custom_errno.h | 58 + main_prog/vl6180/App/vl6180_app.c | 257 ++ main_prog/vl6180/App/vl6180_app.h | 9 + main_prog/vl6180/Target/vl6180_appcfg.h | 92 + main_prog/vl6180/Target/vl6180_i2c.c | 241 ++ main_prog/vl6180/Target/vl6180_i2c.h | 166 ++ main_prog/vl6180/Target/vl6180_platform.h | 115 + main_prog/vl6180/Target/vl6180_types.h | 62 + 24 files changed, 7378 insertions(+), 1 deletion(-) create mode 100644 main_prog/Drivers/BSP/custom/custom.c create mode 100644 main_prog/Drivers/BSP/custom/custom.h create mode 100644 main_prog/Drivers/BSP/custom/custom_errno.h create mode 100644 main_prog/Drivers/BSP/vl6180/Release_Notes.html create mode 100644 main_prog/Drivers/BSP/vl6180/Release_Notes_files/colorschememapping.xml create mode 100644 main_prog/Drivers/BSP/vl6180/Release_Notes_files/filelist.xml create mode 100644 main_prog/Drivers/BSP/vl6180/Release_Notes_files/image001.png create mode 100644 main_prog/Drivers/BSP/vl6180/Release_Notes_files/image003.png create mode 100644 main_prog/Drivers/BSP/vl6180/Release_Notes_files/themedata.thmx create mode 100644 main_prog/Drivers/BSP/vl6180/vl6180_api.c create mode 100644 main_prog/Drivers/BSP/vl6180/vl6180_api.h create mode 100644 main_prog/Drivers/BSP/vl6180/vl6180_cfg.h create mode 100644 main_prog/Drivers/BSP/vl6180/vl6180_def.h create mode 100644 main_prog/vl6180/App/custom_bus.h create mode 100644 main_prog/vl6180/App/custom_conf.h create mode 100644 main_prog/vl6180/App/custom_errno.h create mode 100644 main_prog/vl6180/App/vl6180_app.c create mode 100644 main_prog/vl6180/App/vl6180_app.h create mode 100644 main_prog/vl6180/Target/vl6180_appcfg.h create mode 100644 main_prog/vl6180/Target/vl6180_i2c.c create mode 100644 main_prog/vl6180/Target/vl6180_i2c.h create mode 100644 main_prog/vl6180/Target/vl6180_platform.h create mode 100644 main_prog/vl6180/Target/vl6180_types.h diff --git a/main_prog/CMakeLists.txt b/main_prog/CMakeLists.txt index a227bdd..fd2c334 100644 --- a/main_prog/CMakeLists.txt +++ b/main_prog/CMakeLists.txt @@ -19,6 +19,10 @@ set(INCLUDE_DIR ../loader ../Boot/App ../ARMCM0_STM32G0 + vl6180/Target + vl6180/App + Drivers/BSP/vl6180 + Drivers/BSP/custom #///////////////////////////////////////////// ) @@ -67,7 +71,7 @@ set(INCLUDE_DIR add_compile_definitions(BLACKBOX_CACHE=1) #//////////////////////////USER SOURCES FILES - file( GLOB_RECURSE SOURCES "Core/Src/*.*" "../App/*.*" "../loader/*.*") + file( GLOB_RECURSE SOURCES "Core/Src/*.*" "../App/*.*" "../loader/*.*" "Drivers/BSP/*.c" "vl6180/*.c") #///////////////////END USER SOURCES FILES diff --git a/main_prog/Drivers/BSP/custom/custom.c b/main_prog/Drivers/BSP/custom/custom.c new file mode 100644 index 0000000..d9e71b6 --- /dev/null +++ b/main_prog/Drivers/BSP/custom/custom.c @@ -0,0 +1,556 @@ +/* USER CODE BEGIN Header */ +/** + ****************************************************************************** + * @file : custom.c + * @brief : Source file for the BSP Common driver + ****************************************************************************** + * @attention + * + * Copyright (c) 2022 STMicroelectronics. + * All rights reserved. + * + * This software is licensed under terms that can be found in the LICENSE file + * in the root directory of this software component. + * If no LICENSE file comes with this software, it is provided AS-IS. + * + ****************************************************************************** +*/ +/* USER CODE END Header */ + +/* Includes ------------------------------------------------------------------*/ +#include "custom.h" + +/** @defgroup BSP BSP + * @{ + */ + +/** @defgroup CUSTOM CUSTOM + * @{ + */ + +/** @defgroup CUSTOM_LOW_LEVEL CUSTOM LOW LEVEL + * @brief This file provides set of firmware functions to manage Leds and push-button + * available on STM32WBxx-Nucleo Kit from STMicroelectronics. + * @{ + */ + +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_Private_Defines CUSTOM LOW LEVEL Private Defines + * @{ + */ + +/** @defgroup CUSTOM_LOW_LEVEL_FunctionPrototypes CUSTOM LOW LEVEL Private Function Prototypes + * @{ + */ + +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_Private_Variables CUSTOM LOW LEVEL Private Variables + * @{ + */ +typedef void (* BSP_LED_GPIO_Init) (void); +static GPIO_TypeDef* LED_PORT[LEDn] = {LED2_GPIO_PORT}; +static const uint16_t LED_PIN[LEDn] = {LED2_PIN}; +static void LED_USER_GPIO_Init(void); + +USART_TypeDef* COM_USART[COMn] = {COM1_UART}; +UART_HandleTypeDef hcom_uart[COMn]; +#if (USE_COM_LOG > 0) +static COM_TypeDef COM_ActiveLogPort; +#endif +#if (USE_HAL_UART_REGISTER_CALLBACKS == 1U) +static uint32_t IslpUart1MspCbValid = 0; +#endif +__weak HAL_StatusTypeDef MX_LPUART1_UART_Init(UART_HandleTypeDef* huart); +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_Private_Functions CUSTOM LOW LEVEL Private Functions + * @{ + */ +#if (USE_BSP_COM_FEATURE > 0) +static void LPUART1_MspInit(UART_HandleTypeDef *huart); +static void LPUART1_MspDeInit(UART_HandleTypeDef *huart); +#endif +/** + * @brief This method returns the STM32WBxx NUCLEO BSP Driver revision + * @retval version: 0xXYZR (8bits for each decimal, R for RC) + */ +int32_t BSP_GetVersion(void) +{ + return (int32_t)__CUSTOM_BSP_VERSION; +} + +/** + * @brief Configures LED on GPIO and/or on MFX. + * @param Led: LED to be configured. + * This parameter can be one of the following values: + * @arg LED2, LED4, ... + * @retval HAL status + */ +int32_t BSP_LED_Init(Led_TypeDef Led) +{ + static const BSP_LED_GPIO_Init LedGpioInit[LEDn] = {LED_USER_GPIO_Init}; + LedGpioInit[Led](); + return BSP_ERROR_NONE; +} + +/** + * @brief DeInit LEDs. + * @param Led: LED to be configured. + * This parameter can be one of the following values: + * @arg LED2, LED4, ... + * @note Led DeInit does not disable the GPIO clock nor disable the Mfx + * @retval HAL status + */ +int32_t BSP_LED_DeInit(Led_TypeDef Led) +{ + GPIO_InitTypeDef gpio_init_structure; + + /* Turn off LED */ + HAL_GPIO_WritePin(LED_PORT[Led], LED_PIN[Led], GPIO_PIN_RESET); + /* DeInit the GPIO_LED pin */ + gpio_init_structure.Pin = LED_PIN[Led]; + HAL_GPIO_DeInit(LED_PORT[Led], gpio_init_structure.Pin); + + return BSP_ERROR_NONE; +} + +/** + * @brief Turns selected LED On. + * @param Led: LED to be set on + * This parameter can be one of the following values: + * @arg LED1 + * @arg LED2 + * @arg LED3 + * @arg LED4 + * @retval HAL status + */ +int32_t BSP_LED_On(Led_TypeDef Led) +{ + HAL_GPIO_WritePin(LED_PORT [Led], LED_PIN [Led], GPIO_PIN_SET); + + return BSP_ERROR_NONE; +} + +/** + * @brief Turns selected LED Off. + * @param Led: LED to be set off + * This parameter can be one of the following values: + * @arg LED1 + * @arg LED2 + * @arg LED3 + * @arg LED4 + * @retval HAL status + */ +int32_t BSP_LED_Off(Led_TypeDef Led) +{ + HAL_GPIO_WritePin(LED_PORT [Led], LED_PIN [Led], GPIO_PIN_RESET); + + return BSP_ERROR_NONE; +} + +/** + * @brief Toggles the selected LED. + * @param Led: LED to be toggled + * This parameter can be one of the following values: + * @arg LED1 + * @arg LED2 + * @arg LED3 + * @arg LED4 + * @retval HAL status + */ +int32_t BSP_LED_Toggle(Led_TypeDef Led) +{ + HAL_GPIO_TogglePin(LED_PORT[Led], LED_PIN[Led]); + + return BSP_ERROR_NONE; +} + +/** + * @brief Get the status of the LED. + * @param Led: LED for which get the status + * This parameter can be one of the following values: + * @arg LED1 + * @arg LED2 + * @arg LED3 + * @arg LED4 + * @retval HAL status (1=high, 0=low) + */ +int32_t BSP_LED_GetState(Led_TypeDef Led) +{ + return (int32_t)(HAL_GPIO_ReadPin (LED_PORT [Led], LED_PIN [Led]) == GPIO_PIN_RESET); +} +/** + * @brief + * @retval None + */ +static void LED_USER_GPIO_Init(void) { + + /* GPIO Ports Clock Enable */ + __HAL_RCC_GPIOB_CLK_ENABLE(); + + GPIO_InitTypeDef GPIO_InitStruct = {0}; + + /* GPIO Ports Clock Enable */ + __HAL_RCC_GPIOB_CLK_ENABLE(); + + /*Configure GPIO pin Output Level */ + HAL_GPIO_WritePin(BUS_BSP_LED_GPIO_PORT, BUS_BSP_LED_GPIO_PIN, GPIO_PIN_RESET); + + /*Configure GPIO pin : PTPIN */ + GPIO_InitStruct.Pin = BUS_BSP_LED_GPIO_PIN; + GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; + GPIO_InitStruct.Pull = GPIO_NOPULL; + GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; + HAL_GPIO_Init(BUS_BSP_LED_GPIO_PORT, &GPIO_InitStruct); + +} + +#if (USE_BSP_COM_FEATURE > 0) +/** + * @brief Configures COM port. + * @param COM: COM port to be configured. + * This parameter can be COM1 + * @param UART_Init: Pointer to a UART_HandleTypeDef structure that contains the + * configuration information for the specified USART peripheral. + * @retval BSP error code + */ +int32_t BSP_COM_Init(COM_TypeDef COM) +{ + int32_t ret = BSP_ERROR_NONE; + + if(COM > COMn) + { + ret = BSP_ERROR_WRONG_PARAM; + } + else + { + hcom_uart[COM].Instance = COM_USART[COM]; +#if (USE_HAL_UART_REGISTER_CALLBACKS == 0U) + /* Init the UART Msp */ + LPUART1_MspInit(&hcom_uart[COM]); +#else + if(IslpUart1MspCbValid == 0U) + { + if(BSP_COM_RegisterDefaultMspCallbacks(COM) != BSP_ERROR_NONE) + { + return BSP_ERROR_MSP_FAILURE; + } + } +#endif + if (MX_LPUART1_UART_Init(&hcom_uart[COM])) + { + ret = BSP_ERROR_PERIPH_FAILURE; + } + } + + return ret; +} + +/** + * @brief DeInit COM port. + * @param COM COM port to be configured. + * This parameter can be COM1 + * @retval BSP status + */ +int32_t BSP_COM_DeInit(COM_TypeDef COM) +{ + int32_t ret = BSP_ERROR_NONE; + + if(COM > COMn) + { + ret = BSP_ERROR_WRONG_PARAM; + } + else + { + /* USART configuration */ + hcom_uart[COM].Instance = COM_USART[COM]; + + #if (USE_HAL_UART_REGISTER_CALLBACKS == 0U) + LPUART1_MspDeInit(&hcom_uart[COM]); + #endif /* (USE_HAL_UART_REGISTER_CALLBACKS == 0U) */ + + if(HAL_UART_DeInit(&hcom_uart[COM]) != HAL_OK) + { + ret = BSP_ERROR_PERIPH_FAILURE; + } + } + + return ret; +} + +/** + * @brief Configures COM port. + * @param huart USART handle + * This parameter can be COM1 + * @param COM_Init Pointer to a UART_HandleTypeDef structure that contains the + * configuration information for the specified USART peripheral. + * @retval HAL error code + */ + +/* LPUART1 init function */ + +__weak HAL_StatusTypeDef MX_LPUART1_UART_Init(UART_HandleTypeDef* hlpuart) +{ + HAL_StatusTypeDef ret = HAL_OK; + + hlpuart->Instance = LPUART1; + hlpuart->Init.BaudRate = 209700; + hlpuart->Init.WordLength = UART_WORDLENGTH_8B; + hlpuart->Init.StopBits = UART_STOPBITS_1; + hlpuart->Init.Parity = UART_PARITY_NONE; + hlpuart->Init.Mode = UART_MODE_TX_RX; + hlpuart->Init.HwFlowCtl = UART_HWCONTROL_NONE; + hlpuart->Init.OneBitSampling = UART_ONE_BIT_SAMPLE_DISABLE; + hlpuart->Init.ClockPrescaler = UART_PRESCALER_DIV1; + hlpuart->AdvancedInit.AdvFeatureInit = UART_ADVFEATURE_NO_INIT; + hlpuart->FifoMode = UART_FIFOMODE_DISABLE; + if (HAL_UART_Init(hlpuart) != HAL_OK) + { + ret = HAL_ERROR; + } + + if (HAL_UARTEx_SetTxFifoThreshold(hlpuart, UART_TXFIFO_THRESHOLD_1_8) != HAL_OK) + { + ret = HAL_ERROR; + } + + if (HAL_UARTEx_SetRxFifoThreshold(hlpuart, UART_RXFIFO_THRESHOLD_1_8) != HAL_OK) + { + ret = HAL_ERROR; + } + + if (HAL_UARTEx_DisableFifoMode(hlpuart) != HAL_OK) + { + ret = HAL_ERROR; + } + + return ret; +} + +#endif +#if (USE_HAL_UART_REGISTER_CALLBACKS == 1U) +/** + * @brief Register Default LPUART1 Bus Msp Callbacks + * @retval BSP status + */ +int32_t BSP_COM_RegisterDefaultMspCallbacks(COM_TypeDef COM) +{ + int32_t ret = BSP_ERROR_NONE; + + if(COM >= COMn) + { + ret = BSP_ERROR_WRONG_PARAM; + } + else + { + + __HAL_UART_RESET_HANDLE_STATE(&hcom_uart[COM]); + + /* Register default MspInit/MspDeInit Callback */ + if(HAL_UART_RegisterCallback(&hcom_uart[COM], HAL_UART_MSPINIT_CB_ID, LPUART1_MspInit) != HAL_OK) + { + ret = BSP_ERROR_PERIPH_FAILURE; + } + else if(HAL_UART_RegisterCallback(&hcom_uart[COM], HAL_UART_MSPDEINIT_CB_ID, LPUART1_MspDeInit) != HAL_OK) + { + ret = BSP_ERROR_PERIPH_FAILURE; + } + else + { + IslpUart1MspCbValid = 1U; + } + } + + /* BSP status */ + return ret; +} + +/** + * @brief Register LPUART1 Bus Msp Callback registering + * @param Callbacks pointer to LPUART1 MspInit/MspDeInit callback functions + * @retval BSP status + */ +int32_t BSP_COM_RegisterMspCallbacks (COM_TypeDef COM , BSP_COM_Cb_t *Callback) +{ + int32_t ret = BSP_ERROR_NONE; + + if(COM >= COMn) + { + ret = BSP_ERROR_WRONG_PARAM; + } + else + { + __HAL_UART_RESET_HANDLE_STATE(&hcom_uart[COM]); + + /* Register MspInit/MspDeInit Callbacks */ + if(HAL_UART_RegisterCallback(&hcom_uart[COM], HAL_UART_MSPINIT_CB_ID, Callback->pMspInitCb) != HAL_OK) + { + ret = BSP_ERROR_PERIPH_FAILURE; + } + else if(HAL_UART_RegisterCallback(&hcom_uart[COM], HAL_UART_MSPDEINIT_CB_ID, Callback->pMspDeInitCb) != HAL_OK) + { + ret = BSP_ERROR_PERIPH_FAILURE; + } + else + { + IslpUart1MspCbValid = 1U; + } + } + + /* BSP status */ + return ret; +} +#endif /* USE_HAL_UART_REGISTER_CALLBACKS */ + +#if (USE_COM_LOG > 0) +/** + * @brief Select the active COM port. + * @param COM COM port to be activated. + * This parameter can be COM1 + * @retval BSP status + */ +int32_t BSP_COM_SelectLogPort(COM_TypeDef COM) +{ + if(COM_ActiveLogPort != COM) + { + COM_ActiveLogPort = COM; + } + return BSP_ERROR_NONE; +} + +#if defined(__CC_ARM) /* For arm compiler 5 */ +#if !defined(__MICROLIB) /* If not Microlib */ + +struct __FILE +{ + int dummyVar; //Just for the sake of redefining __FILE, we won't we using it anyways ;) +}; + +FILE __stdout; + +#endif /* If not Microlib */ +#elif defined(__ARMCC_VERSION) && (__ARMCC_VERSION >= 6010050) /* For arm compiler 6 */ +#if !defined(__MICROLIB) /* If not Microlib */ + +FILE __stdout; + +#endif /* If not Microlib */ +#endif /* For arm compiler 5 */ +#if defined(__ICCARM__) /* For IAR */ +size_t __write(int Handle, const unsigned char *Buf, size_t Bufsize) +{ + int i; + + for(i=0; i= 6010050)) /* For ARM Compiler 5 and 6 */ +int fputc (int ch, FILE *f) +{ + (void)HAL_UART_Transmit(&hcom_uart[COM_ActiveLogPort], (uint8_t *)&ch, 1, COM_POLL_TIMEOUT); + return ch; +} +#else /* For GCC Toolchains */ +int __io_putchar (int ch) +{ + (void)HAL_UART_Transmit(&hcom_uart[COM_ActiveLogPort], (uint8_t *)&ch, 1, COM_POLL_TIMEOUT); + return ch; +} +#endif /* For IAR */ +#endif /* USE_COM_LOG */ +/** + * @brief Initializes LPUART1 MSP. + * @param huart LPUART1 handle + * @retval None + */ + +static void LPUART1_MspInit(UART_HandleTypeDef* uartHandle) +{ + GPIO_InitTypeDef GPIO_InitStruct; + RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0}; + /* USER CODE BEGIN LPUART1_MspInit 0 */ + + /* USER CODE END LPUART1_MspInit 0 */ + + /** Initializes the peripherals clock + */ + PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_LPUART1; + PeriphClkInitStruct.Lpuart1ClockSelection = RCC_LPUART1CLKSOURCE_PCLK1; + HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct); + + /* Enable Peripheral clock */ + __HAL_RCC_LPUART1_CLK_ENABLE(); + + __HAL_RCC_GPIOA_CLK_ENABLE(); + /**LPUART1 GPIO Configuration + PA2 ------> LPUART1_TX + PA3 ------> LPUART1_RX + */ + GPIO_InitStruct.Pin = BUS_LPUART1_TX_GPIO_PIN; + GPIO_InitStruct.Mode = GPIO_MODE_AF_PP; + GPIO_InitStruct.Pull = GPIO_NOPULL; + GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; + GPIO_InitStruct.Alternate = BUS_LPUART1_TX_GPIO_AF; + HAL_GPIO_Init(BUS_LPUART1_TX_GPIO_PORT, &GPIO_InitStruct); + + GPIO_InitStruct.Pin = BUS_LPUART1_RX_GPIO_PIN; + GPIO_InitStruct.Mode = GPIO_MODE_AF_PP; + GPIO_InitStruct.Pull = GPIO_NOPULL; + GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; + GPIO_InitStruct.Alternate = BUS_LPUART1_RX_GPIO_AF; + HAL_GPIO_Init(BUS_LPUART1_RX_GPIO_PORT, &GPIO_InitStruct); + + /* USER CODE BEGIN LPUART1_MspInit 1 */ + + /* USER CODE END LPUART1_MspInit 1 */ +} + +static void LPUART1_MspDeInit(UART_HandleTypeDef* uartHandle) +{ + /* USER CODE BEGIN LPUART1_MspDeInit 0 */ + + /* USER CODE END LPUART1_MspDeInit 0 */ + /* Peripheral clock disable */ + __HAL_RCC_LPUART1_CLK_DISABLE(); + + /**LPUART1 GPIO Configuration + PA2 ------> LPUART1_TX + PA3 ------> LPUART1_RX + */ + HAL_GPIO_DeInit(BUS_LPUART1_TX_GPIO_PORT, BUS_LPUART1_TX_GPIO_PIN); + + HAL_GPIO_DeInit(BUS_LPUART1_RX_GPIO_PORT, BUS_LPUART1_RX_GPIO_PIN); + + /* USER CODE BEGIN LPUART1_MspDeInit 1 */ + + /* USER CODE END LPUART1_MspDeInit 1 */ +} + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ + diff --git a/main_prog/Drivers/BSP/custom/custom.h b/main_prog/Drivers/BSP/custom/custom.h new file mode 100644 index 0000000..18e172b --- /dev/null +++ b/main_prog/Drivers/BSP/custom/custom.h @@ -0,0 +1,273 @@ +/* USER CODE BEGIN Header */ +/** + ****************************************************************************** + * @file : custom.h + * @brief : header file for the BSP Common driver + ****************************************************************************** + * @attention + * + * Copyright (c) 2022 STMicroelectronics. + * All rights reserved. + * + * This software is licensed under terms that can be found in the LICENSE file + * in the root directory of this software component. + * If no LICENSE file comes with this software, it is provided AS-IS. + * + ****************************************************************************** +*/ +/* USER CODE END Header */ + +/* Define to prevent recursive inclusion -------------------------------------*/ +#ifndef __CUSTOM_H +#define __CUSTOM_H + +#ifdef __cplusplus + extern "C" { +#endif + +/* Includes ------------------------------------------------------------------*/ +#include "custom_conf.h" +#include "custom_errno.h" +#include "main.h" + +#if (USE_BSP_COM_FEATURE > 0) + #if (USE_COM_LOG > 0) + #if defined(__ICCARM__) || defined(__CC_ARM) || (defined(__ARMCC_VERSION) && (__ARMCC_VERSION >= 6010050)) /* For IAR and ARM Compiler 5 and 6*/ + #include + #endif + #endif +#endif +/** @addtogroup BSP + * @{ + */ + +/** @defgroup CUSTOM + * @{ + */ + +/** @defgroup CUSTOM_LOW_LEVEL + * @{ + */ + +/** @defgroup STM32L4XX_NUCLEO_LOW_LEVEL_Exported_Constants LOW LEVEL Exported Constants + * @{ + */ +/** + * @brief STM32WBXX NUCLEO BSP Driver version number V1.0.0 + */ +#define __CUSTOM_BSP_VERSION_MAIN (uint32_t)(0x01) /*!< [31:24] main version */ +#define __CUSTOM_BSP_VERSION_SUB1 (uint32_t)(0x00) /*!< [23:16] sub1 version */ +#define __CUSTOM_BSP_VERSION_SUB2 (uint32_t)(0x00) /*!< [15:8] sub2 version */ +#define __CUSTOM_BSP_VERSION_RC (uint32_t)(0x00) /*!< [7:0] release candidate */ +#define __CUSTOM_BSP_VERSION ((__CUSTOM_BSP_VERSION_MAIN << 24)\ + |(__CUSTOM_BSP_VERSION_SUB1 << 16)\ + |(__CUSTOM_BSP_VERSION_SUB2 << 8 )\ + |(__CUSTOM_BSP_VERSION_RC)) + +/** @defgroup CUSTOM_LOW_LEVEL_Exported_Types CUSTOM LOW LEVEL Exported Types + * @{ + */ + + /** + * @brief Define for CUSTOM board + */ +#if !defined (USE_CUSTOM) + #define USE_CUSTOM +#endif +#ifndef USE_BSP_COM_FEATURE + #define USE_BSP_COM_FEATURE 0U +#endif + +/** @defgroup CUSTOM_LOW_LEVEL_LED CUSTOM LOW LEVEL LED + * @{ + */ +/** Define number of LED **/ +#define LEDn 1U +/** Definition for BSP USER LED 2 **/ +#define LED2_PIN GPIO_PIN_0 +#define LED2_GPIO_PORT GPIOB +#define LED2_GPIO_CLK_ENABLE() __HAL_RCC_GPIOB_CLK_ENABLE() +#define LED2_GPIO_CLK_DISABLE() __HAL_RCC_GPIOB_CLK_DISABLE() + +#define BUS_GPIO_INSTANCE GPIO +#define BUS_BSP_LED_GPIO_CLK_ENABLE() __HAL_RCC_GPIOB_CLK_ENABLE() +#define BUS_BSP_LED_GPIO_PORT GPIOB +#define BUS_BSP_LED_GPIO_CLK_DISABLE() __HAL_RCC_GPIOB_CLK_DISABLE() +#define BUS_BSP_LED_GPIO_PIN GPIO_PIN_0 + +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_COM CUSTOM LOW LEVEL COM + * @{ + */ +/** + * @brief Definition for COM portx, connected to LPUART1 + */ + +#define BUS_LPUART1_INSTANCE LPUART1 +#define BUS_LPUART1_TX_GPIO_CLK_ENABLE() __HAL_RCC_GPIOA_CLK_ENABLE() +#define BUS_LPUART1_TX_GPIO_AF GPIO_AF8_LPUART1 +#define BUS_LPUART1_TX_GPIO_CLK_DISABLE() __HAL_RCC_GPIOA_CLK_DISABLE() +#define BUS_LPUART1_TX_GPIO_PIN GPIO_PIN_2 +#define BUS_LPUART1_TX_GPIO_PORT GPIOA +#define BUS_LPUART1_RX_GPIO_AF GPIO_AF8_LPUART1 +#define BUS_LPUART1_RX_GPIO_CLK_ENABLE() __HAL_RCC_GPIOA_CLK_ENABLE() +#define BUS_LPUART1_RX_GPIO_CLK_DISABLE() __HAL_RCC_GPIOA_CLK_DISABLE() +#define BUS_LPUART1_RX_GPIO_PIN GPIO_PIN_3 +#define BUS_LPUART1_RX_GPIO_PORT GPIOA + +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_Exported_Types LOW LEVEL Exported Types + * @{ + */ +#ifndef USE_BSP_COM + #define USE_BSP_COM 0U +#endif + +#ifndef USE_COM_LOG + #define USE_COM_LOG 1U +#endif + +typedef enum +{ + LED2 = 0, + LED_GREEN = LED2, +}Led_TypeDef; + +#if (USE_BSP_COM_FEATURE > 0) +typedef enum +{ + COM1 = 0U, + COMn +}COM_TypeDef; + +typedef enum +{ + COM_WORDLENGTH_8B = UART_WORDLENGTH_8B, + COM_WORDLENGTH_9B = UART_WORDLENGTH_9B, +}COM_WordLengthTypeDef; + +typedef enum +{ + COM_STOPBITS_1 = UART_STOPBITS_1, + COM_STOPBITS_2 = UART_STOPBITS_2, +}COM_StopBitsTypeDef; + +typedef enum +{ + COM_PARITY_NONE = UART_PARITY_NONE, + COM_PARITY_EVEN = UART_PARITY_EVEN, + COM_PARITY_ODD = UART_PARITY_ODD, +}COM_ParityTypeDef; + +typedef enum +{ + COM_HWCONTROL_NONE = UART_HWCONTROL_NONE, + COM_HWCONTROL_RTS = UART_HWCONTROL_RTS, + COM_HWCONTROL_CTS = UART_HWCONTROL_CTS, + COM_HWCONTROL_RTS_CTS = UART_HWCONTROL_RTS_CTS, +}COM_HwFlowCtlTypeDef; + +typedef struct +{ + uint32_t BaudRate; + COM_WordLengthTypeDef WordLength; + COM_StopBitsTypeDef StopBits; + COM_ParityTypeDef Parity; + COM_HwFlowCtlTypeDef HwFlowCtl; +}COM_InitTypeDef; +#endif + +#define MX_UART_InitTypeDef COM_InitTypeDef +#define MX_UART_StopBitsTypeDef COM_StopBitsTypeDef +#define MX_UART_ParityTypeDef COM_ParityTypeDef +#define MX_UART_HwFlowCtlTypeDef COM_HwFlowCtlTypeDef +#if (USE_HAL_UART_REGISTER_CALLBACKS == 1U) +typedef struct +{ + void (* pMspInitCb)(UART_HandleTypeDef *); + void (* pMspDeInitCb)(UART_HandleTypeDef *); +} BSP_COM_Cb_t; +#endif /* (USE_HAL_UART_REGISTER_CALLBACKS == 1U) */ + +/** + * @} + */ + +#define COMn 1U +#define COM1_UART LPUART1 + +#define COM_POLL_TIMEOUT 1000 +extern UART_HandleTypeDef hcom_uart[COMn]; +#define hlpuart1 hcom_uart[COM1] + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_Exported_Variables LOW LEVEL Exported Constants + * @{ + */ +/** + * @} + */ + +/** @defgroup CUSTOM_LOW_LEVEL_Exported_Functions CUSTOM LOW LEVEL Exported Functions + * @{ + */ + +int32_t BSP_GetVersion(void); +int32_t BSP_LED_Init(Led_TypeDef Led); +int32_t BSP_LED_DeInit(Led_TypeDef Led); +int32_t BSP_LED_On(Led_TypeDef Led); +int32_t BSP_LED_Off(Led_TypeDef Led); +int32_t BSP_LED_Toggle(Led_TypeDef Led); +int32_t BSP_LED_GetState(Led_TypeDef Led); +#if (USE_BSP_COM_FEATURE > 0) +int32_t BSP_COM_Init(COM_TypeDef COM); +int32_t BSP_COM_DeInit(COM_TypeDef COM); +#endif + +#if (USE_COM_LOG > 0) +int32_t BSP_COM_SelectLogPort(COM_TypeDef COM); +#endif + +#if (USE_HAL_UART_REGISTER_CALLBACKS == 1U) +int32_t BSP_COM_RegisterDefaultMspCallbacks(COM_TypeDef COM); +int32_t BSP_COM_RegisterMspCallbacks(COM_TypeDef COM , BSP_COM_Cb_t *Callback); +#endif /* USE_HAL_UART_REGISTER_CALLBACKS */ + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ +#ifdef __cplusplus +} +#endif + +#endif /* __CUSTOM__H */ + diff --git a/main_prog/Drivers/BSP/custom/custom_errno.h b/main_prog/Drivers/BSP/custom/custom_errno.h new file mode 100644 index 0000000..fa43a83 --- /dev/null +++ b/main_prog/Drivers/BSP/custom/custom_errno.h @@ -0,0 +1,58 @@ +/* USER CODE BEGIN Header */ +/** + ****************************************************************************** + * @file : custom_errno.h + * @brief : Error Code + ****************************************************************************** + * @attention + * + * Copyright (c) 2022 STMicroelectronics. + * All rights reserved. + * + * This software is licensed under terms that can be found in the LICENSE file + * in the root directory of this software component. + * If no LICENSE file comes with this software, it is provided AS-IS. + * + ****************************************************************************** +*/ +/* USER CODE END Header */ + +/* Define to prevent recursive inclusion -------------------------------------*/ +#ifndef CUSTOM_ERRNO_H +#define CUSTOM_ERRNO_H + +#ifdef __cplusplus + extern "C" { +#endif + +/* BSP Common Error codes */ +#define BSP_ERROR_NONE 0 +#define BSP_ERROR_NO_INIT -1 +#define BSP_ERROR_WRONG_PARAM -2 +#define BSP_ERROR_BUSY -3 +#define BSP_ERROR_PERIPH_FAILURE -4 +#define BSP_ERROR_COMPONENT_FAILURE -5 +#define BSP_ERROR_UNKNOWN_FAILURE -6 +#define BSP_ERROR_UNKNOWN_COMPONENT -7 +#define BSP_ERROR_BUS_FAILURE -8 +#define BSP_ERROR_CLOCK_FAILURE -9 +#define BSP_ERROR_MSP_FAILURE -10 +#define BSP_ERROR_FEATURE_NOT_SUPPORTED -11 + +/* BSP BUS error codes */ + +#define BSP_ERROR_BUS_TRANSACTION_FAILURE -100 +#define BSP_ERROR_BUS_ARBITRATION_LOSS -101 +#define BSP_ERROR_BUS_ACKNOWLEDGE_FAILURE -102 +#define BSP_ERROR_BUS_PROTOCOL_FAILURE -103 + +#define BSP_ERROR_BUS_MODE_FAULT -104 +#define BSP_ERROR_BUS_FRAME_ERROR -105 +#define BSP_ERROR_BUS_CRC_ERROR -106 +#define BSP_ERROR_BUS_DMA_FAILURE -107 + +#ifdef __cplusplus +} +#endif +#endif /*CUSTOM_ERRNO_H */ + diff --git a/main_prog/Drivers/BSP/vl6180/Release_Notes.html b/main_prog/Drivers/BSP/vl6180/Release_Notes.html new file mode 100644 index 0000000..c77ed03 --- /dev/null +++ b/main_prog/Drivers/BSP/vl6180/Release_Notes.html @@ -0,0 +1,1244 @@ + + + + + + + + + + +Release Notes for X-CUBE-WIFI1. Software for STM32, Expansion for +STM32Cube + + + + + + + + + + +
+ +

 

+ +
+ + + + + +
+ + + + +
+

Release Notes for VL6180 API

+
+

 

+ + + + + + + +
+
+

 

+
+

Update + History

+

V1.3.0 / December + 04, 2019

+

Main Changes

+

·        + Change int status=0 in VL6180_RangeIgnoreSetEnable() + in vl6180_api.c

+

V1.2.0 / December 04, 2019

+

Main Changes

+

·        + Add documentation + VL6180_API_Documentation.chm

+

·        + Minor corrections on API description

+

·        + Add Nucleo example compatible with + STM32CubeIDE

+

V1.1.0 / November 25, 2019

+

Main Changes

+

·        + Change in + VL6180_cfg.h #define VL6180_UPSCALE_SUPPORT -3 allows max ranging 60 cm

+

·        + Change in + VL6180_def.h #define VL6180_EXTENDED_RANGE   + 1

+

V1.0.0 / November 2019

+

Main Changes

+

·        + First + implementation

+ +
    +
  • +
    +
    • +
+ +

 

+
+

 

+
+

+
+ +
+ +

 

+ +
+ + + + diff --git a/main_prog/Drivers/BSP/vl6180/Release_Notes_files/colorschememapping.xml b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/colorschememapping.xml new file mode 100644 index 0000000..6a0069c --- /dev/null +++ b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/colorschememapping.xml @@ -0,0 +1,2 @@ + + \ No newline at end of file diff --git a/main_prog/Drivers/BSP/vl6180/Release_Notes_files/filelist.xml b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/filelist.xml new file mode 100644 index 0000000..130067c --- /dev/null +++ b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/filelist.xml @@ -0,0 +1,6 @@ + + + + + + \ No newline at end of file diff --git a/main_prog/Drivers/BSP/vl6180/Release_Notes_files/image001.png b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/image001.png new file mode 100644 index 0000000000000000000000000000000000000000..8b80057fd3a454a97de1c9d732b7fede82c83227 GIT binary patch literal 18616 zcmbTd^-~<*6D~X~?jgaQV8LAj0X_tm1Ydk1xVy{Z3GPmS;IP2r4oh%%cMl#Qcz~Pl zz5l>lZ`GVRHB&V|boY7A^z(F|Z=Y4=aIwg-006*MkpHOuZ?5<^0x;12-SsK9!v0Mt zmQpHG08kT${nrHb-!rC@ysj$%ki7ceKq56ESOEZeJ%x`_nqEey{^(v>eK${gL>pJ% zX8+KBAR_W-jhDrs{egi|sP<73DP`UFoa(>xj;8qknEx2bL~2@t%3k>}hnl@CWQrW@ zqfK>@e3$sL-m%ftg0YAkk!@=P!Ognuz(zhb|Tux{FeX<<7(5oLVU8=W*sUZ*$TqlSb6o1O0a zzeP#ZW!;?#>0N5v?0D|q?mzD8-<^@1V0FH{fY}2A9ooXbylcB6Y>PVo4nMxLi|AWA z8M(b#9`j|%0v7ktATOSzsh-T7%Wqa>t*x!29M*iDetE6#^`?iEoQW5F*w7rjcWYw>-UyKyDHetK@Im)qdu0o-zudq@gQN3)r z=(%XIh|%7(Y}2mODA6--)=u;7mi|lUCki50L@QOyZN@2N`Bwwn9et)BF?yQr9`Sn# ze!a;09%cuNiCJ+Hwx|5Sw&L`0rJvq<$7D5j#Y=O^YcW)1x!+MVRWRVHrXDj~g@40Q zBvp_niE6-dasJKX&t@%;X`7_R9QhT$w_Dv~zW73kCM;9WC z#^@^R#^^HZ#`rQ5ZjC*^uYUMgw=ae5*IV2JyEL@LlJ1k!yA8p=fmyQ={`Pjq&sK}Y>k9r>*Y-3njDRLc8z*D?su--n+y(fpV8FB zwS%vLw=L>F9>rMJzXaXgg5NRvaHPKO=qdV`%ecKE^q=CNs6^=Vl)5QG9h0>AKM-1F zvU-S)!Vnz~yg}XNmnaKSqm&}<1}#nOBCWZsLvn3_pkm8Z)~*KF8yv=yRk*!4rf$7T zT*ey^g`%>`O82HoVNPMCaM^5e_Eeop`^`Wsro=Q9SzJ-{LW5j1QdRH>Oq5bEX({TJ-TNGPvNBrk5{my=8FEQ%0fftv4 z)$FK)-usf%cyd|Y@=r@u!~HI3-5_Q=E%R!AkEqtv$Yv%Zit4K`i*n5tM!wdwLFM?% z@N0D&tLS9%TD>`41R~`%HzXtZS6pjo$}fsAA6cq`&Llq^TE@#ID4eU}(xZH$-0oa>g$RMe)N_S(=w@nXEL&?{|e zd%-=H@Ei^9kz3up?3!?QYr2O7^M9)q_E2E@^vESGQ&5WzDh<(QgQEd3BICrRm8O)S!fPO#z(h0}Vk) zolMw(Ecl!UD7xMUH0>?+9qzTMCMQxcM+Od*!L7F!tiwSSG>D@|J~*c~gu?`RewztA z1cO8*h9GGR{``zPp9t6vZJ81Ar<-bz38Jv-ro`wI#Mq&-k$*5tL<>Pk=)T1H_z8YhPJDWCuq5c#f&iDRo3$~XHhc-#T3{whJvB?;N^IKpX^H#=oYNa@u&^9He20t za7qlYKRH^S(Tj2{XC=lPI|MVMOVVX4V8cbx(9Ix%YK__iyN9E(k)118*aO-OzZNT# zbhE^f=Cze>bdhX>8xBFW70+=Tb@QnIyKKmQGt`}ZHXrVVWgxIT1k&eFDonM5iFh{^ z;FtT_qYo%x6$`ChDD~;i`c>h@T~X~pZ&-v==wrV4)ra@?=39Z}7c)OR&&9#@9uxU( z?hh)jyY_o}tH;1B>v%95XoGM@gDYB{I@;aJAn;N$2z~uDX|IL`uf-*Mm1ic21|E8c zQZWw`gvb==bz|iv=774j$zii$vlW@T4LDFEfea$Z+frqVA{<)qP_mhp2AbFqEE(0z zfCJgi{n&vKxpSY#-W)(E-Y3u@1KQGcnWN=qz;Nz2-6>bIL8wZk?oy8xe49zo9Evpm zI>QVA&&4C5*aCjxksX%9lfPpQNw|#TzMQ;YvC%Rx=uA#dmU{e@tzaW&rq}9N5VXBw z6Mff^1He^5U}j4TZD};Z7u2!LZ@OjGIPgR|MLZ*9%)E@0nE%K=W5s+NOT~n_{fBc9 z8DlU6un9om`MN~!FtpPXkJSq(+KPHqF&N23_vGeqphc*cEAF=okHGoFWHHWTm&R zAZXR)=q}Jv`jsvKCoL27h?ylNq0fz5xasR{P`5RW_7kzL^b_#T@e?r5nGKuMX?!lz zcEq|hYJscWj{YtO1of8Xi0jH z6s+!rS0;ag(Cml~|NKB+tNwwq9kl+8wc0!T$L$CFw95drNPiuZ3jOf4G_NXoM$sQj zZn*2v3^ISC(OoqO%W>m};%SHDOcD)D7%f&?jnrI9&1_u;6m(x2g#=wb zH$Cl!I6f#QI6iFo2i^nPy^8_Rt0g@Gzv3FoK629)r#wPie#!P^T*B)9JDi>Qta-Ee zyLS}t0#vL+3WcNfUo47o=g+h7Q(waq$0Fo`#^t+!ugP{n=lV`j6a9^vBl)I!L&VaI zK(10FWw?KM*=_ynJ3HIwyD^##=aKUk4u|yIYk$&C>^B?x{I5c+Il`m3RQ%_=Tq`!D zQw3HQ7dw%VR~rkqeqr+THi``YT){njI8j~%3VNWBl3EUyQ zx>y&BaDTkwjg$12&1?kD`IcCB_?j~8XMfHm4iQ(TCj7-)DOn-+%UzP)ab?nnNlfTA zh(FmGsK1tl`G8>eb=1j~9lDZPh<*?zhjW@Gx5%UjcH4 zbrrd<#%%JyFrW`_Loz= zP30^V%kIB;=&%K@{YbXT6@(|c>dXlNk~?15SVEmMX6`Mjv>+MN2M$^N?ju|1T-qoW zJQV;x5rIpTc>eCM*`;fq^U3U2uW>l1RVxe^4B$CEub2J}+bN)$=(gE92((ah@ar_) z+I|k<9;iL6@Dyhc+LX|pTR>r3{P!==s^guY!a#cZ5Ry6QtTzvk zUh~+ICB=TnC(!+~G1}X`=zKbJF=VNy60Le=gO@j5lEJet5>jc!PbM+D!ZlS$KuYx&pkm{S?k)BU1<65@ z({=ySGqzCiV-vc5qOJ z48y)rR(Ys{uWIjyQX*o`4?xK$K9nE1K!t$coI~(ku$IzWaVM`ocnY1)=&_o_R%I_2 zZ_{Cs>@7#7ktZS)0EENs++_HHh39c*#7z#Pyifk3+e!lsET`nm%a#Zp{hflp4Vw$+ zOju*)#0tN99xzE1;G}_c;Oj@<_%Z8;SCB3P74uOYE__wpp<3HB0g0wsxZ1toEwg)5 z23F}NQwRV%3UQi)GQQt^$a%zzV8w>aIl;CkQ!6h%=n!jXPZ;sfULBWNTi1QT%V~R| zdrjBQt+%&EcrjOO0&pO(SR|R1%nis?Q}KUl75Q=`bI5TGenEMls+QNXGp;Grr-EZVy`f(ovFSmI(u6D90n zU}rWOG+9F)ioe9yO)lx~AD<~|_xP=uVs4I z6w+kccIU+(Ltf0bDM$mvJrBdPzjnQ4w#L-qTZ+S6V5l=pqj|%(!m@K!R(Sm5G<;5V zXK~r#d34;M-;>*+VXbyWbw`4vdOanA^uK`Ag&w)G;7}_OpATxWe^GjFe%&*Ocx)w7 zwt4Bs4luF3C-9V+n~E!?(W3d6$CtEn7OZ{~I`6iW|1x;QzkF49GF&d=Wg#fC2^Vn?KLfW@n~pFc4gBpg!U$uFR0 z6`f||PCJat3glNlwW|z^j;^p%9oQc82S&N+!L>xWR*UT~JbFCj)0}2J6c-rV3iVO! z`IdFp zB0H{SvHRu;zx(EM(0%j9fA`HVZ|@5Oo0EGok@w*1K*{Sg3QERYynQ|7kzI{t_?~>T zQGQ|?TPR(EZYAFen;>d7>k zc`O4jwao>J?dp~fG@8l|SBHzOE5h7?Ba_OYs%93|;KP${8}j%VGb?LRi<;yffk06& zmc)TH`g@-+zt@fG!z|MO3057>Y}ppB{w8IS2o68)NnHSA-jKa+X$k+&Klw{5Ksly#ye_HBKV&h1zbIsIT-|0XRq)zWf_~s9{=n3BOfpPy7{f5RZzL^9tdzjj zr)R?-SV}4UX;&dWNKq={6q|g;FEbIjXC}?$K%uY_ur_MF+MkJ>-c@8l1|6F7^BR4N zf%t(1oJ!m zg^z<^ddW{6+A~!=F*1he)s`5=HR&3O@tjq)pn!{ zodn}X=d$=iUh-ibxQ>PQw|#fHTLppRwXG}*HyUkLKB?Vxf>#@2_z&V#B0Cjvmfka$ znI~k?Pp)A)OXy(kdOeH7nbmp9bNb|>|e%T7Dg>BKo&y=JzU)v zs{+P#O$)wko3MOQY!bv_78@Q%uABK!ZPIi<~iCxyQ>J*D53j_;0vks;+?UxqO^ z8)9k;>&t3F)oFofc_t(0cdCn(OIM;4fePgKSw+PKcigoQR9JV_C-y`&%By+|aMjTd z;$iN6>#`KNXtG+yNhfl+PYn(#cr;Nf>DZ1mRU`A-PFI}Scq~0EgRR31c4LZcz_w!3 zU&-x*oGPQoz`-m#bYEC;V<7tHiC(wn395M}YNU9p|6@2$$6(9N_DyMjuOwT6X&Cu> zXg1{_^+%NsBhDf;)3V~J5%bl|^XVjqRgu^moR2288%NOgcLoNBkN6t5F&l2`tPvao zfAbQy!&*Ln*uWc{tVDqwT1{Q>{s19S6+;c@2e$2eZd>zL~I~M}G^8w4Y2bnyq)>=S+L6j%|@%XWqbYm%+}R z%Jg=|X7Y&0*lujN6>tzy)?{CBuT|FT#I=sU+569+)8oyIH?8?{Y{Im(PMHAGs5_GI z>1wLl+yiE$+I28-c2!jx)_?k2nIm}7iH=O{X#yL$s@}hUPf^xece9Vi{DUPRKm%@= zI4q=C$Qla?I0{;1W!^-Bt)o=r>#KNZnZPW3piq_&q`~HLF~1_^MHlt66*62}BJqzu zM;g!LlycVJ?1ohPMvFHu3^-`<`sR(iyLG`EB|;bk%3GG!#?x`m5gx zWnZm7bb@UTrR9OXVs1t)?(5a%Yqq>?ivrob2S7W|CH$C|Kscw z=5hgFRsHTTA{lDQ(a0VW8vk$By+wL4Ao<5{Br)oU$x2pMfJKrlPqr@4P$Y9Nt_7R| zCx>hhMeHtjM0mJ|?T<(EIY{^^cAiA&R=2C=g&o@6vm!E&&86BrLOf18fr==x77OBH zdyOvB1fjqxDMa5;G9@=qu?tN_vB?)=#H^qB;g*jHrr^*ISGt+pLXyWcu+bAWNk&IG zl?zGxV&+)tmQ@d~T5Yypa4*^P5t*t6C($W-Y9zknsGLXPPDR^RF~`>QcV4iB%ltJg#%JgzSOl!L!d<7;Gfa5FAv zjVdBTD(TpZ3>zF8@VbIAM{aYtDv8fh>oAmOoV`*>G_abe#aOPM+6b%!IzPP2K{>A5U*>>2+^+79)a z;+jQ03qhGCNA7Yx7^lX9Ba9FuFHNen`s{buqNeEv)$x#QoePK6M~soRL17NVafu`4RB%F$`Pl z5~X9X{(zDkw(=x-=6pOllhfSrJCozywriAokKZ^VZ?epc?F2YfOmC=V98gW?oL=*# zC!4VJtdyAXwE6cHlNoijVy3KiZxeTrjL5AO4?|IT4#6gV63bUTC!(fd*MK@3^J@F! zOg&Y}^l`KyT>$RnH8O17_%?_PVh?o(+5L|_R7c|c+R_PRXb26L8QM&z+5MaH{wtOk zn}L=^TXs*WwrBLOJ6hDKim{LKAa3?WEiRefh;#TMZ3y1zA%QAUYh={Ux!GU!o~ zQNH$+pUp$BPoB27%q zF^6BflF{;t=SZSz+GrMJ3q~ti7gQ;5SbjS`5!DFxQB8KOt1OQ(G%_V;vcdj>K_dXjNxb}0M?HyjDs(afDCVx%>+I2GAO;jMfy0Iwh$=Utfm z5snMAm4|C3O1?MDEQ%I@RL1I{SrN67(Q)b*7k&Ip+-THJr%-;ILx=v!SaW75@EH3` zUhVOn4CYZ>iZ!iaGNBq9Be`Mcq5Opf?{HZfcJM-VDr$qSCy^3Lij|O&UW{&ffZ&!( zaA9$H9_5lFs;vRx6|mmn{Ic~u%y*(_t~*m12^>%iUOQ9Ap<@`U;!iRpBZ5y=p}@B6 zSP;R6QS{hs7)q75Mgj7814d~Bae=<{A1Z5>;LN66N?m?;5pl?`*_wW1l4a8IBb4tyR6@^@^BOm`{tD6YyAv};)Te2G+K}4;<~T9 ztiHbWTlGjD1=omQ_viT9PJOR7GjZ^{`7u?a_$hGpx54G9Z4Uj-NJ+>3SA0ZSx1vXw zLxYWusP2Sm*#o~_#B)vb&lTfmtsonTnPHIvx!#}HYvp=bPcZe zcHOCWuo0{MxR+#P#Pz1PSlaT$g-HbB!hTlHpV_F!Ay^U-vb1-6W)!xh?3imeOv*Z3 z=D=Ij-4e>!J=_Q#nqT5Fkomgv(@3uQo!?=8R9Sw(0)&ni z2jsV8*xm^OAO91C)$^*!X=%ZHvh_G35URQ9mZ|{A0)E?gJcL0T$H-NA92s6VF$CYW z9RHBse3R!V%B}9#+)P1_9L@j@2VcH-GZ=N2{$k05r?kj$KxpvthW zd7m|F4Ka%sEOHJC`oN z{Q9h2$S$VYkMHBEw7ybMx&7`nIaMLI5n~s)u5f7_tg^|2p4eFF&|6C45|-}T zY2bbCicJ7u0b>nvzMSvbBTOChoOAKvC$b5)Y}lT;{a-@oZBJ!oQNfsC36M4qtjvVR zX;Qkn$Pw56!sOMyw2f6>a4-#^ zy$1D*lt}-KofQ^atUig?;uYP;un=4nq7RPpS6+7^7eT`a+9Hs&(5Wu`IyLv0kJINP zH{2$kHb`Me^3C!975F7KG!qcJ%Ot-tp1f*bJffu1KR9B1lQ=XYBq15?hlJ33*QN-~ z25i$#OI}x{k+-P3EKo3v2XVk4?t;KE4nj1dk!Zo@w6D?!o#k^~T|3?;an*{_dc}rZ zWWWrKbdBu0k$7Zn5A%~0$lei$vU1P?CE&!L*!t%`ziuxu= z$+Xt=qUvFYn;a&JSK-D!mWnDWtF|5q!R|hT$Hv!*O-Hv$ zFMd5*W#~$3AJN-2|IVd@2bWN6TIfD_0uz(~vS50vn&4k2seimRF5`Q+1IS}!NNHN| zuWuQz50#5kO>f(wTSg+{VKXLrOZR$Gm~DhS1f%%-9{FGG$s*ZrqKZL|g5VaRU11N3WB;tGWJx5jj1rPZ1}$YE7~gsu zE25FmauDeN0tjmI!T8LA_@Jktp-r4gQRI3~pz@ext*^u56U%RNNACtB2^N&i&Zkq_ z`%gV|mr`$f?Rog-De|tRlA$9w&gIG-7Zqk}`K~S#ez0!r0TA4$*?1vW^S1eRHim+x~x!Fuo?ZZGGykdj`C(v!pIX!M7^#v%t*g zcznI+6jSi4g8knZOJ2XD^*-Nu8++1xNL67@Dpa}id>w3=oC<2l|TauHqSGbyr z9Lb=M3fe$ymZM2IcIy2$WhWPLfA8YEy!~$2XHICgk})!EbwTa@re-=DC1|8#7fNFq6gJ2K}GKAX`f_@q32jY5x4yTSxUH;`}j*L?c8b@JA9D(4X1n>r5 zmjA{5zUzqX9?77@2f4TGSC#Gv z>RXD%m8Sx#GLz`?10nyLA3f`rKtm)2mp8 z2WUMD#ZK*6rx@tHUO&Z&$15&*p$9S&RarVs7nI?jWCTx!i z0n`(39&^Y>ScN)8+_K-B#JBi}jEM2qqgbCqWKx*4*ll_rs)9n)b|4=f&23 zGJ5Ub{5j_`P?1;gHXtz{3VvNPjI4v63M z7VR-O|JQRM-E&ZagmZ6Y#+`oTU{Zdpg*T>rA?e2lXyimlx-MsB_vpS!^2jDQhm%@q z{n8XwoaYQc8y7Itb%2)$a=$~0tev`)%-s+AXZ8I@XV4DuPx#4Z3^R?1Q&1e*!{+@j zwy0-{m|^s)xqlSU>jQk{owo@5+inF)-p_24DlAw`pUe~G8ATB<-h>G97|FK_kfkQlN-!Xir7CB=dF)cJj`)++W>CeZ z0KpG5Ul%&-7q_N%mRtvtM37+jS>A#7p`RadxDFCIFsAEA)28 zRc#)^^3Z1>`W_P8_n+_5l5pGfayTk_=7^k}d#ir!c>8mR4k$J+> z7$;sN^3k#e1A<-CaO6F6V7^1u(puc4hVnfPK2u$wSE_XF>^Bp?OAv{2Y8)b{(a(2LFQfe!w)T1x>k{ZpuhTF(Y6rhpZbrH!ElxM! z5seXw{2(-vFEyNn8P2QzldxYgR;$=9Va+n>oR-HQXL;u7|E|m|OuX!t) z=Y4P{a-kdSJHXaCvpi=8=DW$Bomevgq&Ys4T71MX_~k_QpcOJ7j|>5e z8fKax8KCNY#00?1+;-F_`mYl6?wiA0M9-%AWH7g{~~uALu>r1q7;w|*!aJIeE{mR8WtR@KBhs8TcC2jA=CW|Xy-ycIi>d)c7Okmo?_;IS6kWJ z(`FLRj~hxiQw>hGi`}`RB+q+jpRWZ9z114q7dyj#>yMG?n=NfcSz}CGOi5Bt#D4u( zFREX`PCs3=cqxne=H=$udT;=|-YI7ij;hPlH)3oXm z`Zikh-OIS^*V9YKw;%r4iW?YA#ppM%LKP=jnMYQ)JEBqy1t4U@E<8VwMW2U*KvaS5 zNDwVyHjTg6hvcbS>{N7lJu=~^Ut)S#sq~v9%#hIV2H~>o^9=!kEGypac0E4e6TQIW zr~+Bn`Sb4k*0*Zts;f;Vq@fsZn1hLBQyIO8W(13u0211vHK)RMC5neH4xx7?6jMVOl3i-ENH1NU{ z-FW1hXwfmWi;TOg`k_dSL1ckNlukjE5IiKg=2DaEcWG#qTCd+ts`vavz;Wye>fPE6 zy5Y~H#6~R#r29XgZcKEUWF`#TkPjT0Tb$nr`$rM*rO!0=z{AwY-%*%Y>1iy07;xo= zlqRRR7Oc25bnNStf}IG@3`}b^k0oTD!zg(19YJjRnXs}9jracK>Fw6_hgpNk9M$d_ zY;%@p@*94vn6~^S;rS|c_SBN9%41Y5CNDz~xgJ>zs5bOlC^*0Hm`3d+UdEAQlhAJ~ z9rS!JpiEjf-g5TxWc*_}=Uu;kRBG#hg)R{HVt_KfnWZwXW)vK%qN^F`Uk1yRWlJX^%Xv zrk4pFBKoY0c4V8}-7;k5jeHn#no6bE=CpUiQ*YjAXr&^e4Ji=kd5l#`F`6lq$7V{v z3HxGM@4$C!_rCJ0-}}J#b+>i@#M5T@ zDq!my3QKfc?}%tQt*O2KZN233YvPN6nJ}^KNmAv>Z%4u&!~ecZRVXA}Vl6Juc1QC% z^+u0V1RbM%wwc6J;|v%G|8k{t}#XaV3b2aS>;{E0?a{QN?D zjap1}Foj*+4gOfLe03+j+-fGX6EVmh%q%{kCs18^=Y$ttM`Ru~Sih(@mxvo*(|OHJwq(zE2(ex%#gkzo*Y14gL&0 zb&R`Soa5K^wB%jo6cc>zQGL@J1IWOVy&G6nrZ5tClv8t|5cv^+Gb2^+T0kC3kdVb= zzt>d9Y8%qhJjVP{A;^*2E;@stxE=CCM8#hlN3jEzVQ}z~l*fFX-3jF?-%dnrKMp>* z+*ojsjy{>@Jvb5ZmHokSc4fmUNZRBEvkDd^(WV&AoGicLZM&xx+F?MzT8H=FtNK9| zS}XSejv}P(R*P5=IL)L^{d8bx{SC>9DDxXj4@z-n^Hya-p}k%LC>kvh2A}eK-{n8P z{ymeI^r5$}WuJ`hTT7y&m(wGugFoqC45jML$-|3L7JDo`mbG@4AeOa9^F5Xfc~AdJ z6z*HExRMYeE;qZsGE(eCPFCa$fMk$Uzn)5Lqpt$(K3(+J)whl&sJ0{&+hDO7rV zmH=Vx#~{t)BZI;GL9NP4eoCJAPi}V8s2_pM0^Qn!dLjeT+!j52$p%MSaS9-1=VIXE zZZI?CV3-Z~UNNk|?P_bEXiaFvcS$(=j(imNA_Txz*qk*3Zt> zNTsgN3vU6G(NEuWibkSSE-gZ&wr@}`tuvHEIJGFQY)vT7_Sn%Zf>;noCdR{II*9Uy zi1DPT!QZt9edc?XCO_%vF)Vha6tK-jiPV+wdZr2-8Z+moIE4fA9Um2wrmprd`ujDw zA4$!<#8*6C%(UP!wX!r@9XeCS{UX~rhBT6- z&m5@`REID~K)qRRLN40)>Fz=?P=C-jXZA1}lMo#Lic@|(zYtC?Sr$}gjz;wX-)dH; z>kQvsjFQ|FEvL5r4GE`Vi>HJ+qxMkQH`jx)M#C81t{fBmVaUEu2p_>}$^Lp*OiKYZg_C_ycw2+?0OT`)la$oyQwx zn_edD@HInp4-Gny;i{I~SnCp_RpFSS_!Eo_CI3DYHotlBCu`)~d17BV58M;K#oqAY zMpX+Xw9;xj#wpOozs(lT<+Th^5&14m(|Q*%;z`vKh4SNgAVBe}N~g2sLPrFC2|fE< zFpnnM-xp>{8@7DssTYKd@0S%KXilVkqrjiHGyiM<4X=4ToUoPe$O?bRyn$W!y*w+D z6&Dp2t9Ct*jrJO53Vv$UzniUP=-;pr=_NhmXKlFLRkmbSfW7QwHhvWb87Y|_ zx8ovSSXKm9h{zGnW$Hh-iI?ZMHSbjn*3Sh{-$#hX$;rQovTb9bL)q_$Wc zZmKiDhCM5p5vXSn($(MVPz`Tl^8Dq9O!MXzxdIh}Yi;I?zh>o(TXxwNlF}fbbJWC- z#GcWxTx796z)2UUjk&XWZFb3^oh-r)7Kkx{urkexT2D1!HLjPN~zvz2X#hz4#kSWLV*CW#DJu#do;exLU5E*Yb2H*HhXE&}5w)`L0O>xl{F?nRCT2 z*sv_q70&aZdR}eGSdA;#MccWyIlME%-v<$!Uv*^qnA&%(krwShZthK$iyit6H#l;> zK-^@!-w;mtEMfj7rnxx}?MKV=JHn^z-cHiGPN(d-mV0j(9hnwwg#l4%su_AWn&D=e zjR-cx9)55a@TwJcUi!8R@A2vD&T99g^diZcn-!n?8)u3269>8(cQRcMciiUGO^eip z5B)0E8kXbcz#sx*&|^TUl$Lb)lb&Ip>#TdtDfUcwzE~nzmuQ7EmTjAgdgUiGuSuNa zpCb6rE6(O5o(^pW-+RuE)g@nrZK=PFeQcL58r8o>9J$FQ<9+2A1d*DBdQ!b*dT;;4 z$Xo4EWN=S2^E$tAy9hSL=6Vn#bHD2g;0=sNhjJ6d)KUocZ)+A6o6_A*qTK}$*h#RS zyk#XkuOO@^1ht8v-%9N{Y9oewzu$e7L(scb^mXW2_TiW*-y)vNyH`OadIrI^Y>*Zd zp?=ROXFoq0Kk^tpwCFt$B)QKsZPM$&nJ*fs2;Xd)FtPd@FMUTnfVUp;sJHFaw;TuBTKR%BOW_}ClL_Bhz{A0l{Qgc%@tjIWj2ys8T z-56z(;=%E*LE!6!#2)6$>Eq4>1p;7`)Z_NSc1X=l%@0`gB7usIOR#p2{Cap%H#@u+ z`w+GL;VMer0DCjGMC|TGF_;&EgwZvSq=Q8@4}X7rF+n51h%CM@hl5WX$J z1a?I~km{+qh|RA-3+BNxgHjmg>KA!Bo!rA$QbB?cckI}KdkcLRox3JZd`fkXjx#A+ z_&En<1xc&Qmnoz0c*OV_guW?$J#uUHP(jS@beks0sZ#) z21ebzv6U?Wp@^S4Wn-$u_zmK3cE*C1Mlc5xAi|J_lu9>vY@H z+=VfBpk=&5g2V=pY;m2PHSN1`4hDAzs43VInEYm~-~S`AxRI%f?TU84wXtx z=s<1xk#OUIW)~ZG_2?E}ncAz?RlZ%Nu{wqJtc71aL~G>$Y^@Cl^I zh)|w&6EwGxERMm32{6|adN{lmCnO=?!|jUP3Ws1;e!SWGzjeq)Lvs!ZTTq&ie5vo- z`1p%Yqwt8KsRfc+Zbj`#L-1}(Bwi~Ax5qO&ZU@{ejQ+Hp4mt4VPoV_VeCr(6zF z9UR1ae&+2iX+s6E2V}Lxc6ZM+-8S6$a@?&Cn^C~=sPX~d#JLm;5Qw1n%IW*&PBV?q z09O(5{}gEc5xG_jOowcjF=x4y(&YamY5r}Y`?S#80Bh&J&-}>XgL{roRVEZo{x*i~ ziq&;TCj2%^Ju@%&4lTnyhe)5-5PDrQb*+9kAHW!EOaiu61g8cl_=CS1bA@HjhP}H5 zEBJUSKy2WF;ua_T{{-d-8TdvHidCA`BXq&j4cFtL z^yXVy20#nD1@%y@Y5U4sF1MvXa8K;F7B|Z;gH>tspveGY5S|}@U_A#|Imi?6GS1f%=ROP|BEkV#WqVG3b_;n2 z;H#;^adfh%ovD>w5Gs4>tI$7iJW3x%2mWus`fl%IFZf2qhN?JgWZYM_WBdsAyZ9Ln zRkEUt($@b`?c4fgl`7mn2lzu)}t zF)QPs=rMRr?Dp9+=yMv@`)?NKswHtVMS+34S>A@W)D9NFirDEhF)P8UhG0LzO-*O0 zw~iYtAHX;-bhAs~r#R<26~a<=Te-BB1z_}yavF7s_X>@Au~8kI-fv?*ch&2-MEDeRpn$| zQs#J6{sP}E#c@zKLH{=n*1NNgxp^;34)cyq+y$_nMaXHdPefdQB&ZYuaBF&F+#jI) z5iI(HZ*=0~V#^Xg^oqt{LGBS3`Mzzz-b6=qrl1#6B|u? z)MRjg9LIM9!?@uFajP;=#Ssg@2~wUs91pUhTWF1+X;!z;#!7zZ!HA3(S&VVh0-H-7)D5Ez?jhb5*13LRK%!y+ z0JbakM=Tfr@d$}P-7SM{#QqrU2pOeg#laPR_u*ECoxGxwD+5qp7mJFAC4KD`kx<@y z!H-TwF(`nXfja!2zxynS|Kfw?Nv{=+iYwx~iR_4 zsDFPJT72Tn&;L~mWIpqIHR?q6{H5=03xogjIQ00LT=Sm?Yu??dTo^X%GTU3y3 z5U%wt^lQ~lI;@oqpCR=JSG?o&&sGC)JkTBL$iPQn)gVhj=u1Ww=)nAbnfA|CTF1W} zHDFT%X57(fTIQ+HQ=ZLM-4b?z)=H^8gSHr jqXrx`;HZHtT?79Qd=?ufS>7*000000NkvXXu0mjfyH5ns literal 0 HcmV?d00001 diff --git a/main_prog/Drivers/BSP/vl6180/Release_Notes_files/image003.png b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/image003.png new file mode 100644 index 0000000000000000000000000000000000000000..a673c8406e39fb68200a8733198b888d58b47993 GIT binary patch literal 12834 zcmV+-GTqIIP)Px#32;bRa{vGmbN~PnbOGLGA9w%&02y>eSaefwW^{L9a%BKbX=8G4b8lvJAWvpy zX=7!7?KN=#05PITL_t(|UhRDecwE($=BZbUs!D5VwJgiFyvss(!yDeffFUFynVt}m zm^2d-!qQ16^G%ZJPWPZs^h~F_XTEeMfiw;2Op|Upd+0bo6IQbtgBO7}S++J?vNlU4 zsU+22HUByHzADK!=t-6hj`g6ds`u`@@7{C&d-i*uqqeq|rjKa~ycY!=)1;ZE!23~P z8X(j7cwY)k17sQ?(*T*qz~m_~%|RwlyUXIvX@Fc7!#w#;P6K4}w7V?soCe5cG0c z_5w#)eo&~^tvGGe74A3A`b@l1*ed~N|KZaC39 zu(-LqucX@_^bUq11^_auUtH8iivCFfgJBY16Eum7wo%ZLJLDRl#U1hkAB`~ni5k^2 zQh!GM2By?4TuPl!jos)$)Xy-1dsaacn`V9TTeT&bYR=gD1@ijZ=z7nd0_GY05dLG> zs3Jd;)>af{6uR7XI8%Sg0R-U4N25Q{-5>bEf!5A7dz(5l>O1=AbRa|{(FDcfYSzfW zFe+p;86XCTioXm7ImgV0uX8a)Q3K~0N9JF3E6(9MpX2XLR{qV`q%42OU%LjO&^c9} z%kaIU$UN$M5``JC{5OGr_`~1%z--2M^*herZBkgDS5P+)pQXRhYUHsREb2(l&-LzsZeitxP&@CAsA|DzK0&tX}OZUBdyzP$H54V)PR)3P( z2Sz9wx1pO105$kY3_cH%jG&&$YRd7zVkl*FWq2{NGPHcR9!wkAHBh9O)F-2^s>AoB z07TDR27?I{jmH!~)TGqlN;icEUqFD)$bfP={1fBvKm(7Z;$3>s6&%!W+{}RCI{3Q@ zBpzyYUY(0`JpvFu$p8Tm7$EqL5(0=MIIT?plR%#nLpcXd_RvU-sgLF{r_fwLX1NTCsc)!(RAa)kd6dY&ZJNPq zBi`myt7v?vn$th@QxxIUy_)OjiUezV+@vlI7PB3u=+KW>&(*c@ zkW0VJd!&8pPF1hwGQt&g)8sO9DJ5nV$I@(!fiBY6MowIt?eo(7qO246`U>=q;Y$V} z07q#!9R0>i`wrjvFE8$MH+1%s&FO}eU@@UM#b_>Wsbc~lzRR4kOx5(ALQwvxbw??y zrnW|vEt& zxtvx~xE$*-O4otyXmTU7kqXyP9a&#c11Wj~>jhvD++NW!q>R#4M5Ewytb?%bq3Sh?K>7xgk!DSdbPL7t`F5g8k_1?umed%YI-S1l%KM zBozMa%lqn=yw%VKBRvy3B@0qLi)11xDTKAQ~5OqSeS}dg5|Gtc&rN`0kbbZH-nbWDjY7!&wU0Z zPFykoK|@zJoane==fOq_k&`?wc94!@t1?=Om}(vpMWSJf1czi+{nE1;td9 zmql5g3=vId9!lR=(_2-i>J+nhl-`l%PNRq5+~iDge1YWXHjnzAYI(YjRO?1_o3!GS z?kKl)v~sLLWQx9Yjk=;S^_kTu0G1Tw(VC@m>m3f`Wr&y9B>@oDJraq;*1BVDvl=`7 zD;CV5`7?{CFfW_D9=GB?e?Z3>V?G*& zmV3!M7(`kOv|-csh~*nc75tz?%;Hn02R80$YjLA;n!bV9Va=m0_M zN_qx{u6d`q%hx{~CdWDS2Bp*|DHI7&S#BnM`Q{C@ZS_)s=}g8up}t;rg(1en&}Ci% zI65ZV`40jh%a6C8zWQ+cX>l2+bO+5wOfeIS$0-kD^xc6M}K_eEo_XalaZ|R~D_%XEhA#D=|!oh>2Ax@@Qg+AK0Vgco4PwN~L z1&1!r0XdGlaFWoZkBbHna1Vag*7{Su3l6k)0Sj;yiDN>?GPOsH{SzFqT{(XyRn3_( z>5g5_H%iFgX4@MMhxeZ^9WEL`(9k*kBjM}!w4BcD?H?kS_=?jGEHDn?BFsHJUidl| zms7TfooCa>L@5A(^y8iv-EOz#u>J=sVsw_+T9~!V51xc+3-`E$y0tm0e9p?wP1qbX zBR`Mkm*iQd3(uJ0a1;qe+SROsT1s?{WBH^mYp|Z0%y}Ibi-Y(EN1`|EKRHm^ z+1pP>Jgj34qur)j+!%J63H`&D#d*r(AH$(2?LO8IFt)IBCH{30>;EWBCKUO zE?PaiV7#u#^{&1F`q|FC^m@wx5rUTzLe>#w1ymJYG_w!Pz#`+)lVPW;DrV5~nK|%z zc%KLNKqT}0kMT$0Jf8vaVnkwzZH>Jn6-}qQC<)J~q!H^tnGjke4E_N<>;R4zx`)Gp zQ;ga0zJ_KxcA}G#4!0<`66)94VX``cXPnGzCN@8VMVm@t$?VR{k=WtTvSI= zbvQodVpp7mV{VcwYN3Y?uwO5ty3rsq=sb3E>X?p9V5wJ<@c4^ZObkX9T36>yD@vle zTuNJ2?3*!D2U1BnW_yH7n1iLwbNx6~3I9M0DHb7jWQeLtD=05>{J2qIXoTKA(o6$U zgPgelyZonBGlfHWuF4%T-HDtYkR%7%U6SQQ*19*4<8{7>qP-T#XQ{}=0LaD@eIu1e zPj*ps7_1W>Qm_d%c;fbuj2V@b%nmZJSW_C=W5yo1qkPxMxxQ14tMtFpE`94;$=i}kI^mB99hi_W}9&u2!?3{ z3TKuDJ!Bce{{QW^o9MycJWsohbzs?D0XaQht<{(hQnQgIxGCCnhK=F|JP-^RL55=M zN;B0ttt**(Fqfzn)hG}3V0(q+QM8+ZUvc(njr=PxwY`=bi-e@=_1MSqD zB>gP?5Hn#EfKZDeB%x2>qjI?vNK&hpWHz%Bt4=5QuK*&Q{b{m)(N}P7WN?78ZDCrm za5gy|MP9ort#2?8Oi+l^Yqh z<|&~%TV|>82VmMZ^ajc8nDXnW1NED4(M__Yqu)m)UAzpJ}P7!TcSYmqQ zEp@HDB%kj6*hYu~J3aSq3-VZ_NNIGLxRl{$ULg924i4&J7Jwv}#h6*lS`;c6D=)3A zwPTflPjb4v)>Q;2oc%UDNQ;VdY31U%V|A_fXnh0H9u9Q|;P%K>9#QCErj?T78me-Y z!7gxR1vXAL=yVI`l+c2ig`7^f%MyVmSm=TP1mdMI5RP4Uq+>9%`2^T~kQb6m@3md1 zCAgj`GE!W| zxR;9es97ju3$YQ!q?{#!9GJFPg927bs~0VxSw+5a zhav)NZEs5tosQbc;eu()gD$jCI-0Dt6*MXfCe2ycTM(fvTa>EGi(*B2c`u>(gfrI1 zZ6FF<5P+cGbI=jTQwXta{oz~`}M03rR_lmvC1QEwnk^=pHdh<{txt&h> z<(q7?g8PnY5xZ11RDHVQ;FaMv61A z#lfsdhcC-bcWk*5 zx{r&V*xLl_Xb20PlwztD#VH*_=_EWr<~f0~c9jS!6bCUuqW2h3=CIObcpwuHXR8*^ zq(x!;+@H;Kt_~Pa6#_U9S3|CzK_~vtT=ODCSL{Qr zrPs~y9vnfmI*QK#oN#kI4%)DIURQo@=7g71P6Q`Y3J{&KzG?S~(~I{V zYo>VrX>*5#;Db0g4C%fm9stXZ^{{)2+uTBZjT8v_BeR zM=hHKNP?IR9JW>fK@0_4#r!TIZuXbR-UYI97AxtH>(Sp$uhfMp7z)ytwp7x}iXt6^ zv(|Nv4u5*}97#g@)t+W*?dZaK8!X1+k>)_Pti~yAiJ{&Cs7PT9{{SjAhfqklvAZZOJ`V(6466ws}l)MxwL9F z;wTnY_;nA4=peX9J3Pic!yy4fl(~cK2&9D=PZH7ExlKwrRU#)z%NLZxQkvb2E4-YN zlanvlF=YVZod}WDwQ2XU)}q$dW^zI_CT}F0O8;jFOOjEVn>W-*Wn<<%@F;`O;^#zrE|3?utp=!?Ao-jNLco7z^;$AfTN8- z+^`BFjtFJ)G6IxVq<@=@7KS4xjM7igrd;SbE6RPA%yH&ehq?yoT`W00H9SILgdcdf zfVA&JfkEJ?9b){Og&vEaOs|JFE}labg+BIs9J1Ey$(NckfS?Ighg(i)-4 zS-c$q2A4ak2(3MrT0>X+TByk(I;yFI=;2l(3CbVt3$ecfTT#jO4md-|h=1yx2CDDs zp}+jZ2KwaMD&ag=L@ z`Ak|jcSd(!mitL?kMqh{w?eNe0SG4rfpXW>9dB9C(9}u}IB_I1OUyPM^AOJzTelo@ z;fV@TBPmFLA_QQ=&$=W*yF{eu_;r4K2e3y+e0M zo~<|tkEa99zg)2V71-X%N(O!uy3WoQjH&~YMc>xWa^m59H0A{KHvUzXAiPdk`w}9_Lrb59?%>%x%5TSxGPOl!%J(5IcLi9RgLY+^&ypTg-#tjbJKRA%P>eI6 zZ;6_#xrI!b(Ml=zI0YbVF^#1lo8}eM=J`bjpp(4_@iO7PJ|+STv+Q{T1mdLtI|Xfi ztKmc;XRJGU28xVOkKjK_Gna3Qh4VnC&Y7^#w`rh=nIPgvx#X3yqUtcMAyuaVKx9)t zOxC}D@-^8m^2;9uNHDXl97xln`MwO=FYOkyMcSH**ec~f{nnt$(aE|pse z1K^gOM^Dj_Q{BkwhX@wfDKD<3jOwfApz4pvVgwr<*eEBL*3Zt5&&>1iULVJ;^ld82 zoHszwh^pi5-D~$Zoid`~2uxEYHslaCBEgN67!kIrA|N`_E{+CGCY2MS@WAybF(j^T zE@K)PT12TCsPvjlfW!|y;z5M^d3N9T@oNx=89(93=W)`)94AcLi1;12{lcllAJ3pM z^$;CH(qM_AokbboK;^lXGVnXFSnP$v2DU%bjHJ4I!5<+P}qtwPlH zin3f5E6;&@3{A!0TdCu`00QpeLQ>FmdmGyqH6Z8I(3_}<{8oL|B7^CyPK?g1P+~=$ z9aTDYMhP4J(dHQ%PY=J4mO`> zW!WhsG6F{xs>a|c+e_BLEXts@@O@Z0-e@>M`;WK6%?~FbdybXl z6;PPbTP=+h)%ZE=3&CW_&&{FL6(uw$FO%21FbBD4$9Vw+t(?`??Y|D(!`%zzl-{g*$KWEuJ=APf_nT~kZ_-MtV9iuq)d;G@8YBoI`s;@k zwPQ~`ZCSR6DlM$<&4Eee3J(!7LS=E18GsYtjW)-{%F^(TVDmh0Y?!t!oMCB!SN~9u zUf6$xy8HUc<%P8)3XCR>0L7e5WB)Q;oY*tAthj*YM#GVU3n>nDK6jHsph{zk$J^yuVuXX_00I?Lx@TUseK# z)soqk>OYE%x;K!N%&vUd9+)k;R1Y;M_I*3!h0TG3GV1fNAY$@R;R< ziKwy+#zI&zH!Pozy+N(9{{WV6lHpXqR0$!P{cCjq&ruV& zMEdWG$6|`&qoP`IgEttY`iu+8gLcEiPT6zW~B|!wFB<|?$uzsYaj7md9U=E+P zi{?=EyjhkWwD;HvI)>PbQ&I|*S*w)YQF@4ZQm!e0u(=L}h}M*5)8gVB&RDOr^uQ@D zG%0|@VzK!E$JGegr`HrtaA2mmA5z_9n$XhSNA*Y?j`42Ivh+eJ#mb$dLi?&>Hn|g& zi*$j_Rr9FO0(Tk?hOh*ql?EcvJrD+9C0^-X+Vv(tRA^MOm-OE-I9XXv25qXy_h-88 zJHb7sY&qpbXg^_qaNLEt2OhFwA`kj7mSw*O-c3V|h{do1%&{S5a;hMmuzoE9#5se2 z-jbOGbTvniEwHM(rVcFRY9p*hCWp4nQue>pj>;vdqeYrv6KjJY_86cyS0XT1QTztZ za^A-Wa!eQ?Xk{^ovkjlT52VFY_|VoaKRu7VI0g~!m)#ciVlD|7ioDVeJ$y}I_Pa4^ zo0nElxrK~%P6~SCNDCo>N?CAHH&--T44Se`#h}E;f^wY7unKE@K5=D5A2`)d!9Cii zu-g-=YBB&>h9|6<&{IByh1t5;vHK9!HMc8%p>+bWU$iol%D~4tF3)RjHbT5`Hr#l} z35c%UaE^tLF~$n8_YqgMJU=NJzhXSc0mA6W9+$JT%%Hti8#myCdcA(OPjd62Zp7Uiy<8*U@cTRzK}_XM7jj1AAtC zaL0rI0&pzF?Ah?aHFs*Byc>$+!_T})t(~W3y9pJ(H_a7RN;MbZTvahek@u08Nn5U{ zuoU0vg64l4H@KZE~@2Q?K2R4ha*s*I7vr3Lg~wyvVvHm`WTATRrG0gfqM zsXrO&Sq6xHL&HYs9`h&jpbyJEuODir?>+G{y?wM1K8>(eLY1yza*VXqqGK}P9#_C+ zk33LI-8j_RNqZWxS|3WSq$g^;rJ}%+NTq!s_>u+3-qn>A^y&3gk?WT&cse`F`_}-+ z1Qz;v0dP`l$_7#-^n#j>bNOB~6CQ z5zKbGPZwrqwq$3y-$5b%90oA@E(Sd&`V7keK?efRLmtBeUcrYsiRfLI!cl-7c=+?4 ztm6GUF{Yp6Imp-qp2Ok!;(~KQkU_@rlmUGDn5G|g`dJ1DcSN(l3%(ZP!%nozseKay z$mK+s>AoroOao*Z3GYjRX@E=vWEvpT7??Z-ra8#uX?I!NX$c@ZR(^GcBRIG;=I{oC z&RG3z`yTZ(b$(s(g$m^PRvMX(w{F?@D3U7F@mS^USw)WQ>R2o=vNyZoQ0-f9U6fT| ze@G)%^SxKSXx`q)7??qLZa?vUePBrCpyY|c+7e;dK z-UUV|{6~mVl^Pj_&FA(xYHMqy{Ns6_$;dA9EH+%mT)3m7hQodI<^%s=IVe^0@Y^%7 zlgv5<)aIf(?3SO{kJh&$jTqU((Prw1`Ki=Xg)W7tcaA^I^$u^`H1r3!>%#p3^R(C(FHx z5*gK$2xB3Sfj3JfcAA$3`06}zWM73omZ6V>pxYk&bs+NzuN!p=ZLA!Y0HP{# zI3#mYFWiq|Ju!AP`7Ab;o#hGm{{{t~L6oBs`=PE&#u77=G5gk-!^!(t^z2x9S7COT z?!c7TfKAvC;BXl6WIVK^`mQGep1^OnzxA{C-GIL4!ME39BeT0HW}AV`VXS^OT-aFj zdbB2hT#EuqI`Mo@9Z}>?GQt>$Mc>796%l+LnJD{3WF;R5IKGd%D)4TZ`v8GzbO#wd z39MzZUr!lP>}*H*lnnkI0tvvq{ri{;AtVyDsRcjA4K%oPFL{zhI5!t`=)u5WPhMkV z&4YE{ul>sMCIHVvrFEae+l_8TU2v%<@gf^SI~_M-kpHpvp5<>-G*Avu|0U|n!)%7j zJ%PO-Y*@gPadXWhbq`W|@MQpfIokD6)L$+e%o^C@!0qgX4iO@s_sbMDHlpAC*b{F0BUx#611`+rw^B2%ob}`m zmS9ove+MA$q*6x%g&a?zO$K>K4n_XYBRw++Xx zLc8uU4Cmbd=ywoGEdU_z1#tR7um1yX*g~FAR?_R{wtWku1WqISe_A>w4iH`KEk}M3 ze0t@*t%+D{2#6Lja?2Y(7<{_&i>L5vut7k(h08dq?^=!>d9Fb=)o=aPr9a*Nvj=$Z z1KKg;_EScoI~Tb#x2*E``88VS*3^yIjToq6^y&WE`&N(MkNn?i9@$%tYoC{xJRg7v zK4)|u^sqT0M)0buT>lEp?vctEmBod$qo(HZoiwBBI?T!?bm+BmO1RM0L^Fk5Pf!uILhb?VdJY|?vMNNu z6MqiiTuX+#4r%UqH;VB)w830T*7^#9$wz%-A6M(_Z`K)hBBn z+%=DE8P}s-uTqAAJXL=PgAXwK-ym<<94yJWoxI`I=tDWEkd2Mr{ukP5Zm{dGsj2xf z&G=6XkwUkDl6b9^#beR{QT4}MU|V{0%qJR71y?NHN@h+(v2G9EmuPm#oHh~Hm}r=&Zq zc6d4C;B&kumUDs477ru`BWJ(UErE5fM)G5rlO|2@a$jdU+8SeCWA8$W;;1(&G+^`B zsvd~WLQE7`9SJ0wB)#N`{v`$Q8V0;*f=ZWgiahT_!Mn_qfG#eZ%^9#IqhognawK{% z^C8j<=3-!OF}{cQ!cyB4I9#j~VZ8Rndv~9J;0wC$K>c_%ffxwvvf*utXcyjlBuT0>pM~c41btkbgySY3)RTYl}uSkzZ&z(lWTc_H=d&t%S zj&&3q0(bD^?3}d5Ali!@M~J;RIE~FoJ=tf|%ZQ^K@)3B0H;cyv020GKgAS%ZDp3e~ z{>nML!Xw4j69$&rgHk~XNk?6YM03<(?@ZW}Z{B?9(Vv^`+O_6>hd39IVkvx`c4 zK|b11eecSv{=Msuo=n_TpXfRDo7y8!jnu^B`_bVw*rc4T0^XZT4zPDDTwSsS!&xSK zX!=XTG@}*SSjl4Y&E~zZ)zW?+97ANA4G{&qKM0NA#qS&4j4Maeb=BCY?3Qa#*G$}o z_VaFd7AKi{g(nIJPgC3t5G0*=qtIiuU*E*KkZSA0b+9Jrlc;x404OuWV*SuyrIJVl zI}>M|061DH>(D>eZr?7VTI&Dd-dj-JRj8Y}(jkCx4J@*y_`Y`xy-GnZO3nZmn_3-Y z$I5RN8Dal&n=MvmL}S&@R@}bd4?da^re#QwDMiDU{=D)oB-y&-9wSr<5i$c(fBBBe z+fN2M0{e5zvR?unZ{JaUw*%J1K4hoaW5ISf(v0f>=pQ|E6UCe8epl{L`xgzD_r7>& zq$!x~I|!juN0E`Iu`GTq2>*5H97PndAH+6_*fay3P0(%VFlN1B)YcY6YaTht+Y8-I z?%Y3yR{s*(g%`j%?ttjve8HzEl)VRX`bo^x+c0S05YgR``3@?%1uvMfZAUq5=?n=e zOZg!j$4XBgCzycPN6Z%ZB z4EhIV@+h&WMv+tK0Zelz-YCfEWXn-K&;Lv-m3{12n4WjiKvlfv;a$&C%mL-uSdGu8 zz(il5%t!|XVlR-*yAg@D--K24GnnxFg5?~DI?&tpQS@v=OE|4@kmzuA!mwR$i^pBy z=<7l*dKVIwU9~qto6Er7U2Cy&9mtK~t8FzpYPZ>q8|`t=vF-hjzO|$DuAewys)0d& z9NR_Rlt{)Pw)thAi6^j`*o(CfJdgxON%SNWC-LIL4yZN9p#2XqT`&^^AofETnlFH` zw_=N)Pr~%WGI<+J$mG9cP)nhmvpETxJD!EL0VOT|5zrL?;%%A}*l*kREXdzYK7W#e z+2BHP_%-MTFp90v^kJ9TnDbzHqfre|@#d`X8zdXSP15;WWy@{Nou(S5tPT@A&#R z)NXz2-+CanqvEc|k}hx)gkr7GXZ|m^?bw+-6lH3%UmQSrlUt8$ODOlmatbFEtOp`q#k1VvH9oKx3FfK}H8euf!*t93%JOqAX1(s zcc8KMo=rT%QaTFPU%R~kI!(b@mO+{>>!lgmbIg=b)Hvfn`Q_QxFh{4w(+z`$)d zyWIBm>{R4ekn!g|5A=b7mI|PbDtG}z%=@+E61rAfyFCgv{TSFZKw)eH7s482*^nax ze_n*X@=tnTE}>ps*rrA65;QB|!eLhVa7nW*Q(DmcEyK?b86cJH7nZ)4eC^W!x#WlN!ggR9AQzUtmwfI2A5be>cDVQT{{R3007*qoM6N<$f)$^W Ang9R* literal 0 HcmV?d00001 diff --git a/main_prog/Drivers/BSP/vl6180/Release_Notes_files/themedata.thmx b/main_prog/Drivers/BSP/vl6180/Release_Notes_files/themedata.thmx new file mode 100644 index 0000000000000000000000000000000000000000..6adf7f0405c11a6cd3eef7e08fc5df63e2c20e80 GIT binary patch literal 3138 zcmaKu2{hFG8pj7=EMtiVGnG-3cro^&a0z2CW2@|YmMkF}F_zF+vc_c3nte&x*HRce zlVQw@?8!1|6D4lCof`1W+MV8n z-h$w+z6>~+FjZG#_I1Z#+*G|32KEpq%kJbVE&8?#GS_#fXP4;JyjK^4uS2!1i{}&! z$yJwQ!Xf<1_Qjm(A6q)wL=QEGOulp$_MYwD(e7II7~2sSn1IAer&4ar28Cqq(KeG%mk^A! z8NBrDfYKh*7V5ns%O_75G1_1gWdKHsOR=a3AA?W}BHri?H>+IntiTJTcCXTpw zOR?jqQSA|9SflZ7{xboR#Yq~Hg;>D6NT};6Ck1QO;y3cN-d5I=#9Cl&0f6H5sPPr9WBa}A$`)`%~oj(91g z8n`VvFVt1EcwfR(ca76 z#o71Ags=}@WbKA=sm){aZzYix99u5OL33+-eW6k7=FUjc%C`kK0hPu>4~JMs`?oisa|YC zh$=o~(+qc4iPOIFhPWfTfLa$5W~EpBeeukVYUTY*06-!H00954cs%TYZKZip4-9UsRr?U8WC5ZAnX z$$e=y==4YJkApgRmkpoK>a6)rpg6g`;SBHLb9=)&Ew?v~G;>a8-*~=&x9l+XJ#jp7 zD*Xi!ALKnHDQAUa<4xptmiB698=Se``Y^=z*k&}B_7vUMbZQg0Z=91V zAgHzU+>Lskz&UXA8J}`qj9;YdKvZDQ1}0jNWimgSt!dO(|LusxmW@O~&R}$`L_?;v z?Y?tB#V|7rq|gFMqSL9`fl5;tz{vsZ+V zYs68#+ASrZn4wVr2tUdLRfZb1vQTe^IVv+3igp*Bo$Cs+X+Mf#vI#d1_GGY?tZ%iM z=@LWh=ms~1BX;ZEYppyvGNf*IvwH8@blMQIYtU#=pg%!WSR71omr&<4A7>6bVhq>W zh(FE0WGebe-|UNIXzqDq?h8u%Zln}Gsd=bIN@BM* zOGXU->p6_SeBavoGL`Ka9jl=5&UB-QN7* zO)Q(-w(9NNU9M0F{kDtPsa-G=xzri7yD~9Aq;`H^UtI-LH;Xz5M<0>M~ zE*$**3#>W)rIe;-qie58f&<*;@fT{$sM?$bELOaU1G$J%r7L?(S2H3AiDb5y;d`;L zeT`qB3)|z0J3|urGu6+{{^amt8TP$X_2Sm4n@(9uYLAnbXM>p_`W}b~E~p$8&C4eD zQW~7l*25v)P`O1Xq-C{35V6m`82KSg@q}ijkU$DUVdiBm1)U>-=2JlRj`*pKxm)M& zO<$gQsV#hT3#2KrgiD9mw%!0{&eo7^xoKEpv;PCv{4wvKkx&e*|E|e@ZKy3lt8`8s>ubJ$JV}S-g%(xY; zj8o3TTyLTBcocp0kZ)pUtuV1T7TqReDBj$bkYUsr!I%T9EMkI$<*#$cjPUNt2ksmw z1u}E1?9WFzqo~^Bn+fs3R_H+r%j4OL3M6l#;UadYtPxjs-PW~{F^W^FV&|WyE>ZIgXK>Rc-wqzb;S1x z7sqlAI}d-8+nv<-`%>GC-19I^*{Q_`)@x4vvXdrTgZ#LvPDsNZ9&D_n}z%OaatTHUcv%~!Wj6+ zr`J!*jIW7`1eYHpRrG&*Z|6o>N!q%g_^$wtH_FX%c`v@*HfOqFpx8$DN6FZ69!zlt z8@c>D31TALx~GIP(^yk1c*5m;0>$@%x4KBVq;U8>zpD#5Qz*|ur%nqal?J-ZSw430 zLv^z6)U^KyG9{U)={F$@GE255Ry*{t49oN5;71+$#v|?kU@k*!72owT5ONTfG)|HB5xdP1H!tRKJvo^v($ppfQQo2I#Hj@%Ou57C@XBZ=#_@ha35gw@S;WWTqRPeUj51R7GIlJiIFQ){iS?M zwzo4O3h$sp-+3m_8QaxZgW4==j7rlY@?KBqrGylkmj5k6$!?zm z-Mm>_zyag$tQ$0z^ss^EdQh6NpFQM$fAh*;HvWr&|A${LvObsMjoi6&3+U}lY~e~4 zo{1i#o}4uQu}W>(s@90EMQmgbZB%(H1DLCqL^ zDTb`%RBLx9!CPVTm`k$0$VFkeu?Rvs-IwF6-u>*+Skv9GYQ@6D%S)#UA6@8c9o5xkJO#lS&=*)vB`-+el7fC^|^>?ESe&i@dk%FGV*Qc|}4UY6%wzRyM zqc!$7wb0Q^0RA`7(ti8p`3>Hp_5YdRFyZ}-mZItT3-28cJWNbK0|jU(`3pJyO;Nwd ye>l@&eEFG)^t()d!OYscalar 1x2x 3x */ +/** + * scaling factor to Upper limit look up + */ +static const uint16_t UpperLimitLookUP[] ROMABLE_DATA = {185, 370, 580}; /* lookup table for scaling->limit 1x2x3x */ + + +#if VL6180_RANGE_STATUS_ERRSTRING +const char *ROMABLE_DATA VL6180_RangeStatusErrString[] = { + "No Error", + "VCSEL Continuity Test", + "VCSEL Watchdog Test", + "VCSEL Watchdog", + "PLL1 Lock", + "PLL2 Lock", + "Early Convergence Estimate", + "Max Convergence", + "No Target Ignore", + "Not used 9", + "Not used 10", + "Max Signal To Noise Ratio", + "Raw Ranging Algo Underflow", + "Raw Ranging Algo Overflow", + "Ranging Algo Underflow", + "Ranging Algo Overflow", + + "Filtered by post processing (WAF)", + "Ranging filtering (WAF) on-going", + "Data not ready", +}; + +const char *VL6180_RangeGetStatusErrString(uint8_t RangeErrCode) +{ + if (RangeErrCode > sizeof(VL6180_RangeStatusErrString) / sizeof(VL6180_RangeStatusErrString[0])) + return NULL; + return VL6180_RangeStatusErrString[RangeErrCode]; +} +#endif + +#if VL6180_UPSCALE_SUPPORT == 1 + #define _GetUpscale(dev, ...) 1 + #define _SetUpscale(...) -1 + #define DEF_UPSCALE 1 +#elif VL6180_UPSCALE_SUPPORT == 2 + #define _GetUpscale(dev, ...) 2 + #define _SetUpscale(...) + #define DEF_UPSCALE 2 +#elif VL6180_UPSCALE_SUPPORT == 3 + #define _GetUpscale(dev, ...) 3 + #define _SetUpscale(...) + #define DEF_UPSCALE 3 +#else + #define DEF_UPSCALE (-(VL6180_UPSCALE_SUPPORT)) + #define _GetUpscale(dev, ...) VL6180DevDataGet(dev, UpscaleFactor) + #define _SetUpscale(dev, Scaling) VL6180DevDataSet(dev, UpscaleFactor, Scaling) +#endif + + +#if VL6180_SINGLE_DEVICE_DRIVER +/** + * the unique driver data When single device driver is active + */ +struct VL6180DevData_t VL6180_DEV_DATA_ATTR SingleVL6180DevData = { + .EceFactorM = DEF_ECE_FACTOR_M, + .EceFactorD = DEF_ECE_FACTOR_D, +#ifdef VL6180_HAVE_UPSCALE_DATA + .UpscaleFactor = DEF_UPSCALE, +#endif +#ifdef VL6180_HAVE_DMAX_RANGING + .DMaxEnable = DEF_DMAX_ENABLE, +#endif +}; +#endif /* VL6180_SINGLE_DEVICE_DRIVER */ + + + +#define Fix7_2_KCPs(x) ((((uint32_t)(x))*1000)>>7) + + +#if VL6180_WRAP_AROUND_FILTER_SUPPORT || VL6180_HAVE_DMAX_RANGING +static int _GetRateResult(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData); +#endif + +#if VL6180_WRAP_AROUND_FILTER_SUPPORT +static int _filter_Init(VL6180Dev_t dev); +static int _filter_GetResult(VL6180Dev_t dev, VL6180_RangeData_t *pData); + #define _IsWrapArroundActive(dev) VL6180DevDataGet(dev, WrapAroundFilterActive) +#else + #define _IsWrapArroundActive(dev) 0 +#endif + + +#if VL6180_HAVE_DMAX_RANGING + void _DMax_OneTimeInit(VL6180Dev_t dev); + static int _DMax_InitData(VL6180Dev_t dev); + static int _DMax_Compute(VL6180Dev_t dev, VL6180_RangeData_t *pRange); + #define _IsDMaxActive(dev) VL6180DevDataGet(dev, DMaxEnable) +#else + #define _DMax_InitData(...) 0 /* success */ + #define _DMax_OneTimeInit(...) (void)0 + #define _IsDMaxActive(...) 0 +#endif + +static int VL6180_RangeStaticInit(VL6180Dev_t dev); +static int VL6180_UpscaleStaticInit(VL6180Dev_t dev); + +int VL6180_WaitDeviceBooted(VL6180Dev_t dev) +{ + uint8_t FreshOutReset; + int status; + LOG_FUNCTION_START(""); + do { + status = VL6180_RdByte(dev, SYSTEM_FRESH_OUT_OF_RESET, &FreshOutReset); + } while (FreshOutReset != 1 && status == 0); + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_InitData(VL6180Dev_t dev) +{ + int status, dmax_status ; + int8_t offset; + uint8_t FreshOutReset; + uint32_t CalValue; + uint16_t u16; + uint32_t XTalkCompRate_KCps; + + LOG_FUNCTION_START(""); + + VL6180DevDataSet(dev, EceFactorM, DEF_ECE_FACTOR_M); + VL6180DevDataSet(dev, EceFactorD, DEF_ECE_FACTOR_D); + + VL6180DevDataSet(dev, RangeIgnore.Enabled, 0); + +#ifdef VL6180_HAVE_UPSCALE_DATA + VL6180DevDataSet(dev, UpscaleFactor, DEF_UPSCALE); +#endif + +#ifdef VL6180_HAVE_WRAP_AROUND_DATA + VL6180DevDataSet(dev, WrapAroundFilterActive, (VL6180_WRAP_AROUND_FILTER_SUPPORT > 0)); + VL6180DevDataSet(dev, DMaxEnable, DEF_DMAX_ENABLE); +#endif + + _DMax_OneTimeInit(dev); + do { + + /* backup offset initial value from nvm these must be done prior any over call that use offset */ + status = VL6180_RdByte(dev, SYSRANGE_PART_TO_PART_RANGE_OFFSET, (uint8_t *)&offset); + if (status) { + break; + } + VL6180DevDataSet(dev, Part2PartOffsetNVM, offset); + + status = VL6180_RdDWord(dev, SYSRANGE_RANGE_IGNORE_THRESHOLD, &CalValue); + if (status) { + break; + } + if ((CalValue&0xFFFF0000) == 0) { + CalValue = 0x00CE03F8; + } + VL6180DevDataSet(dev, Part2PartAmbNVM, CalValue); + + status = VL6180_RdWord(dev, SYSRANGE_CROSSTALK_COMPENSATION_RATE , &u16); + if (status) { + break; + } + XTalkCompRate_KCps = Fix7_2_KCPs(u16); + VL6180DevDataSet(dev, XTalkCompRate_KCps, XTalkCompRate_KCps); + + dmax_status = _DMax_InitData(dev); + if (dmax_status < 0) { + break; + } + + /* Read or wait for fresh out of reset */ + status = VL6180_RdByte(dev, SYSTEM_FRESH_OUT_OF_RESET, &FreshOutReset); + if (status) { + break; + } + if (FreshOutReset != 1 || dmax_status) + status = CALIBRATION_WARNING; + + } while (0); + + LOG_FUNCTION_END(status); + return status; +} + +int8_t VL6180_GetOffsetCalibrationData(VL6180Dev_t dev) +{ + int8_t offset; + LOG_FUNCTION_START(""); + offset = VL6180DevDataGet(dev, Part2PartOffsetNVM); + LOG_FUNCTION_END(offset); + return offset; +} + +int VL6180_SetOffsetCalibrationData(VL6180Dev_t dev, int8_t offset) +{ + int status; + LOG_FUNCTION_START("%d", offset); + VL6180DevDataSet(dev, Part2PartOffsetNVM, offset); + offset /= _GetUpscale(dev); + status = VL6180_WrByte(dev, SYSRANGE_PART_TO_PART_RANGE_OFFSET, offset); + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_SetXTalkCompensationRate(VL6180Dev_t dev, FixPoint97_t Rate) +{ + int status; + LOG_FUNCTION_START("%d", Rate); + status = VL6180_WrWord(dev, SYSRANGE_CROSSTALK_COMPENSATION_RATE, Rate); + if (status == 0) { + uint32_t XTalkCompRate_KCps; + XTalkCompRate_KCps = Fix7_2_KCPs(Rate); + VL6180DevDataSet(dev, XTalkCompRate_KCps, XTalkCompRate_KCps); + /* update dmax whenever xtalk rate changes */ + status = _DMax_InitData(dev); + } + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_SetI2CAddress(VL6180Dev_t dev, uint8_t NewAddress) +{ + int status; + LOG_FUNCTION_START(""); + + status = VL6180_WrByte(dev, I2C_SLAVE_DEVICE_ADDRESS, NewAddress / 2); + if (status) { + VL6180_ErrLog("new i2c addr Wr fail"); + } + LOG_FUNCTION_END(status); + return status; +} + +uint16_t VL6180_GetUpperLimit(VL6180Dev_t dev) +{ + uint16_t limit; + int scaling; + + LOG_FUNCTION_START(""); + + scaling = _GetUpscale(dev); + /* FIXME we do assume here _GetUpscale is valid if user call us prior to init we may overflow the LUT mem area */ + limit = UpperLimitLookUP[scaling - 1]; + + LOG_FUNCTION_END((int)limit); + return limit; +} + + + +int VL6180_StaticInit(VL6180Dev_t dev) +{ + int status = 0, init_status; + LOG_FUNCTION_START(""); + + /* TODO doc When using configurable scaling but using 1x as start condition + * load tunning upscale or not ??? */ + if (_GetUpscale(dev) == 1 && !(VL6180_UPSCALE_SUPPORT < 0)) + init_status = VL6180_RangeStaticInit(dev); + else + init_status = VL6180_UpscaleStaticInit(dev); + + if (init_status < 0) { + goto error; + } else if (init_status > 0) { + } + + if (status < 0) { + VL6180_ErrLog("StaticInit fail"); + } + if (!status && init_status) { + status = init_status; + } +error: + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_SetGroupParamHold(VL6180Dev_t dev, int Hold) +{ + int status; + uint8_t value; + + LOG_FUNCTION_START("%d", Hold); + if (Hold) + value = 1; + else + value = 0; + status = VL6180_WrByte(dev, SYSTEM_GROUPED_PARAMETER_HOLD, value); + + LOG_FUNCTION_END(status); + return status; + +} + +int VL6180_Prepare(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); + + do { + status = VL6180_StaticInit(dev); + if (status < 0) + break; + status = VL6180_SetupGPIO1(dev, GPIOx_SELECT_GPIO_INTERRUPT_OUTPUT, INTR_POL_HIGH ); + if (status) + break; + /* set range InterruptMode to new sample */ + status = VL6180_RangeConfigInterrupt(dev, CONFIG_GPIO_INTERRUPT_NEW_SAMPLE_READY); + if (status) + break; + + /* set default threshold */ +/* status = VL6180_RangeSetRawThresholds(dev, 10, 200); + if (status) { + break; + }*/ + #if VL6180_WRAP_AROUND_FILTER_SUPPORT + _filter_Init(dev); + #endif + /* make sure to reset any left previous condition that can hangs first poll */ + status = VL6180_ClearAllInterrupt(dev); + } while (0); + LOG_FUNCTION_END(status); + + return status; +} + + +int VL6180_RangePollMeasurement(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData) +{ + int status; + int ClrStatus; + IntrStatus_t IntStatus; + + LOG_FUNCTION_START(""); + /* start single range measurement */ + + + #if VL6180_SAFE_POLLING_ENTER + /* if device get stopped with left interrupt uncleared , it is required to clear them now or poll for new condition will never occur*/ + status = VL6180_RangeClearInterrupt(dev); + if (status) { + VL6180_ErrLog("VL6180_RangeClearInterrupt fail"); + goto done; + } + #endif + /* //![single_shot_snipet] */ + status = VL6180_RangeSetSystemMode(dev, MODE_START_STOP | MODE_SINGLESHOT); + if (status) { + goto done; + } + + + /* poll for new sample ready */ + while (1) { + status = VL6180_RangeGetInterruptStatus(dev, &IntStatus.val); + if (status) { + break; + } + if (IntStatus.status.Range == RES_INT_STAT_GPIO_NEW_SAMPLE_READY || IntStatus.status.Error != 0) { + break; + } + + //VL6180_PollDelay(dev); + } + /* //![single_shot_snipet] */ + + if (!status) { + status = VL6180_RangeGetMeasurement(dev, pRangeData); + } + + /* clear range interrupt source */ + ClrStatus = VL6180_RangeClearInterrupt(dev); + if (ClrStatus) { + /* leave initial status if already in error */ + if (!status) { + status = ClrStatus; + } + } +done: + LOG_FUNCTION_END(status); + return status; +} + + +#if VL6180_CACHED_REG + +int VL6180_GetCachedDWord(VL6180Dev_t dev, uint16_t index, uint32_t *pValue) +{ + int status; + uint32_t Value; + if (VL6180DevDataGet(dev, CacheFilled) != 0 && + index >= VL6180_FIRST_CACHED_INDEX && + index <= (VL6180_LAST_CACHED_INDEX - 3)) { + uint8_t *pBytes = &VL6180DevDataGet(dev, CachedRegs[index - VL6180_FIRST_CACHED_INDEX]); + Value = ((uint32_t)pBytes[0] << 24) | + ((uint32_t)pBytes[1] << 16) | + ((uint32_t)pBytes[2] << 8) | + (uint32_t)pBytes[3]; + *pValue = Value; + status = 0; + } else { + status = VL6180_RdDWord(dev, index, pValue); + } + return status; +} + +int VL6180_GetCachedWord(VL6180Dev_t dev, uint16_t index, uint16_t *pValue) +{ + int status; + uint32_t Value; + if (VL6180DevDataGet(dev, CacheFilled) != 0 && + index >= VL6180_FIRST_CACHED_INDEX && + index <= (VL6180_LAST_CACHED_INDEX - 1)) { + uint8_t *pBytes = &VL6180DevDataGet(dev, CachedRegs[index - VL6180_FIRST_CACHED_INDEX]); + Value = ((uint32_t)pBytes[0] << 8) | (uint32_t)pBytes[1]; + *pValue = Value; + status = 0; + } else { + status = VL6180_RdWord(dev, index, pValue); + } + return status; +} + +int VL6180_GetCachedByte(VL6180Dev_t dev, uint16_t index, uint8_t *pValue) +{ + int status; + uint8_t Value; + if (VL6180DevDataGet(dev, CacheFilled) != 0 && + index >= VL6180_FIRST_CACHED_INDEX && + index <= VL6180_LAST_CACHED_INDEX) { + Value = VL6180DevDataGet(dev, CachedRegs[index - VL6180_FIRST_CACHED_INDEX]); + *pValue = Value; + status = 0; + } else { + status = VL6180_RdByte(dev, index, pValue); + } + return status; +} + + +int _CachedRegs_Fetch(VL6180Dev_t dev) +{ + int status; + uint8_t *Buffer; + if (VL6180DevDataGet(dev, CacheFilled) == 0) { + VL6180DevDataSet(dev, CacheFilled, 1); + Buffer = &VL6180DevDataGet(dev, CachedRegs[0]); + status = VL6180_RdMulti(dev, VL6180_FIRST_CACHED_INDEX, Buffer, VL6180_CACHED_REG_CNT); + } else { + status = 0 ; + } + return status; +} + +void _CachedRegs_Flush(VL6180Dev_t dev) +{ + VL6180DevDataSet(dev, CacheFilled, 0); +} + +#else +# define _CachedRegs_Fetch(...) 0 +# define _CachedRegs_Flush(...) (void)0 +# define _Fetch_CachedRegs(...) 0 +# define VL6180_GetCachedByte(dev, index, pValue) VL6180_RdByte(dev, index, pValue) +# define VL6180_GetCachedWord(dev, index, pValue) VL6180_RdWord(dev, index, pValue) +# define VL6180_GetCachedDWord(dev, index, pValue) VL6180_RdDWord(dev, index, pValue) +#endif /* VL6180_CACHED_REG */ + + + +int VL6180_RangeGetMeasurement(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData) +{ + int status; + uint16_t RawRate; + uint8_t RawStatus; + + LOG_FUNCTION_START(""); + + status = _CachedRegs_Fetch(dev); + if (status) { + VL6180_ErrLog("Cache register read fail"); + goto error; + } + status = VL6180_RangeGetResult(dev, &pRangeData->range_mm); + if (!status) { + status = VL6180_GetCachedWord(dev, RESULT_RANGE_SIGNAL_RATE, &RawRate); + if (!status) { + pRangeData->signalRate_mcps = VL6180_9to7Conv(RawRate); + status = VL6180_GetCachedByte(dev, RESULT_RANGE_STATUS, &RawStatus); + if (!status) { + pRangeData->errorStatus = RawStatus >> 4; + } else { + } + #if VL6180_WRAP_AROUND_FILTER_SUPPORT || VL6180_HAVE_DMAX_RANGING + status = _GetRateResult(dev, pRangeData); + if (status) + goto error; + #endif + #if VL6180_WRAP_AROUND_FILTER_SUPPORT + /* if enabled run filter */ + if (_IsWrapArroundActive(dev)) { + status = _filter_GetResult(dev, pRangeData); + if (!status) { + /* patch the range status and measure if it is filtered */ + if(pRangeData->FilteredData.filterError != NoError) { + pRangeData->errorStatus = pRangeData->FilteredData.filterError; + pRangeData->range_mm = pRangeData->FilteredData.range_mm; + } + } + } + #endif + + #if VL6180_HAVE_DMAX_RANGING + if (_IsDMaxActive(dev)) { + _DMax_Compute(dev, pRangeData); + } + #endif + } else { + } + } else { + } +error: + _CachedRegs_Flush(dev); + LOG_FUNCTION_END_FMT(status, "%d %d %d", (int)pRangeData->range_mm, (int)pRangeData->signalRate_mcps, (int)pRangeData->errorStatus) ; + return status; +} + + +int VL6180_RangeGetMeasurementIfReady(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData) +{ + int status; + IntrStatus_t IntStatus; + + LOG_FUNCTION_START(); + status = VL6180_RangeGetInterruptStatus(dev, &IntStatus.val); + if (status == 0) { + if (IntStatus.status.Range == RES_INT_STAT_GPIO_NEW_SAMPLE_READY || + IntStatus.status.Error != 0) { + status = VL6180_RangeGetMeasurement(dev, pRangeData); + if (status == 0) { + /* clear range interrupt source */ + status = VL6180_RangeClearInterrupt(dev); + if (status) { + VL6180_ErrLog("VL6180_RangeClearInterrupt fail"); + } + } + } else { + pRangeData->errorStatus = DataNotReady; + } + } else { + VL6180_ErrLog("fail to get interrupt status"); + } + LOG_FUNCTION_END(status) ; + return status; +} + +int VL6180_FilterSetState(VL6180Dev_t dev, int state) +{ + int status; + LOG_FUNCTION_START("%d", state); + #if VL6180_WRAP_AROUND_FILTER_SUPPORT + VL6180DevDataSet(dev, WrapAroundFilterActive, state); + status = 0; + #else + status = NOT_SUPPORTED; + #endif + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_FilterGetState(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); + #if VL6180_WRAP_AROUND_FILTER_SUPPORT + status = VL6180DevDataGet(dev, WrapAroundFilterActive); + #else + status = 0; + #endif + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeGetResult(VL6180Dev_t dev, int32_t *pRange_mm) +{ + int status; + uint8_t RawRange; + int32_t Upscale; + + LOG_FUNCTION_START("%p", pRange_mm); + + status = VL6180_GetCachedByte(dev, RESULT_RANGE_VAL, &RawRange); + if (!status) { + Upscale = _GetUpscale(dev); + *pRange_mm = Upscale * (int32_t)RawRange; + } + LOG_FUNCTION_END_FMT(status, "%d", (int)*pRange_mm); + return status; +} + +int VL6180_RangeSetRawThresholds(VL6180Dev_t dev, uint8_t low, uint8_t high) +{ + int status; + LOG_FUNCTION_START("%d %d", (int) low, (int)high); + /* TODO we can optimize here grouping high/low in a word but that's cpu endianness dependent */ + status = VL6180_WrByte(dev, SYSRANGE_THRESH_HIGH, high); + if (!status) { + status = VL6180_WrByte(dev, SYSRANGE_THRESH_LOW, low); + } + + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeSetThresholds(VL6180Dev_t dev, uint16_t low, uint16_t high, int UseSafeParamHold) +{ + int status; + int scale; + LOG_FUNCTION_START("%d %d", (int) low, (int)high); + scale = _GetUpscale(dev, UpscaleFactor); + if (low > scale * 255 || high > scale * 255) { + status = INVALID_PARAMS; + } else { + do { + if (UseSafeParamHold) { + status = VL6180_SetGroupParamHold(dev, 1); + if (status) + break; + } + status = VL6180_RangeSetRawThresholds(dev, (uint8_t)(low / scale), (uint8_t)(high / scale)); + if (UseSafeParamHold) { + int HoldStatus; + /* tryt to unset param hold vene if previous fail */ + HoldStatus = VL6180_SetGroupParamHold(dev, 0); + if (!status) + status = HoldStatus; + } + } while (0); + } + + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_RangeGetThresholds(VL6180Dev_t dev, uint16_t *low, uint16_t *high) +{ + int status = 0; + uint8_t RawLow, RawHigh; + int scale; + + LOG_FUNCTION_START("%p %p", low , high); + + scale = _GetUpscale(dev, UpscaleFactor); + do { + if (high != NULL) { + status = VL6180_RdByte(dev, SYSRANGE_THRESH_HIGH, &RawHigh); + if (status) { + VL6180_ErrLog("rd SYSRANGE_THRESH_HIGH fail"); + break; + } + *high = (uint16_t)RawHigh * scale; + } + if (low != NULL) { + status = VL6180_RdByte(dev, SYSRANGE_THRESH_LOW, &RawLow); + if (status) { + VL6180_ErrLog("rd SYSRANGE_THRESH_LOW fail"); + break; + } + *low = (uint16_t)RawLow * scale; + } + } while (0); + LOG_FUNCTION_END_FMT(status, "%d %d", (int)*low , (int)*high); + return status; +} + + +int VL6180_RangeGetInterruptStatus(VL6180Dev_t dev, uint8_t *pIntStatus) +{ + int status; + uint8_t IntStatus; + LOG_FUNCTION_START("%p", pIntStatus); + /* FIXME we are grouping "error" with over status the user must check implicitly for it + * not just new sample or over status , that will nevr show up in case of error*/ + status = VL6180_GetCachedByte(dev, RESULT_INTERRUPT_STATUS_GPIO, &IntStatus); + *pIntStatus = IntStatus & 0xC7; + + LOG_FUNCTION_END_FMT(status, "%d", (int)*pIntStatus); + return status; +} + + +int VL6180_GetInterruptStatus(VL6180Dev_t dev, uint8_t *IntStatus) +{ + int status; + LOG_FUNCTION_START("%p" , IntStatus); + status = VL6180_RdByte(dev, RESULT_INTERRUPT_STATUS_GPIO, IntStatus); + LOG_FUNCTION_END_FMT(status, "%d", (int)*IntStatus); + return status; +} + +int VL6180_ClearInterrupt(VL6180Dev_t dev, uint8_t IntClear) +{ + int status; + LOG_FUNCTION_START("%d", (int)IntClear); + if (IntClear <= 7) { + status = VL6180_WrByte(dev, SYSTEM_INTERRUPT_CLEAR, IntClear); + } else { + status = INVALID_PARAMS; + } + LOG_FUNCTION_END(status); + return status; +} + + +static int VL6180_RangeStaticInit(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); + + /* REGISTER_TUNING_SR03_270514_CustomerView.txt */ + VL6180_WrByte(dev, 0x0207, 0x01); + VL6180_WrByte(dev, 0x0208, 0x01); + VL6180_WrByte(dev, 0x0096, 0x00); + VL6180_WrByte(dev, 0x0097, 0xfd); + VL6180_WrByte(dev, 0x00e3, 0x00); + VL6180_WrByte(dev, 0x00e4, 0x04); + VL6180_WrByte(dev, 0x00e5, 0x02); + VL6180_WrByte(dev, 0x00e6, 0x01); + VL6180_WrByte(dev, 0x00e7, 0x03); + VL6180_WrByte(dev, 0x00f5, 0x02); + VL6180_WrByte(dev, 0x00d9, 0x05); + VL6180_WrByte(dev, 0x00db, 0xce); + VL6180_WrByte(dev, 0x00dc, 0x03); + VL6180_WrByte(dev, 0x00dd, 0xf8); + VL6180_WrByte(dev, 0x009f, 0x00); + VL6180_WrByte(dev, 0x00a3, 0x3c); + VL6180_WrByte(dev, 0x00b7, 0x00); + VL6180_WrByte(dev, 0x00bb, 0x3c); + VL6180_WrByte(dev, 0x00b2, 0x09); + VL6180_WrByte(dev, 0x00ca, 0x09); + VL6180_WrByte(dev, 0x0198, 0x01); + VL6180_WrByte(dev, 0x01b0, 0x17); + VL6180_WrByte(dev, 0x01ad, 0x00); + VL6180_WrByte(dev, 0x00ff, 0x05); + VL6180_WrByte(dev, 0x0100, 0x05); + VL6180_WrByte(dev, 0x0199, 0x05); + VL6180_WrByte(dev, 0x01a6, 0x1b); + VL6180_WrByte(dev, 0x01ac, 0x3e); + VL6180_WrByte(dev, 0x01a7, 0x1f); + VL6180_WrByte(dev, 0x0030, 0x00); + + /* Recommended : Public registers - See data sheet for more detail */ + VL6180_WrByte(dev, 0x0011, 0x10); /* Enables polling for New Sample ready when measurement completes */ + VL6180_WrByte(dev, 0x010a, 0x30); /* Set the averaging sample period (compromise between lower noise and increased execution time) */ + VL6180_WrByte(dev, 0x003f, 0x46); /* Sets the light and dark gain (upper nibble). Dark gain should not be changed.*/ + VL6180_WrByte(dev, 0x0031, 0xFF); /* sets the # of range measurements after which auto calibration of system is performed */ + VL6180_WrByte(dev, 0x002e, 0x01); /* perform a single temperature calibration of the ranging sensor */ + + /* Optional: Public registers - See data sheet for more detail */ + VL6180_WrByte(dev, 0x001b, 0x09); /* Set default ranging inter-measurement period to 100ms */ + VL6180_WrByte(dev, 0x0014, 0x24); /* Configures interrupt on New sample ready */ + + + status = VL6180_RangeSetMaxConvergenceTime(dev, 50); /* Calculate ece value on initialization (use max conv) */ + LOG_FUNCTION_END(status); + + return status; +} + +#if VL6180_UPSCALE_SUPPORT != 1 + +static int _UpscaleInitPatch0(VL6180Dev_t dev) +{ + int status; + uint32_t CalValue = 0; + CalValue = VL6180DevDataGet(dev, Part2PartAmbNVM); + status = VL6180_WrDWord(dev, 0xDA, CalValue); + return status; +} + +/* only include up-scaling register setting when up-scale support is configured in */ +int VL6180_UpscaleRegInit(VL6180Dev_t dev) +{ + /* apply REGISTER_TUNING_ER02_100614_CustomerView.txt */ + VL6180_WrByte(dev, 0x0207, 0x01); + VL6180_WrByte(dev, 0x0208, 0x01); + VL6180_WrByte(dev, 0x0096, 0x00); + VL6180_WrByte(dev, 0x0097, 0x54); + VL6180_WrByte(dev, 0x00e3, 0x00); + VL6180_WrByte(dev, 0x00e4, 0x04); + VL6180_WrByte(dev, 0x00e5, 0x02); + VL6180_WrByte(dev, 0x00e6, 0x01); + VL6180_WrByte(dev, 0x00e7, 0x03); + VL6180_WrByte(dev, 0x00f5, 0x02); + VL6180_WrByte(dev, 0x00d9, 0x05); + + _UpscaleInitPatch0(dev); + + VL6180_WrByte(dev, 0x009f, 0x00); + VL6180_WrByte(dev, 0x00a3, 0x28); + VL6180_WrByte(dev, 0x00b7, 0x00); + VL6180_WrByte(dev, 0x00bb, 0x28); + VL6180_WrByte(dev, 0x00b2, 0x09); + VL6180_WrByte(dev, 0x00ca, 0x09); + VL6180_WrByte(dev, 0x0198, 0x01); + VL6180_WrByte(dev, 0x01b0, 0x17); + VL6180_WrByte(dev, 0x01ad, 0x00); + VL6180_WrByte(dev, 0x00ff, 0x05); + VL6180_WrByte(dev, 0x0100, 0x05); + VL6180_WrByte(dev, 0x0199, 0x05); + VL6180_WrByte(dev, 0x01a6, 0x1b); + VL6180_WrByte(dev, 0x01ac, 0x3e); + VL6180_WrByte(dev, 0x01a7, 0x1f); + VL6180_WrByte(dev, 0x0030, 0x00); + VL6180_WrByte(dev, 0x0011, 0x10); + VL6180_WrByte(dev, 0x010a, 0x30); + VL6180_WrByte(dev, 0x003f, 0x46); + VL6180_WrByte(dev, 0x0031, 0xFF); + VL6180_WrByte(dev, 0x0040, 0x63); + VL6180_WrByte(dev, 0x002e, 0x01); + VL6180_WrByte(dev, 0x002c, 0xff); + VL6180_WrByte(dev, 0x001b, 0x09); + VL6180_WrByte(dev, 0x003e, 0x31); + VL6180_WrByte(dev, 0x0014, 0x24); +#if VL6180_EXTENDED_RANGE + VL6180_RangeSetMaxConvergenceTime(dev, 63); +#else + VL6180_RangeSetMaxConvergenceTime(dev, 50); +#endif + return 0; +} +#else +#define VL6180_UpscaleRegInit(...) -1 +#endif + +int VL6180_UpscaleSetScaling(VL6180Dev_t dev, uint8_t scaling) +{ + int status; + uint16_t Scaler; + uint16_t ValidHeight; + int8_t Offset; + + +#ifdef VL6180_HAVE_UPSCALE_DATA + #define min_scaling 1 + #define max_scaling (sizeof(ScalerLookUP) / sizeof(ScalerLookUP[0])) +#else + /* we are in fixed config so only allow configured factor */ + #define min_scaling VL6180_UPSCALE_SUPPORT + #define max_scaling VL6180_UPSCALE_SUPPORT +#endif + + if (scaling >= min_scaling && scaling <= max_scaling) { + + Scaler = ScalerLookUP[scaling - 1]; + status = VL6180_WrWord(dev, RANGE_SCALER, Scaler); + _SetUpscale(dev, scaling); + + /* Apply scaling on part-2-part offset */ + Offset = VL6180DevDataGet(dev, Part2PartOffsetNVM) / scaling; + status = VL6180_WrByte(dev, SYSRANGE_PART_TO_PART_RANGE_OFFSET, Offset); + + /* Apply scaling on CrossTalkValidHeight */ + if (status == 0) { + status = VL6180_WrByte(dev, SYSRANGE_CROSSTALK_VALID_HEIGHT, + DEF_CROSS_TALK_VALID_HEIGHT_VALUE / scaling); + } + /* Apply scaling on RangeIgnore ValidHeight if enabled */ + if ( status == 0) { + if ( VL6180DevDataGet(dev, RangeIgnore.Enabled) !=0 ) { + ValidHeight = VL6180DevDataGet(dev, RangeIgnore.ValidHeight); + ValidHeight /= _GetUpscale(dev); + if( ValidHeight > 255 ) + ValidHeight = 255; + + status = VL6180_WrByte(dev, SYSRANGE_RANGE_IGNORE_VALID_HEIGHT, + (uint8_t)(ValidHeight & 0xFF) ); + } + } + +#if !VL6180_EXTENDED_RANGE + if (status == 0) { + status = VL6180_RangeSetEceState(dev, scaling == 1); /* enable ece only at 1x scaling */ + } + if (status == 0 && !VL6180_EXTENDED_RANGE && scaling != 1) { + status = NOT_GUARANTEED ; + } +#endif + } else { + status = INVALID_PARAMS; + } +#undef min_scaling +#undef max_scaling + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_UpscaleGetScaling(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); + status = _GetUpscale(dev); + LOG_FUNCTION_END(status); + + return status; +} + + +static int VL6180_UpscaleStaticInit(VL6180Dev_t dev) +{ + /* todo make these a fail macro in case only 1x is suppoted */ + int status; + + LOG_FUNCTION_START(""); + do { + status = VL6180_UpscaleRegInit(dev); + if (status) { + break; + } +#if VL6180_EXTENDED_RANGE + status = VL6180_RangeSetEceState(dev, 0); + if (status) { + VL6180_ErrLog("VL6180_RangeSetEceState fail"); + break; + } +#endif + } while (0); + if (!status) { + /* must write the scaler at least once to the device to ensure the scaler is in a known state. */ + status = VL6180_UpscaleSetScaling(dev, _GetUpscale(dev)); + VL6180_WrByte(dev, 0x016, 0x00); /* change fresh out of set status to 0 */ + } + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_SetGPIOxFunctionality(VL6180Dev_t dev, int pin, uint8_t functionality) +{ + int status; + + LOG_FUNCTION_START("%d %d", (int) pin, (int)functionality); + + if (((pin == 0) || (pin == 1)) && IsValidGPIOFunction(functionality)) { + uint16_t RegIndex; + + if (pin == 0) + RegIndex = SYSTEM_MODE_GPIO0; + else + RegIndex = SYSTEM_MODE_GPIO1; + + status = VL6180_UpdateByte(dev, RegIndex, (uint8_t)~GPIOx_FUNCTIONALITY_SELECT_MASK, + functionality << GPIOx_FUNCTIONALITY_SELECT_SHIFT); + + } else { + status = INVALID_PARAMS; + } + + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_SetupGPIOx(VL6180Dev_t dev, int pin, uint8_t IntFunction, int ActiveHigh) +{ + int status; + + LOG_FUNCTION_START("%d %d", (int) pin, (int)IntFunction); + + if (((pin == 0) || (pin == 1)) && IsValidGPIOFunction(IntFunction)) { + uint16_t RegIndex; + uint8_t value = 0; + + if (pin == 0) + RegIndex = SYSTEM_MODE_GPIO0; + else + RegIndex = SYSTEM_MODE_GPIO1; + + if (ActiveHigh) + value |= GPIOx_POLARITY_SELECT_MASK; + + value |= IntFunction << GPIOx_FUNCTIONALITY_SELECT_SHIFT; + status = VL6180_WrByte(dev, RegIndex, value); + if (status) { + } + } else { + status = INVALID_PARAMS; + } + + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_DisableGPIOxOut(VL6180Dev_t dev, int pin) +{ + int status; + + LOG_FUNCTION_START("%d", (int)pin); + + status = VL6180_SetGPIOxFunctionality(dev, pin, GPIOx_SELECT_OFF); + + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_SetupGPIO1(VL6180Dev_t dev, uint8_t IntFunction, int ActiveHigh) +{ + int status; + LOG_FUNCTION_START("%d %d", (int)IntFunction, (int)ActiveHigh); + status = VL6180_SetupGPIOx(dev, 1, IntFunction, ActiveHigh); + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeConfigInterrupt(VL6180Dev_t dev, uint8_t ConfigGpioInt) +{ + int status; + + if (ConfigGpioInt <= CONFIG_GPIO_INTERRUPT_NEW_SAMPLE_READY) { + status = VL6180_UpdateByte(dev, SYSTEM_INTERRUPT_CONFIG_GPIO, + (uint8_t)(~CONFIG_GPIO_RANGE_MASK), + ConfigGpioInt); + } else { + status = INVALID_PARAMS; + } + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_RangeSetEceFactor(VL6180Dev_t dev, uint16_t FactorM, uint16_t FactorD) +{ + int status; + uint8_t u8; + + LOG_FUNCTION_START("%d %d", (int)FactorM, (int)FactorD); + do { + /* D cannot be 0 M must be <=D and >= 0 */ + if (FactorM <= FactorD && FactorD > 0) { + VL6180DevDataSet(dev, EceFactorM, FactorM); + VL6180DevDataSet(dev, EceFactorD, FactorD); + /* read and re-apply max conv time to get new ece factor set */ + status = VL6180_RdByte(dev, SYSRANGE_MAX_CONVERGENCE_TIME, &u8); + if (status) { + VL6180_ErrLog("SYSRANGE_MAX_CONVERGENCE_TIME rd fail "); + break; + } + status = VL6180_RangeSetMaxConvergenceTime(dev, u8); + if (status < 0) { + VL6180_ErrLog("fail to apply time after ece m/d change"); + break; + } + } else { + VL6180_ErrLog("invalid factor %d/%d", (int)FactorM, (int)FactorD); + status = INVALID_PARAMS; + } + } while (0); + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeSetEceState(VL6180Dev_t dev, int enable) +{ + int status; + uint8_t or_mask; + + LOG_FUNCTION_START("%d", (int)enable); + if (enable) + or_mask = RANGE_CHECK_ECE_ENABLE_MASK; + else + or_mask = 0; + + status = VL6180_UpdateByte(dev, SYSRANGE_RANGE_CHECK_ENABLES, ~RANGE_CHECK_ECE_ENABLE_MASK, or_mask); + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_RangeSetMaxConvergenceTime(VL6180Dev_t dev, uint8_t MaxConTime_msec) +{ + int status = 0; + LOG_FUNCTION_START("%d", (int)MaxConTime_msec); + do { + status = VL6180_WrByte(dev, SYSRANGE_MAX_CONVERGENCE_TIME, MaxConTime_msec); + if (status) { + break; + } + status = VL6180_RangeSetEarlyConvergenceEestimateThreshold(dev); + if (status) { + break; + } + status = _DMax_InitData(dev); + } while (0); + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeSetInterMeasPeriod(VL6180Dev_t dev, uint32_t InterMeasTime_msec) +{ + uint8_t SetTime; + int status; + + LOG_FUNCTION_START("%d", (int)InterMeasTime_msec); + do { + if (InterMeasTime_msec > 2550) { + status = INVALID_PARAMS; + break; + } + /* doc in not 100% clear and confusing about the limit practically all value are OK but 0 + * that can hang device in continuous mode */ + if (InterMeasTime_msec < 10) { + InterMeasTime_msec = 10; + } + SetTime = (uint8_t)(InterMeasTime_msec / 10); + status = VL6180_WrByte(dev, SYSRANGE_INTERMEASUREMENT_PERIOD, SetTime); + if (status) { + } else if (SetTime != InterMeasTime_msec / 10) { + status = MIN_CLIPED; /* on success change status to clip if it did */ + } + } while (0); + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_RangeGetDeviceReady(VL6180Dev_t dev, int *Ready) +{ + int status; + uint8_t u8; + LOG_FUNCTION_START("%p", (int)Ready); + status = VL6180_RdByte(dev, RESULT_RANGE_STATUS, &u8); + if (!status) + *Ready = u8&RANGE_DEVICE_READY_MASK; + LOG_FUNCTION_END_FMT(status, "%d", *Ready); + return status; +} + + +int VL6180_RangeWaitDeviceReady(VL6180Dev_t dev, int MaxLoop) +{ + int status = 0; /* if user specify an invalid <=0 loop count we'll return error */ + int n; + uint8_t u8; + LOG_FUNCTION_START("%d", (int)MaxLoop); + if (MaxLoop < 1) { + status = INVALID_PARAMS; + } else { + for (n = 0; n < MaxLoop ; n++) { + status = VL6180_RdByte(dev, RESULT_RANGE_STATUS, &u8); + if (status) + break; + u8 = u8 & RANGE_DEVICE_READY_MASK; + if (u8) + break; + + } + if (!status && !u8) { + status = TIME_OUT; + } + } + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeSetSystemMode(VL6180Dev_t dev, uint8_t mode) +{ + int status; + LOG_FUNCTION_START("%d", (int)mode); + /* FIXME we are not checking device is ready via @a VL6180_RangeWaitDeviceReady + * so if called back to back real fast we are not checking + * if previous mode "set" got absorbed => bit 0 must be 0 so that it work + */ + if (mode <= 3) { + status = VL6180_WrByte(dev, SYSRANGE_START, mode); + if (status) { + } + } else { + status = INVALID_PARAMS; + } + LOG_FUNCTION_END(status); + return status; +} + + +int VL6180_RangeStartContinuousMode(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); + status = VL6180_RangeSetSystemMode(dev, MODE_START_STOP | MODE_CONTINUOUS); + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeStartSingleShot(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); + status = VL6180_RangeSetSystemMode(dev, MODE_START_STOP | MODE_SINGLESHOT); + LOG_FUNCTION_END(status); + return status; +} + + +static int VL6180_RangeSetEarlyConvergenceEestimateThreshold(VL6180Dev_t dev) +{ + int status; + + const uint32_t cMicroSecPerMilliSec = 1000; + const uint32_t cEceSampleTime_us = 500; + uint32_t ece_factor_m = VL6180DevDataGet(dev, EceFactorM); + uint32_t ece_factor_d = VL6180DevDataGet(dev, EceFactorD); + uint32_t convergTime_us; + uint32_t fineThresh; + uint32_t eceThresh; + uint8_t u8; + uint32_t maxConv_ms; + int32_t AveTime; + + LOG_FUNCTION_START(""); + + do { + status = VL6180_RdByte(dev, SYSRANGE_MAX_CONVERGENCE_TIME, &u8); + if (status) { + break; + } + maxConv_ms = u8; + AveTime = _GetAveTotalTime(dev); + if (AveTime < 0) { + status = -1; + break; + } + + convergTime_us = maxConv_ms * cMicroSecPerMilliSec - AveTime; + status = VL6180_RdDWord(dev, 0xB8, &fineThresh); + if (status) { + break; + } + fineThresh *= 256; + eceThresh = ece_factor_m * cEceSampleTime_us * fineThresh / (convergTime_us * ece_factor_d); + + status = VL6180_WrWord(dev, SYSRANGE_EARLY_CONVERGENCE_ESTIMATE, (uint16_t)eceThresh); + } while (0); + + LOG_FUNCTION_END(status); + return status; +} + + +static int _RangeIgnore_UpdateDevice(VL6180Dev_t dev){ + int status; + int enable; + int threshold; + int range; + int or_mask; + enable= VL6180DevDataGet(dev, RangeIgnore.Enabled); + if( enable ){ + // if to be nabled program first range value and threshold + range = VL6180DevDataGet(dev, RangeIgnore.ValidHeight); + range /= _GetUpscale(dev); + if( range > 255 ) + range = 255; + + status = VL6180_WrByte(dev, SYSRANGE_RANGE_IGNORE_VALID_HEIGHT, range); + if( status ){ + goto done; + } + + threshold = VL6180DevDataGet(dev, RangeIgnore.IgnoreThreshold); + status = VL6180_WrWord(dev, SYSRANGE_RANGE_IGNORE_THRESHOLD, threshold); + if( status ){ + goto done; + } + or_mask = RANGE_CHECK_RANGE_ENABLE_MASK; + } + else{ + or_mask = 0; + } + status = VL6180_UpdateByte(dev, SYSRANGE_RANGE_CHECK_ENABLES, ~RANGE_CHECK_RANGE_ENABLE_MASK, or_mask); + _DMax_InitData(dev); +done: + return status; +} + +int VL6180_RangeIgnoreSetEnable(VL6180Dev_t dev, int EnableState){ + int CurEnable; + int status=0; + LOG_FUNCTION_START("enable %d", EnableState); + + if( EnableState ) + EnableState = 1; + + CurEnable = VL6180DevDataGet(dev, RangeIgnore.Enabled); + if( EnableState != CurEnable ){ + VL6180DevDataSet(dev, RangeIgnore.Enabled, EnableState); + status = _RangeIgnore_UpdateDevice(dev); + } + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_RangeIgnoreConfigure(VL6180Dev_t dev, uint16_t ValidHeight_mm, uint16_t IgnoreThreshold){ + int status; + int enabled; + + LOG_FUNCTION_START("height= %d Threshold=%d", (int)ValidHeight_mm, (int)Threshold); + + enabled = VL6180DevDataGet(dev, RangeIgnore.Enabled); + VL6180DevDataSet(dev, RangeIgnore.ValidHeight, ValidHeight_mm); + VL6180DevDataSet(dev, RangeIgnore.IgnoreThreshold, IgnoreThreshold); + if( enabled ){ + status = _RangeIgnore_UpdateDevice(dev); + } + else{ + status = 0; + } + LOG_FUNCTION_END(status); + return status; +} + +/* + * Return >0 = time + * <0 1 if fail to get read data from device to compute time + */ +static int32_t _GetAveTotalTime(VL6180Dev_t dev) +{ + uint32_t cFwOverhead_us = 24; + uint32_t cVcpSetupTime_us = 70; + uint32_t cPLL2_StartupDelay_us = 200; + uint8_t cMeasMask = 0x07; + uint32_t Samples; + uint32_t SamplePeriod; + uint32_t SingleTime_us; + int32_t TotalAveTime_us; + uint8_t u8; + int status; + + LOG_FUNCTION_START(""); + + status = VL6180_RdByte(dev, 0x109, &u8); + if (status) { + return -1; + } + Samples = u8 & cMeasMask; + status = VL6180_RdByte(dev, READOUT_AVERAGING_SAMPLE_PERIOD, &u8); + if (status) { + return -1; + } + SamplePeriod = u8; + SingleTime_us = cFwOverhead_us + cVcpSetupTime_us + (SamplePeriod * 10); + TotalAveTime_us = (Samples + 1) * SingleTime_us + cPLL2_StartupDelay_us; + + LOG_FUNCTION_END(TotalAveTime_us); + return TotalAveTime_us; +} + +#if VL6180_HAVE_DMAX_RANGING +#define _GetDMaxDataRetSignalAt400mm(dev) VL6180DevDataGet(dev, DMaxData.retSignalAt400mm) +#else +#define _GetDMaxDataRetSignalAt400mm(dev) 375 /* Use a default high value */ +#endif + + +#if VL6180_WRAP_AROUND_FILTER_SUPPORT + +#define PRESERVE_DEVICE_ERROR_CODE /* If uncommented, device error code will be preserved on top of wraparound error code, but this may lead to some error code instability like overflow error <==> RangingFilteringOnGoing error oscillations */ +#define SENSITIVE_FILTERING_ON_GOING /* If uncommented, filter will go back to RangingFilteringOnGoing if it must go through the std dev testing */ + +#define FILTER_STDDEV_SAMPLES 6 +#define MIN_FILTER_STDDEV_SAMPLES 3 +#define MIN_FILTER_STDDEV_SAMPLES_AFTER_FLUSH_OR_BYPASS 5 +#define STDDEV_BASE_VALUE 150 + +#define FILTER_INVALID_DISTANCE 65535 + +#define _FilterData(field) VL6180DevDataGet(dev, FilterData.field) +/* + * One time init + */ +int _filter_Init(VL6180Dev_t dev) +{ + int i; + _FilterData(MeasurementIndex) = 0; + + _FilterData(Default_ZeroVal) = 0; + _FilterData(Default_VAVGVal) = 0; + _FilterData(NoDelay_ZeroVal) = 0; + _FilterData(NoDelay_VAVGVal) = 0; + _FilterData(Previous_VAVGDiff) = 0; + + _FilterData(StdFilteredReads) = 0; + _FilterData(FilteringOnGoingConsecutiveStates) = 0; + + for (i = 0; i < FILTER_NBOF_SAMPLES; i++) { + _FilterData(LastTrueRange)[i] = FILTER_INVALID_DISTANCE; + _FilterData(LastReturnRates)[i] = 0; + } + _FilterData(MeasurementsSinceLastFlush)=0; + return 0; +} + + +static uint32_t _filter_StdDevDamper(uint32_t AmbientRate, + uint32_t SignalRate, + const uint32_t StdDevLimitLowLight, + const uint32_t StdDevLimitLowLightSNR, + const uint32_t StdDevLimitHighLight, + const uint32_t StdDevLimitHighLightSNR) +{ + uint32_t newStdDev; + uint16_t SNR; + + if (AmbientRate > 0) + SNR = (uint16_t) ((100 * SignalRate) / AmbientRate); + else + SNR = 9999; + + if (SNR >= StdDevLimitLowLightSNR) { + newStdDev = StdDevLimitLowLight; + } else { + if (SNR <= StdDevLimitHighLightSNR) + newStdDev = StdDevLimitHighLight; + else { + newStdDev = (uint32_t)(StdDevLimitHighLight - + (SNR - StdDevLimitHighLightSNR) * + (StdDevLimitHighLight - StdDevLimitLowLight) / + (StdDevLimitLowLightSNR - StdDevLimitHighLightSNR)); + } + } + + return newStdDev; +} + + +/* + * Return <0 on error + */ +static int32_t _filter_Start(VL6180Dev_t dev, + uint16_t m_trueRange_mm, + uint16_t m_rawRange_mm, + uint32_t m_rtnSignalRate, + uint32_t m_rtnAmbientRate, + uint16_t errorCode) +{ + int status; + uint16_t m_newTrueRange_mm = 0; + #if VL6180_HAVE_MULTI_READ + uint8_t MultiReadBuf[8]; + #endif + uint16_t i; + uint16_t bypassFilter = 0; + uint16_t resetVAVGData = 1; + + uint16_t filterErrorCode = NoError; + uint16_t filterErrorCodeOnRangingErrorCode = NoError; + + uint16_t registerValue; + + uint32_t register32BitsValue1; + uint32_t register32BitsValue2; + + uint16_t ValidDistance = 0; + uint16_t SuspicuousRangingZone = 0; + + uint16_t WrapAroundFlag = 0; + uint16_t NoWrapAroundFlag = 0; + uint16_t NoWrapAroundHighConfidenceFlag = 0; + + uint16_t FlushFilter = 0; + uint32_t RateChange = 0; + + uint16_t StdDevSamplesMinNeeded = 0; + uint16_t StdDevSamples = 0; + uint32_t StdDevDistanceSum = 0; + uint32_t StdDevDistanceMean = 0; + uint32_t StdDevDistance = 0; + uint32_t StdDevRateSum = 0; + uint32_t StdDevRateMean = 0; + uint32_t StdDevRate = 0; + uint32_t StdDevLimitWithTargetMove = 0; + + uint32_t VAVGDiff; + uint32_t IdealVAVGDiff; + uint32_t MinVAVGDiff; + uint32_t MaxVAVGDiff; + + /* Filter Parameters */ + static const uint16_t ROMABLE_DATA WrapAroundLowRawRangeLimit = 60; + static const uint32_t ROMABLE_DATA WrapAroundLowReturnRateLimit_ROM = 800; + /* Shall be adapted depending on crossTalk */ + static const uint16_t ROMABLE_DATA WrapAroundLowRawRangeLimit2 = 165; + static const uint32_t ROMABLE_DATA WrapAroundLowReturnRateLimit2_ROM = 180; + /* Shall be adapted depending on crossTalk and device sensitivity*/ + static const uint32_t ROMABLE_DATA WrapAroundLowRawRangeLimit2SuspicuousAddedSignalRate = 150; + + + static const uint32_t ROMABLE_DATA WrapAroundLowReturnRateFilterLimit_ROM = 850; + /* Shall be adapted depending on crossTalk and device sensitivity*/ + static const uint16_t ROMABLE_DATA WrapAroundHighRawRangeFilterLimit = 350; + static const uint32_t ROMABLE_DATA WrapAroundHighReturnRateFilterLimit_ROM = 1400; + /* Shall be adapted depending on crossTalk and device sensitivity*/ + + static const uint32_t ROMABLE_DATA WrapAroundMaximumAmbientRateFilterLimit = 15000; + + /* Temporal filter data and flush values */ + static const uint32_t ROMABLE_DATA MinReturnRateFilterFlush = 75; + static const uint32_t ROMABLE_DATA MaxReturnRateChangeFilterFlush = 50; + + /* STDDEV values and damper values */ + static const uint32_t ROMABLE_DATA StdDevLimitLowLight = STDDEV_BASE_VALUE; + static const uint32_t ROMABLE_DATA StdDevLimitLowLightSNR = 30; /* 0.3 */ + static const uint32_t ROMABLE_DATA StdDevLimitHighLight = STDDEV_BASE_VALUE*6; + static const uint32_t ROMABLE_DATA StdDevLimitHighLightSNR = 5; /* 0.05 */ + + static const uint32_t ROMABLE_DATA StdDevHighConfidenceSNRLimit = 8; + static const uint32_t ROMABLE_DATA StdDevNoWrapDetectedMultiplier = 4; + + static const uint32_t ROMABLE_DATA StdDevMovingTargetStdDevLimit = 90000; + + static const uint32_t ROMABLE_DATA StdDevMovingTargetReturnRateLimit = 3500; + static const uint32_t ROMABLE_DATA StdDevMovingTargetStdDevForReturnRateLimit = STDDEV_BASE_VALUE*25; + + static const uint32_t ROMABLE_DATA MAX_VAVGDiff_ROM = 1800; + static const uint32_t ROMABLE_DATA SuspicuousMAX_VAVGDiffRatio = 2; + + /* WrapAroundDetection variables */ + static const uint16_t ROMABLE_DATA WrapAroundNoDelayCheckPeriod = 2; + static const uint16_t ROMABLE_DATA StdFilteredReadsIncrement = 2; + static const uint16_t ROMABLE_DATA StdFilteredReadsDecrement = 1; + static const uint16_t ROMABLE_DATA StdMaxFilteredReads = 4; + + uint32_t SignalRateDMax; + uint32_t WrapAroundLowReturnRateLimit; + uint32_t WrapAroundLowReturnRateLimit2; + uint32_t WrapAroundLowReturnRateFilterLimit; + uint32_t WrapAroundHighReturnRateFilterLimit; + + uint32_t MAX_VAVGDiff = 1800; + + uint8_t u8;//, u8_2; + uint32_t XTalkCompRate_KCps; + uint32_t StdDevLimit = 300; + uint32_t MaxOrInvalidDistance = 255*_GetUpscale(dev); + /* #define MaxOrInvalidDistance (uint16_t) (255 * 3) */ + + /* Check if distance is Valid or not */ + switch (errorCode) { + case Raw_Ranging_Algo_Underflow: + case Ranging_Algo_Underflow: + filterErrorCodeOnRangingErrorCode = RangingFiltered; /* If we have to go through filter, mean we have here a wraparound case */ + ValidDistance = 0; + break; + case Raw_Ranging_Algo_Overflow: + case Ranging_Algo_Overflow: + filterErrorCodeOnRangingErrorCode = RangingFiltered; /* If we have to go through filter, mean we have here a wraparound case */ + //m_trueRange_mm = MaxOrInvalidDistance; + m_trueRange_mm = 200*_GetUpscale(dev); + ValidDistance = 1; + break; + default: + if (m_rawRange_mm >= MaxOrInvalidDistance) { + ValidDistance = 0; + bypassFilter = 1; /* Bypass the filter in this case as produced distance is not usable (and also the VAVGVal and ZeroVal values) */ + } else { + ValidDistance = 1; + } + break; + } + m_newTrueRange_mm = m_trueRange_mm; + + XTalkCompRate_KCps = VL6180DevDataGet(dev, XTalkCompRate_KCps); + + /* Update signal rate limits depending on crosstalk */ + SignalRateDMax = (uint32_t)_GetDMaxDataRetSignalAt400mm(dev) ; + WrapAroundLowReturnRateLimit = WrapAroundLowReturnRateLimit_ROM + XTalkCompRate_KCps; + WrapAroundLowReturnRateLimit2 = ((WrapAroundLowReturnRateLimit2_ROM * + SignalRateDMax) / 312) + + XTalkCompRate_KCps; + WrapAroundLowReturnRateFilterLimit = ((WrapAroundLowReturnRateFilterLimit_ROM * + SignalRateDMax) / 312) + XTalkCompRate_KCps; + WrapAroundHighReturnRateFilterLimit = ((WrapAroundHighReturnRateFilterLimit_ROM * + SignalRateDMax) / 312) + XTalkCompRate_KCps; + + + /* Checks on low range data */ + if ((m_rawRange_mm < WrapAroundLowRawRangeLimit) && (m_rtnSignalRate < WrapAroundLowReturnRateLimit)) { + filterErrorCode = RangingFiltered; /* On this condition, wraparound case is ensured */ + bypassFilter = 1; + } + if ((m_rawRange_mm < WrapAroundLowRawRangeLimit2) && (m_rtnSignalRate < WrapAroundLowReturnRateLimit2)) { + filterErrorCode = RangingFiltered; /* On this condition, wraparound case is ensured */ + bypassFilter = 1; + } + if ((m_rawRange_mm < WrapAroundLowRawRangeLimit2) && (m_rtnSignalRate < (WrapAroundLowReturnRateLimit2 + WrapAroundLowRawRangeLimit2SuspicuousAddedSignalRate))) { + SuspicuousRangingZone = 1; /* On this area, we are in an highly suspicuous wraparound ares, filter parameter will be stengthen */ + } + + + /* Checks on Ambient rate level */ + if (m_rtnAmbientRate > WrapAroundMaximumAmbientRateFilterLimit) { + /* Too high ambient rate */ + FlushFilter = 1; + bypassFilter = 1; + } + + /* Checks on Filter flush */ + if (m_rtnSignalRate < MinReturnRateFilterFlush) { + /* Completely lost target, so flush the filter */ + FlushFilter = 1; + bypassFilter = 1; + } + if (_FilterData(LastReturnRates)[0] != 0) { + if (m_rtnSignalRate > _FilterData(LastReturnRates)[0]) + RateChange = (100 * + (m_rtnSignalRate - _FilterData(LastReturnRates)[0])) / + _FilterData(LastReturnRates)[0]; + else + RateChange = (100 * + (_FilterData(LastReturnRates)[0] - m_rtnSignalRate)) / + _FilterData(LastReturnRates)[0]; + } else + RateChange = 0; + if (RateChange > MaxReturnRateChangeFilterFlush) { + FlushFilter = 1; + } + /* TODO optimize filter using circular buffer */ + if (FlushFilter == 1) { + _FilterData(MeasurementIndex) = 0; + for (i = 0; i < FILTER_NBOF_SAMPLES; i++) { + _FilterData(LastTrueRange)[i] = FILTER_INVALID_DISTANCE; + _FilterData(LastReturnRates)[i] = 0; + } + _FilterData(MeasurementsSinceLastFlush)=0; + } else { + for (i = (uint16_t) (FILTER_NBOF_SAMPLES - 1); i > 0; i--) { + _FilterData(LastTrueRange)[i] = _FilterData(LastTrueRange)[i - 1]; + _FilterData(LastReturnRates)[i] = _FilterData(LastReturnRates)[i - 1]; + } + } + + if (ValidDistance == 1) + _FilterData(LastTrueRange)[0] = m_trueRange_mm; + else + _FilterData(LastTrueRange)[0] = FILTER_INVALID_DISTANCE; + _FilterData(LastReturnRates)[0] = m_rtnSignalRate; + _FilterData(MeasurementsSinceLastFlush)++; + + /* Check if we need to go through the filter or not */ + if (!(((m_rawRange_mm < WrapAroundHighRawRangeFilterLimit) && + (m_rtnSignalRate < WrapAroundLowReturnRateFilterLimit)) || + ((m_rawRange_mm >= WrapAroundHighRawRangeFilterLimit) && + (m_rtnSignalRate < WrapAroundHighReturnRateFilterLimit)))) + bypassFilter = 1; + else { + /* if some wraparound filtering due to some ranging error code has been detected, update the filter status and bypass the filter */ + if(filterErrorCodeOnRangingErrorCode!=NoError){ +#ifndef PRESERVE_DEVICE_ERROR_CODE + filterErrorCode = filterErrorCodeOnRangingErrorCode; +#else + if((errorCode==Raw_Ranging_Algo_Underflow) || (errorCode==Ranging_Algo_Underflow)) { + /* Preserves the error codes except for Raw_Ranging_Algo_Underflow and Ranging_Algo_Underflow */ + filterErrorCode = filterErrorCodeOnRangingErrorCode; + } +#endif + bypassFilter = 1; + resetVAVGData = 0; + } + } + + /* Check which kind of measurement has been made */ + status = VL6180_RdByte(dev, 0x01AC, &u8); + if (status) { + goto done_err; + } + registerValue = u8; + + /* Read data for filtering */ +#if VL6180_HAVE_MULTI_READ + status = VL6180_RdMulti(dev, 0x10C, MultiReadBuf, 8); /* read only 8 lsb bits */ + if (status) { + VL6180_ErrLog("0x10C multi rd fail"); + goto done_err; + } + register32BitsValue1 = ((uint32_t) MultiReadBuf[0] << 24) + + ((uint32_t) MultiReadBuf[1] << 16) + + ((uint32_t) MultiReadBuf[2] << 8) + + ((uint32_t) MultiReadBuf[3] << 0); + register32BitsValue2 = ((uint32_t) MultiReadBuf[4] << 24) + + ((uint32_t) MultiReadBuf[5] << 16) + + ((uint32_t) MultiReadBuf[6] << 8) + + ((uint32_t) MultiReadBuf[7] << 0); +#else + status = VL6180_RdDWord(dev, 0x10C, ®ister32BitsValue1); /* read 32 bits, lower 17 bits are the one useful */ + if (status) { + goto done_err; + } + status = VL6180_RdDWord(dev, 0x0110, & register32BitsValue2); /* read 32 bits, lower 17 bits are the one useful */ + if (status) { + goto done_err; + } +#endif + + + if ((FlushFilter == 1) || ((bypassFilter == 1) && (resetVAVGData == 1))) { + if (registerValue != 0x3E) { + status = VL6180_WrByte(dev, 0x1AC, 0x3E); + if (status) { + goto done_err; + } + //status = VL6180_WrByte(dev, 0x0F2, 0x01); + //if (status) { + // VL6180_ErrLog("0x0F2 bypass wr fail"); + // goto done_err; + //} + } + /* Set both Default and NoDelay To same value */ + _FilterData(Default_ZeroVal) = register32BitsValue1; + _FilterData(Default_VAVGVal) = register32BitsValue2; + _FilterData(NoDelay_ZeroVal) = register32BitsValue1; + _FilterData(NoDelay_VAVGVal) = register32BitsValue2; + + _FilterData(MeasurementIndex) = 0; + } else { + if (registerValue == 0x3E) { + _FilterData(Default_ZeroVal) = register32BitsValue1; + _FilterData(Default_VAVGVal) = register32BitsValue2; + } else { + _FilterData(NoDelay_ZeroVal) = register32BitsValue1; + _FilterData(NoDelay_VAVGVal) = register32BitsValue2; + } + + if (_FilterData(MeasurementIndex) % WrapAroundNoDelayCheckPeriod == 0) { + u8 = 0x3C; + //u8_2 = 0x05; + } else { + u8 = 0x3E; + //u8_2 = 0x01; + } + status = VL6180_WrByte(dev, 0x01AC, u8); + if (status) { + goto done_err; + } + //status = VL6180_WrByte(dev, 0x0F2, u8_2); + //if (status) { + // VL6180_ErrLog("0x0F2 wr fail"); + // goto done_err; + //} + _FilterData(MeasurementIndex)++; + } + + if (bypassFilter == 1) { + /* Do not go through the filter */ + + /* Update filter error code */ + _FilterData(filterError) = filterErrorCode; + + /* Update reported range */ + if(filterErrorCode==RangingFiltered) + m_newTrueRange_mm = MaxOrInvalidDistance; /* Set to invalid distance */ + + return m_newTrueRange_mm; + } + + /* Computes current VAVGDiff */ + if (_FilterData(Default_VAVGVal) > _FilterData(NoDelay_VAVGVal)) + VAVGDiff = _FilterData(Default_VAVGVal) - _FilterData(NoDelay_VAVGVal); + else + VAVGDiff = 0; + _FilterData(Previous_VAVGDiff) = VAVGDiff; + + if(SuspicuousRangingZone==0) + MAX_VAVGDiff = MAX_VAVGDiff_ROM; + else + /* In suspicuous area, strengthen the filter */ + MAX_VAVGDiff = MAX_VAVGDiff_ROM / SuspicuousMAX_VAVGDiffRatio; + + /* Check the VAVGDiff */ + if (_FilterData(Default_ZeroVal) > _FilterData(NoDelay_ZeroVal)) + IdealVAVGDiff = _FilterData(Default_ZeroVal) - _FilterData(NoDelay_ZeroVal); + else + IdealVAVGDiff = _FilterData(NoDelay_ZeroVal) - _FilterData(Default_ZeroVal); + if (IdealVAVGDiff > MAX_VAVGDiff) + MinVAVGDiff = IdealVAVGDiff - MAX_VAVGDiff; + else + MinVAVGDiff = 0; + MaxVAVGDiff = IdealVAVGDiff + MAX_VAVGDiff; + if (VAVGDiff < MinVAVGDiff || VAVGDiff > MaxVAVGDiff) { + WrapAroundFlag = 1; + filterErrorCode = RangingFiltered; + } else { + /* Go through filtering check */ + + if(_FilterData(MeasurementIndex)<=1) + /* On measurement after a bypass, uses an increase number of samples */ + StdDevSamplesMinNeeded = MIN_FILTER_STDDEV_SAMPLES_AFTER_FLUSH_OR_BYPASS; + else + StdDevSamplesMinNeeded = MIN_FILTER_STDDEV_SAMPLES; + + /* StdDevLimit Damper on SNR */ + StdDevLimit = _filter_StdDevDamper(m_rtnAmbientRate, m_rtnSignalRate, StdDevLimitLowLight, StdDevLimitLowLightSNR, StdDevLimitHighLight, StdDevLimitHighLightSNR); + + /* Standard deviations computations */ + StdDevSamples = 0; + StdDevDistanceSum = 0; + StdDevDistanceMean = 0; + StdDevDistance = 0; + StdDevRateSum = 0; + StdDevRateMean = 0; + StdDevRate = 0; + for (i = 0; (i < FILTER_NBOF_SAMPLES) && (StdDevSamples < FILTER_STDDEV_SAMPLES); i++) { + if (_FilterData(LastTrueRange)[i] != FILTER_INVALID_DISTANCE) { + StdDevSamples = (uint16_t) (StdDevSamples + 1); + StdDevDistanceSum = (uint32_t) (StdDevDistanceSum + _FilterData(LastTrueRange)[i]); + StdDevRateSum = (uint32_t) (StdDevRateSum + _FilterData(LastReturnRates)[i]); + } + } + if (StdDevSamples > 0) { + StdDevDistanceMean = (uint32_t) (StdDevDistanceSum / StdDevSamples); + StdDevRateMean = (uint32_t) (StdDevRateSum / StdDevSamples); + } + /* TODO optimize shorten Std dev in aisngle loop computation using sum of x2 - (sum of x)2 */ + StdDevSamples = 0; + StdDevDistanceSum = 0; + StdDevRateSum = 0; + for (i = 0; (i < FILTER_NBOF_SAMPLES) && (StdDevSamples < FILTER_STDDEV_SAMPLES); i++) { + if (_FilterData(LastTrueRange)[i] != FILTER_INVALID_DISTANCE) { + StdDevSamples = (uint16_t) (StdDevSamples + 1); + StdDevDistanceSum = (uint32_t) (StdDevDistanceSum + + (int)(_FilterData(LastTrueRange)[i] - + StdDevDistanceMean) * + (int) (_FilterData(LastTrueRange)[i] - + StdDevDistanceMean)); + StdDevRateSum = (uint32_t) (StdDevRateSum + + (int) (_FilterData(LastReturnRates)[i] - + StdDevRateMean) * + (int) (_FilterData(LastReturnRates)[i] - + StdDevRateMean)); + } + } + if (StdDevSamples >= StdDevSamplesMinNeeded) { + StdDevDistance = (uint16_t) (StdDevDistanceSum / StdDevSamples); + StdDevRate = (uint16_t) (StdDevRateSum / StdDevSamples); + } else { + StdDevDistance = 0; + StdDevRate = 0; + } + + /* Check Return rate standard deviation */ + if (StdDevRate < StdDevMovingTargetStdDevLimit) { + if (StdDevSamples < StdDevSamplesMinNeeded) { + //m_newTrueRange_mm = MaxOrInvalidDistance; + filterErrorCode = RangingFiltered; + } else { + /* Check distance standard deviation */ + if (StdDevRate < StdDevMovingTargetReturnRateLimit) + StdDevLimitWithTargetMove = StdDevLimit + + (((StdDevMovingTargetStdDevForReturnRateLimit - + StdDevLimit) * StdDevRate) / + StdDevMovingTargetReturnRateLimit); + else + StdDevLimitWithTargetMove = StdDevMovingTargetStdDevForReturnRateLimit; + + if(_FilterData(filterError)==NoError){ + /* No wrapAround detected yet, so relax constraints on the std dev */ + StdDevLimitWithTargetMove = StdDevLimitWithTargetMove * StdDevNoWrapDetectedMultiplier; + } + + if (((StdDevDistance * StdDevHighConfidenceSNRLimit) < StdDevLimit) && (StdDevSamples>=FILTER_STDDEV_SAMPLES)) { + NoWrapAroundHighConfidenceFlag = 1; + } else { + if (StdDevDistance < StdDevLimitWithTargetMove) { + NoWrapAroundFlag = 1; + } else { + WrapAroundFlag = 1; + filterErrorCode = RangingFiltered; + } + } + } + } else { + /* Target moving too fast */ + WrapAroundFlag = 1; + filterErrorCode = RangingFiltered; + } + } + + if (ValidDistance == 0) { + /* In case of invalid distance */ + if (_FilterData(StdFilteredReads) > 0) + _FilterData(StdFilteredReads) = (uint16_t) (_FilterData(StdFilteredReads) - 1); + } else { + if (WrapAroundFlag == 1) { + _FilterData(StdFilteredReads) = (uint16_t) (_FilterData(StdFilteredReads) + + StdFilteredReadsIncrement); + if (_FilterData(StdFilteredReads) > StdMaxFilteredReads) + _FilterData(StdFilteredReads) = StdMaxFilteredReads; + } else { + if (NoWrapAroundFlag == 1) { + if (_FilterData(StdFilteredReads) > 0) { + filterErrorCode = RangingFiltered; + if (_FilterData(StdFilteredReads) > StdFilteredReadsDecrement) + _FilterData(StdFilteredReads) = (uint16_t) (_FilterData(StdFilteredReads) - + StdFilteredReadsDecrement); + else + _FilterData(StdFilteredReads) = 0; + } + } else { + if (NoWrapAroundHighConfidenceFlag == 1) { + _FilterData(StdFilteredReads) = 0; + } + } + } + } + + /* If we detect a change from no Error to RangingFilteringOnGoing, then it means that + * the filter detected a change in te scene, so discard all previous measurements. + */ + if((_FilterData(filterError) == NoError) && (filterErrorCode!=NoError)) { + for (i = 1; i < FILTER_NBOF_SAMPLES; i++) { + _FilterData(LastTrueRange)[i] = FILTER_INVALID_DISTANCE; + _FilterData(LastReturnRates)[i] = 0; + } + } + + /* Update filter error code */ + _FilterData(filterError) = filterErrorCode; + + /* Update reported range */ + if(filterErrorCode==RangingFiltered) + m_newTrueRange_mm = MaxOrInvalidDistance; /* Set to invalid distance */ + + return m_newTrueRange_mm; +done_err: + return -1; + +#undef MaxOrInvalidDistance +} + + +static int _filter_GetResult(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData) +{ + uint32_t m_rawRange_mm = 0; + int32_t FilteredRange; + const uint8_t scaler = _GetUpscale(dev); + uint8_t u8; + int status; + + do { + status = VL6180_GetCachedByte(dev, RESULT_RANGE_RAW, &u8); + if (status) { + break; + } + m_rawRange_mm = u8; + + FilteredRange = _filter_Start(dev, pRangeData->range_mm, (m_rawRange_mm * scaler), pRangeData->rtnRate, pRangeData->rtnAmbRate, pRangeData->errorStatus); + if (FilteredRange < 0) { + status = -1; + break; + } + pRangeData->FilteredData.range_mm = FilteredRange; + pRangeData->FilteredData.rawRange_mm = m_rawRange_mm * scaler; + pRangeData->FilteredData.filterError= _FilterData(filterError); + } while (0); + return status; +} + +#undef _FilterData +#ifdef PRESERVE_DEVICE_ERROR_CODE +#undef PRESERVE_DEVICE_ERROR_CODE +#endif +#ifdef SENSITIVE_FILTERING_ON_GOING +#undef SENSITIVE_FILTERING_ON_GOING +#endif +#undef FILTER_STDDEV_SAMPLES +#undef MIN_FILTER_STDDEV_SAMPLES +#undef MIN_FILTER_STDDEV_SAMPLES_AFTER_FLUSH_OR_BYPASS +#undef STDDEV_BASE_VALUE +#undef FILTER_INVALID_DISTANCE + +#endif /* VL6180_WRAP_AROUND_FILTER_SUPPORT */ + +#ifdef VL6180_HAVE_RATE_DATA + +static int _GetRateResult(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData) +{ + uint32_t m_rtnConvTime = 0; + uint32_t m_rtnSignalRate = 0; + uint32_t m_rtnAmbientRate = 0; + uint32_t m_rtnSignalCount = 0; + uint32_t m_rtnAmbientCount = 0; + uint32_t m_refConvTime = 0; + uint32_t cRtnSignalCountMax = 0x7FFFFFFF; + uint32_t cDllPeriods = 6; + uint32_t calcConvTime = 0; + + int status; + + do { + status = VL6180_GetCachedDWord(dev, RESULT_RANGE_RETURN_SIGNAL_COUNT, &m_rtnSignalCount); + if (status) { + break; + } + if (m_rtnSignalCount > cRtnSignalCountMax) { + m_rtnSignalCount = 0; + } + + status = VL6180_GetCachedDWord(dev, RESULT_RANGE_RETURN_AMB_COUNT, &m_rtnAmbientCount); + if (status) { + break; + } + + + status = VL6180_GetCachedDWord(dev, RESULT_RANGE_RETURN_CONV_TIME, &m_rtnConvTime); + if (status) { + break; + } + + status = VL6180_GetCachedDWord(dev, RESULT_RANGE_REFERENCE_CONV_TIME, &m_refConvTime); + if (status) { + break; + } + + pRangeData->rtnConvTime = m_rtnConvTime; + pRangeData->refConvTime = m_refConvTime; + + calcConvTime = m_refConvTime; + if (m_rtnConvTime > m_refConvTime) { + calcConvTime = m_rtnConvTime; + } + if (calcConvTime == 0) + calcConvTime = 63000; + + m_rtnSignalRate = (m_rtnSignalCount * 1000) / calcConvTime; + m_rtnAmbientRate = (m_rtnAmbientCount * cDllPeriods * 1000) / calcConvTime; + + pRangeData->rtnRate = m_rtnSignalRate; + pRangeData->rtnAmbRate = m_rtnAmbientRate; + + + } while (0); + return status; +} +#endif /* VL6180_HAVE_RATE_DATA */ + + +int VL6180_DMaxSetState(VL6180Dev_t dev, int state) +{ + int status; + LOG_FUNCTION_START("%d", state); +#if VL6180_HAVE_DMAX_RANGING + VL6180DevDataSet(dev, DMaxEnable, state); + if (state) { + status = _DMax_InitData(dev); + } else { + status = 0; + } +#else + status = NOT_SUPPORTED; +#endif + LOG_FUNCTION_END(status); + return status; +} + +int VL6180_DMaxGetState(VL6180Dev_t dev) +{ + int status; + LOG_FUNCTION_START(""); +#if VL6180_HAVE_DMAX_RANGING + status = VL6180DevDataGet(dev, DMaxEnable); +#else + status = 0; +#endif + LOG_FUNCTION_END(status); + return status; +} + + +#if VL6180_HAVE_DMAX_RANGING + +#define _DMaxData(field) VL6180DevDataGet(dev, DMaxData.field) +/* + * Convert fix point x.7 to KCpount per sec + */ + +#ifndef VL6180_PLATFORM_PROVIDE_SQRT + +/* + * 32 bit integer square root with not so bad precision (integer result) and is quite fast + * see http://en.wikipedia.org/wiki/Methods_of_computing_square_roots + */ +uint32_t VL6180_SqrtUint32(uint32_t num) +{ + uint32_t res = 0; + uint32_t bit = 1 << 30; /* The second-to-top bit is set: 1 << 30 for 32 bits */ + + /* "bit" starts at the highest power of four <= the argument. */ + while (bit > num) + bit >>= 2; + + while (bit != 0) { + if (num >= res + bit) { + num -= res + bit; + res = (res >> 1) + bit; + } else + res >>= 1; + bit >>= 2; + } + return res; +} +#endif + + +/* DMax one time init */ +void _DMax_OneTimeInit(VL6180Dev_t dev) +{ + _DMaxData(ambTuningWindowFactor_K) = DEF_AMBIENT_TUNING; +} + + +static uint32_t _DMax_RawValueAtRateKCps(VL6180Dev_t dev, int32_t rate) +{ + uint32_t snrLimit_K; + int32_t DMaxSq; + uint32_t RawDMax; + DMaxFix_t retSignalAt400mm; + uint32_t ambTuningWindowFactor_K; + + + ambTuningWindowFactor_K = _DMaxData(ambTuningWindowFactor_K); + snrLimit_K = _DMaxData(snrLimit_K); + retSignalAt400mm = _DMaxData(retSignalAt400mm); + /* 12 to 18 bits Kcps */ + if (rate > 0) { + DMaxSq = 400 * 400 * 1000 / rate - (400 * 400 / 330); + /* K of (1/RtnAmb -1/330 )=> 30bit- (12-18)bit => 12-18 bits*/ + if (DMaxSq <= 0) { + RawDMax = 0; + } else { + /* value can be more 32 bit so base on raneg apply + * retSignalAt400mm before or after division to presevr accuracy */ + if (DMaxSq < (2 << 12)) { + DMaxSq = DMaxSq * retSignalAt400mm / + (snrLimit_K + ambTuningWindowFactor_K); + /* max 12 + 12 to 18 -10 => 12-26 bit */ + } else { + DMaxSq = DMaxSq / (snrLimit_K + ambTuningWindowFactor_K) * retSignalAt400mm; + /* 12 to 18 -10 + 12 to 18 *=> 12-26 bit */ + } + RawDMax = VL6180_SqrtUint32(DMaxSq); + } + } else { + RawDMax = 0x7FFFFFFF; /* bigest possibmle 32bit signed value */ + } + return RawDMax; +} + +/* + * fetch static data from register to avoid re-read + * precompute all intermediate constant and cliipings + * + * to be re-used/call on changes of : + * 0x2A + * SYSRANGE_MAX_AMBIENT_LEVEL_MULT + * Dev Data XtalkComRate_KCPs + * SYSRANGE_MAX_CONVERGENCE_TIME + * SYSRANGE_RANGE_CHECK_ENABLES mask RANGE_CHECK_RANGE_ENABLE_MASK + * range 0xb8-0xbb (0xbb) + */ +static int _DMax_InitData(VL6180Dev_t dev) +{ + int status, warning; + uint8_t u8; + uint16_t u16; + uint32_t u32; + uint32_t Reg2A_KCps; + uint32_t RegB8; + uint8_t MaxConvTime; + uint32_t XTalkCompRate_KCps; + uint32_t RangeIgnoreThreshold; + int32_t minSignalNeeded; + uint8_t SysRangeCheckEn; + uint8_t snrLimit; + static const int ROMABLE_DATA MaxConvTimeAdjust = -4; + + warning = 0; + + LOG_FUNCTION_START(""); + do { + status = VL6180_RdByte(dev, 0x02A, &u8); + if (status) { + break; + } + + if (u8 == 0) { + warning = CALIBRATION_WARNING; + u8 = 40; /* use a default average value */ + } + Reg2A_KCps = Fix7_2_KCPs(u8); /* convert to KCPs */ + + status = VL6180_RdByte(dev, SYSRANGE_RANGE_CHECK_ENABLES, &SysRangeCheckEn); + if (status) { + break; + } + + status = VL6180_RdByte(dev, SYSRANGE_MAX_CONVERGENCE_TIME, &MaxConvTime); + if (status) { + break; + } + + status = VL6180_RdDWord(dev, 0x0B8, &RegB8); + if (status) { + break; + } + + status = VL6180_RdByte(dev, SYSRANGE_MAX_AMBIENT_LEVEL_MULT, &snrLimit); + if (status) { + break; + } + _DMaxData(snrLimit_K) = (int32_t)16 * 1000 / snrLimit; + XTalkCompRate_KCps = VL6180DevDataGet(dev, XTalkCompRate_KCps); + + if (Reg2A_KCps >= XTalkCompRate_KCps) { + _DMaxData(retSignalAt400mm) = Reg2A_KCps; + } else{ + _DMaxData(retSignalAt400mm) = 0; + /* Reg2A_K - XTalkCompRate_KCp <0 is invalid */ + } + + /* if xtalk range check is off omit it in snr clipping */ + if (SysRangeCheckEn&RANGE_CHECK_RANGE_ENABLE_MASK) { + status = VL6180_RdWord(dev, SYSRANGE_RANGE_IGNORE_THRESHOLD, &u16); + if (status) { + break; + } + RangeIgnoreThreshold = Fix7_2_KCPs(u16); + } else{ + RangeIgnoreThreshold = 0; + } + + minSignalNeeded = (RegB8 * 256) / ((int32_t)MaxConvTime + (int32_t)MaxConvTimeAdjust); + /* KCps 8+8 bit -(1 to 6 bit) => 15-10 bit */ + /* minSignalNeeded = max ( minSignalNeeded, RangeIgnoreThreshold - XTalkCompRate_KCps) */ + if (minSignalNeeded <= (int32_t)RangeIgnoreThreshold - (int32_t)XTalkCompRate_KCps) + minSignalNeeded = RangeIgnoreThreshold - XTalkCompRate_KCps; + + u32 = (minSignalNeeded*(uint32_t)snrLimit) / 16; + _DMaxData(ClipSnrLimit) = _DMax_RawValueAtRateKCps(dev, u32); + /* clip to dmax to min signal snr limit rate*/ + } while (0); + if (!status) + status = warning; + LOG_FUNCTION_END(status); + return status; +} + +static int _DMax_Compute(VL6180Dev_t dev, VL6180_RangeData_t *pRange) +{ + uint32_t rtnAmbRate; + int32_t DMax; + int scaling; + uint16_t HwLimitAtScale; + static const uint32_t ROMABLE_DATA rtnAmbLowLimit_KCps = 330 * 1000; + + rtnAmbRate = pRange->rtnAmbRate; + if (rtnAmbRate < rtnAmbLowLimit_KCps) { + DMax = _DMax_RawValueAtRateKCps(dev, rtnAmbRate); + scaling = _GetUpscale(dev); + HwLimitAtScale = UpperLimitLookUP[scaling - 1]; + + if (DMax > _DMaxData(ClipSnrLimit)) { + DMax = _DMaxData(ClipSnrLimit); + } + if (DMax > HwLimitAtScale) { + DMax = HwLimitAtScale; + } + pRange->DMax = DMax; + } else { + pRange->DMax = 0; + } + return 0; +} + +#undef _DMaxData +#undef Fix7_2_KCPs + +#endif /* VL6180_HAVE_DMAX_RANGING */ + + + diff --git a/main_prog/Drivers/BSP/vl6180/vl6180_api.h b/main_prog/Drivers/BSP/vl6180/vl6180_api.h new file mode 100644 index 0000000..a796df6 --- /dev/null +++ b/main_prog/Drivers/BSP/vl6180/vl6180_api.h @@ -0,0 +1,866 @@ +/******************************************************************************* +Copyright © 2019, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + + +#ifndef VL6180_API_H_ +#define VL6180_API_H_ + +#include "vl6180_platform.h" + +#ifdef __cplusplus +extern "C" { +#endif + +/** @defgroup api_ll API Low Level Functions + * @brief API Low level functions + */ + +/** @defgroup api_hl API High Level Functions + * @brief API High level functions + */ + + +/* + * Check and set default platform dependent configuration + */ +#ifndef VL6180_SINGLE_DEVICE_DRIVER +#error "VL6180_SINGLE_DEVICE_DRIVER not defined" +/* TODO you may remove or comment these #error but it is best you update your vl6180_platform.h file to define it*/ +#endif + + +#ifndef VL6180_RANGE_STATUS_ERRSTRING +#warning "VL6180_RANGE_STATUS_ERRSTRING not defined ?" +/* TODO you may remove or comment these #warning and keep the default below to keep compatibility + or update your vl6180_platform.h file */ +/** + * force VL6180_RANGE_STATUS_ERRSTRING to not supported when not part of any cfg file + */ +#define VL6180_RANGE_STATUS_ERRSTRING 0 +#endif + +#ifndef VL6180_SAFE_POLLING_ENTER +#warning "VL6180_SAFE_POLLING_ENTER not defined, likely old vl6180_cfg.h file ?" +/* TODO you may remove or comment these #warning and keep the default below to keep compatibility + or update your vl6180_platform.h file */ +/** + * force VL6180_SAFE_POLLING_ENTER to off when not in cfg file + */ +#define VL6180_SAFE_POLLING_ENTER 0 /* off by default as in api 2.0 */ +#endif + +#ifndef VL6180_LOG_ENABLE +/** + * Force VL6180_LOG_ENABLE to none as default + */ +#define VL6180_LOG_ENABLE 0 +#endif + +#if VL6180_RANGE_STATUS_ERRSTRING +/**@def VL6180_HAVE_RANGE_STATUS_ERRSTRING + * @brief is defined when @a #VL6180_RANGE_STATUS_ERRSTRING is enable + */ +#define VL6180_HAVE_RANGE_STATUS_ERRSTRING +#endif + + +/** @brief Get API version as "hex integer" 0xMMnnss + */ +#define VL6180_ApiRevInt ((VL6180_API_REV_MAJOR<<24)+(VL6180_API_REV_MINOR<<16)+VL6180_API_REV_SUB) + +/** Get API version as string for exe "2.1.12" " + */ +#define VL6180_ApiRevStr VL6180_STR(VL6180_API_REV_MAJOR) "." VL6180_STR(VL6180_API_REV_MINOR) "." VL6180_STR(VL6180_API_REV_SUB) + +#ifndef VL6180_API +# define VL6180_API +#endif + +/** @defgroup api_init Init functions + * @brief API init functions + * @ingroup api_hl + * @{ + */ +/** + * @brief Wait for device booted after chip enable (hardware standby) + * @par Function Description + * After Chip enable Application you can also simply wait at least 1ms to ensure device is ready + * @warning After device chip enable (gpio0) de-asserted user must wait gpio1 to get asserted (hardware standby). + * or wait at least 400usec prior to do any low level access or api call . + * + * This function implements polling for standby but you must ensure 400usec from chip enable passed\n + * @warning Calling this function if device is not fresh out of reset will result in an indefinite loop\n + * + * @param dev The device + * @return 0 on success + */ +VL6180_API int VL6180_WaitDeviceBooted(VL6180Dev_t dev); + +/** + * + * @brief One time device initialization + * + * To be called once and only once after device is brought out of reset (Chip enable) and booted see @a VL6180_WaitDeviceBooted() + * + * @par Function Description + * When not used after a fresh device "power up" or reset, it may return @a #CALIBRATION_WARNING + * meaning wrong calibration data may have been fetched from device that can result in unpredictable and wrong ranging values\n + * + * @param dev The device + * @return 0 on success, @a #CALIBRATION_WARNING if failed + */ +VL6180_API int VL6180_InitData(VL6180Dev_t dev); + +/** + * @brief Configure GPIO1 function and set polarity. + * @par Function Description + * To be used prior to arm single shot measure or start continuous mode. + * + * The function uses @a VL6180_SetupGPIOx() for setting gpio 1. + * @warning changing polarity can generate a spurious interrupt on pins. + * It sets an interrupt flags condition that must be cleared to avoid polling hangs. \n + * It is safe to run VL6180_ClearAllInterrupt() just after. + * + * @param dev The device + * @param IntFunction The interrupt functionality to use one of :\n + * @a #GPIOx_SELECT_OFF \n + * @a #GPIOx_SELECT_GPIO_INTERRUPT_OUTPUT + * @param ActiveHigh The interrupt line polarity see ::IntrPol_e + * use @a #INTR_POL_LOW (falling edge) or @a #INTR_POL_HIGH (rising edge) + * @return 0 on success + */ +VL6180_API int VL6180_SetupGPIO1(VL6180Dev_t dev, uint8_t IntFunction, int ActiveHigh); + + /** + * @brief Prepare device for operation + * @par Function Description + * Does static initialization and reprogram common default settings \n + * Device is prepared for new measure, ready single shot ranging typical polling operation\n + * After prepare user can : \n + * @li Call other API function to set other settings\n + * @li Configure the interrupt pins, etc... \n + * @li Then start ranging operations in single shot or continuous mode + * + * @param dev The device + * @return 0 on success + */ +VL6180_API int VL6180_Prepare(VL6180Dev_t dev); + + /** @} */ + + +/** @defgroup api_hl_range Ranging functions + * @brief Ranging functions + * @ingroup api_hl + * @{ + */ + +/** + * @brief Start continuous ranging mode + * + * @details End user should ensure device is in idle state and not already running + */ +VL6180_API int VL6180_RangeStartContinuousMode(VL6180Dev_t dev); + +/** + * @brief Start single shot ranging measure + * + * @details End user should ensure device is in idle state and not already running + */ +VL6180_API int VL6180_RangeStartSingleShot(VL6180Dev_t dev); + +/** + * @brief Set maximum convergence time + * + * @par Function Description + * Setting a low convergence time can impact maximal detectable distance. + * Refer to VL6180 Datasheet Table 7 : Typical range convergence time. + * A typical value for up to x3 scaling is 50 ms + * + * @param dev + * @param MaxConTime_msec + * @return 0 on success. <0 on error. >0 for calibration warning status + */ +VL6180_API int VL6180_RangeSetMaxConvergenceTime(VL6180Dev_t dev, uint8_t MaxConTime_msec); + +/** + * @brief Single shot Range measurement in polling mode. + * + * @par Function Description + * Kick off a new single shot range then wait for ready to retrieve it by polling interrupt status \n + * Ranging must be prepared by a first call to @a VL6180_Prepare() and it is safer to clear very first poll call \n + * This function reference VL6180_PollDelay(dev) porting macro/call on each polling loop, + * but PollDelay(dev) may never be called if measure in ready on first poll loop \n + * Should not be use in continuous mode operation as it will stop it and cause stop/start misbehaviour \n + * \n This function clears Range Interrupt status , but not error one. For that uses @a VL6180_ClearErrorInterrupt() \n + * This range error is not related VL6180_RangeData_t::errorStatus that refer measure status \n + * + * @param dev The device + * @param pRangeData Will be populated with the result ranging data @a VL6180_RangeData_t + * @return 0 on success , @a #RANGE_ERROR if device reports an error case in it status (not cleared) use + * + * \sa ::VL6180_RangeData_t + */ +VL6180_API int VL6180_RangePollMeasurement(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData); + +/** + * @brief Check for measure readiness and get it if ready + * + * @par Function Description + * Using this function is an alternative to @a VL6180_RangePollMeasurement() to avoid polling operation. This is suitable for applications + * where host CPU is triggered on a interrupt (not from VL6180) to perform ranging operation. In this scenario, we assume that the very first ranging + * operation is triggered by a call to @a VL6180_RangeStartSingleShot(). Then, host CPU regularly calls @a VL6180_RangeGetMeasurementIfReady() to + * get a distance measure if ready. In case the distance is not ready, host may get it at the next call.\n + * + * @warning + * This function does not re-start a new measurement : this is up to the host CPU to do it.\n + * This function clears Range Interrupt for measure ready , but not error interrupts. For that, uses @a VL6180_ClearErrorInterrupt() \n + * + * @param dev The device + * @param pRangeData Will be populated with the result ranging data if available + * @return 0 on success and <0 in case of error. Please check pRangeData.errorStatus to check is new measurement is ready or not. + */ +VL6180_API int VL6180_RangeGetMeasurementIfReady(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData); + +/** + * @brief Retrieve range measurements set from device + * + * @par Function Description + * The measurement is made of range_mm status and error code @a VL6180_RangeData_t \n + * Based on configuration selected extra measures are included. + * + * @warning should not be used in continuous if wrap around filter is active \n + * Does not perform any wait nor check for result availability or validity. + *\sa VL6180_RangeGetResult for "range only" measurement + * + * @param dev The device + * @param pRangeData Pointer to the data structure to fill up + * @return 0 on success + */ +VL6180_API int VL6180_RangeGetMeasurement(VL6180Dev_t dev, VL6180_RangeData_t *pRangeData); + +/** + * @brief Get ranging result and only that + * + * @par Function Description + * Unlike @a VL6180_RangeGetMeasurement() this function only retrieves the range in millimeter \n + * It does any required up-scale translation\n + * It can be called after success status polling or in interrupt mode \n + * @warning these function is not doing wrap around filtering \n + * This function doesn't perform any data ready check! + * + * @param dev The device + * @param pRange_mm Pointer to range distance + * @return 0 on success + */ +VL6180_API int VL6180_RangeGetResult(VL6180Dev_t dev, int32_t *pRange_mm); + +/** + * @brief Configure ranging interrupt reported to application + * + * @param dev The device + * @param ConfigGpioInt Select ranging report\n select one (and only one) of:\n + * @a #CONFIG_GPIO_INTERRUPT_DISABLED \n + * @a #CONFIG_GPIO_INTERRUPT_LEVEL_LOW \n + * @a #CONFIG_GPIO_INTERRUPT_LEVEL_HIGH \n + * @a #CONFIG_GPIO_INTERRUPT_OUT_OF_WINDOW \n + * @a #CONFIG_GPIO_INTERRUPT_NEW_SAMPLE_READY + * @return 0 on success + */ +VL6180_API int VL6180_RangeConfigInterrupt(VL6180Dev_t dev, uint8_t ConfigGpioInt); + + +/** + * @brief Clear range interrupt + * + * @param dev The device + * @return 0 On success + */ +#define VL6180_RangeClearInterrupt(dev) VL6180_ClearInterrupt(dev, INTERRUPT_CLEAR_RANGING) + +/** + * @brief Return ranging error interrupt status + * + * @par Function Description + * Appropriate Interrupt report must have been selected first by @a VL6180_RangeConfigInterrupt() or @a VL6180_Prepare() \n + * + * Can be used in polling loop to wait for a given ranging event or in interrupt to read the trigger \n + * Events triggers are : \n + * @a #RES_INT_STAT_GPIO_LOW_LEVEL_THRESHOLD \n + * @a #RES_INT_STAT_GPIO_HIGH_LEVEL_THRESHOLD \n + * @a #RES_INT_STAT_GPIO_OUT_OF_WINDOW \n (RES_INT_STAT_GPIO_LOW_LEVEL_THRESHOLD|RES_INT_STAT_GPIO_HIGH_LEVEL_THRESHOLD) + * @a #RES_INT_STAT_GPIO_NEW_SAMPLE_READY \n + * + * @sa IntrStatus_t + * @param dev The device + * @param pIntStatus Pointer to status variable to update + * @return 0 on success + */ +VL6180_API int VL6180_RangeGetInterruptStatus(VL6180Dev_t dev, uint8_t *pIntStatus); + +#if VL6180_RANGE_STATUS_ERRSTRING + +extern const char *ROMABLE_DATA VL6180_RangeStatusErrString[]; +/** + * @brief Human readable error string for range error status + * + * @param RangeErrCode The error code as stored on @a VL6180_RangeData_t::errorStatus + * @return error string , NULL for invalid RangeErrCode + * @sa ::RangeError_u + */ +const char *VL6180_RangeGetStatusErrString(uint8_t RangeErrCode); +#else +#define VL6180_RangeGetStatusErrString(...) NULL +#endif + +/** @} */ + + +/** @defgroup api_ll_init Init functions + * @brief Init functions + * @ingroup api_ll + * @{ + */ + +/** + * @brief Low level ranging register static settings (you should call @a VL6180_Prepare() function instead) + * + * @param dev + * @return 0 on success + */ +VL6180_API int VL6180_StaticInit(VL6180Dev_t dev); + + /** @} */ + +/** @defgroup api_ll_range Ranging functions + * @brief Ranging Low Level functions + * @ingroup api_ll + * @{ + */ + +/** + * @brief Wait for device to be ready (before a new ranging command can be issued by application) + * @param dev The device + * @param MaxLoop Max Number of i2c polling loop see @a #msec_2_i2cloop + * @return 0 on success. <0 when fail \n + * @ref VL6180_ErrCode_t::TIME_OUT for time out \n + * @ref VL6180_ErrCode_t::INVALID_PARAMS if MaxLop<1 + */ +VL6180_API int VL6180_RangeWaitDeviceReady(VL6180Dev_t dev, int MaxLoop); + +/** + * @brief Program Inter measurement period (used only in continuous mode) + * + * @par Function Description + * When trying to set too long time, it returns #INVALID_PARAMS + * + * @param dev The device + * @param InterMeasTime_msec Requires inter-measurement time in msec + * @return 0 on success + */ +VL6180_API int VL6180_RangeSetInterMeasPeriod(VL6180Dev_t dev, uint32_t InterMeasTime_msec); + + +/** + * @brief Set device ranging scaling factor + * + * @par Function Description + * The ranging scaling factor is applied on the raw distance measured by the device to increase operating ranging at the price of the precision. + * Changing the scaling factor when device is not in f/w standby state (free running) is not safe. + * It can be source of spurious interrupt, wrongly scaled range etc ... + * @warning __This function doesns't update high/low threshold and other programmed settings linked to scaling factor__. + * To ensure proper operation, threshold and scaling changes should be done following this procedure: \n + * @li Set Group hold : @a VL6180_SetGroupParamHold() \n + * @li Get Threshold @a VL6180_RangeGetThresholds() \n + * @li Change scaling : @a VL6180_UpscaleSetScaling() \n + * @li Set Threshold : @a VL6180_RangeSetThresholds() \n + * @li Unset Group Hold : @a VL6180_SetGroupParamHold() + * + * @param dev The device + * @param scaling Scaling factor to apply (1,2 or 3) + * @return 0 on success when up-scale support is not configured it fail for any + * scaling than the one statically configured. + */ +VL6180_API int VL6180_UpscaleSetScaling(VL6180Dev_t dev, uint8_t scaling); + +/** + * @brief Get current ranging scaling factor + * + * @param dev The device + * @return The current scaling factor + */ +VL6180_API int VL6180_UpscaleGetScaling(VL6180Dev_t dev); + + +/** + * @brief Give filtered state (wrap-around filter) of a range measurement + * @param pRangeData Range measurement data + * @return 0 means measure was not filtered, when not 0 range from device got filtered by filter post processing + */ +#define VL6180_RangeIsFilteredMeasurement(pRangeData) ((pRangeData)->errorStatus == RangingFiltered) + +/** + * @brief Get the maximal distance for actual scaling + * @par Function Description + * Do not use prior to @a VL6180_Prepare() or at least @a VL6180_InitData() + * + * Any range value more than the value returned by this function is to be considered as "no target detected" + * or "no target in detectable range" + * @warning The maximal distance depends on the scaling + * + * @param dev The device + * @return The maximal range limit for actual mode and scaling + */ +uint16_t VL6180_GetUpperLimit(VL6180Dev_t dev); + +/** + * @brief Apply low and high ranging thresholds that are considered only in continuous mode + * + * @par Function Description + * This function programs low and high ranging thresholds that are considered in continuous mode : + * interrupt will be raised only when an object is detected at a distance inside this [low:high] range. + * The function takes care of applying current scaling factor if any.\n + * To be safe, in continuous operation, thresholds must be changed under "group parameter hold" cover. + * Group hold can be activated/deactivated directly in the function or externally (then set 0) + * using /a VL6180_SetGroupParamHold() function. + * + * @param dev The device + * @param low Low threshold in mm + * @param high High threshold in mm + * @param SafeHold Use of group parameters hold to surround threshold programming. + * @return 0 On success + */ +VL6180_API int VL6180_RangeSetThresholds(VL6180Dev_t dev, uint16_t low, uint16_t high, int SafeHold); + +/** + * @brief Get scaled high and low threshold from device + * + * @par Function Description + * Due to scaling factor, the returned value may be different from what has been programmed first (precision lost). + * For instance VL6180_RangeSetThresholds(dev,11,22) with scale 3 + * will read back 9 ((11/3)x3) and 21 ((22/3)x3). + + * @param dev The device + * @param low scaled low Threshold ptr can be NULL if not needed + * @param high scaled High Threshold ptr can be NULL if not needed + * @return 0 on success, return value is undefined if both low and high are NULL + * @warning return value is undefined if both low and high are NULL + */ +VL6180_API int VL6180_RangeGetThresholds(VL6180Dev_t dev, uint16_t *low, uint16_t *high); + +/** + * @brief Set ranging raw thresholds (scaling not considered so not recommended to use it) + * + * @param dev The device + * @param low raw low threshold set to raw register + * @param high raw high threshold set to raw register + * @return 0 on success + */ +VL6180_API int VL6180_RangeSetRawThresholds(VL6180Dev_t dev, uint8_t low, uint8_t high); + +/** + * @brief Set Early Convergence Estimate ratio + * @par Function Description + * For more information on ECE check datasheet + * @warning May return a calibration warning in some use cases + * + * @param dev The device + * @param FactorM ECE factor M in M/D + * @param FactorD ECE factor D in M/D + * @return 0 on success. <0 on error. >0 on warning + */ +VL6180_API int VL6180_RangeSetEceFactor(VL6180Dev_t dev, uint16_t FactorM, uint16_t FactorD); + +/** + * @brief Set Early Convergence Estimate state (See #SYSRANGE_RANGE_CHECK_ENABLES register) + * @param dev The device + * @param enable State to be set 0=disabled, otherwise enabled + * @return 0 on success + */ +VL6180_API int VL6180_RangeSetEceState(VL6180Dev_t dev, int enable); + +/** + * @brief Set activation state of the wrap around filter + * @param dev The device + * @param state New activation state (0=off, otherwise on) + * @return 0 on success + */ +VL6180_API int VL6180_FilterSetState(VL6180Dev_t dev, int state); + +/** + * Get activation state of the wrap around filter + * @param dev The device + * @return Filter enabled or not, when filter is not supported it always returns 0S + */ +VL6180_API int VL6180_FilterGetState(VL6180Dev_t dev); + + +/** + * @brief Set activation state of DMax computation + * @param dev The device + * @param state New activation state (0=off, otherwise on) + * @return 0 on success + */ +VL6180_API int VL6180_DMaxSetState(VL6180Dev_t dev, int state); + +/** + * Get activation state of DMax computation + * @param dev The device + * @return Filter enabled or not, when filter is not supported it always returns 0S + */ +VL6180_API int VL6180_DMaxGetState(VL6180Dev_t dev); + + +/** + * @brief Set ranging mode and start/stop measure (use high level functions instead : @a VL6180_RangeStartSingleShot() or @a VL6180_RangeStartContinuousMode()) + * + * @par Function Description + * When used outside scope of known polling single shot stopped state, \n + * user must ensure the device state is "idle" before to issue a new command. + * + * @param dev The device + * @param mode A combination of working mode (#MODE_SINGLESHOT or #MODE_CONTINUOUS) and start/stop condition (#MODE_START_STOP) \n + * @return 0 on success + */ +VL6180_API int VL6180_RangeSetSystemMode(VL6180Dev_t dev, uint8_t mode); + +/** + * @brief Enable/disable range ignore feature + * + * @par Function Description + * Enable range ignore feature to ensure that the device does not range on the cover glass because of cross-talk. + * @a VL6180_RangeIgnoreConfigure() should be run first to configure feature prior to enable it. + * + * @param dev The Device + * @param EnableState Feature state to set 0= off else =on + * @return 0 on success + */ +VL6180_API int VL6180_RangeIgnoreSetEnable(VL6180Dev_t dev, int EnableState); + +/** + * @brief Configure Range ignore feature + * + * @par Function Description + * When return signal rate is below the IgnoreThreshold and return distance is below the ValidHeight, the distance will be ignored + * @warning It is recommended to enable range ignore feature and configure it only when device is in stop or idle state + * @warning Once this function is called, next call to @a VL6180_InitData() function without reseting the device will result in wrong ranging operation + * @param dev The Device + * @param ValidHeight_mm Valid height in mm (unscaled ie not raw value before scaling) + * @param IgnoreThreshold Ignore threshold in fixpoint 9.7 MegaCount/sec + * @return + */ +VL6180_API int VL6180_RangeIgnoreConfigure(VL6180Dev_t dev, uint16_t ValidHeight_mm, uint16_t IgnoreThreshold); +/** @} */ + +/** @defgroup api_ll_range_calibration Ranging calibration functions + * @brief Ranging calibration functions + * @ingroup api_ll + * @{ + */ +/** + * @brief Get part to part calibration offset + * + * @par Function Description + * Should only be used after a successful call to @a VL6180_InitData to backup device nvm value + * + * @param dev The device + * @return part to part calibration offset from device + */ +VL6180_API int8_t VL6180_GetOffsetCalibrationData(VL6180Dev_t dev); + +/** + * Set or over-write part to part calibration offset and apply it immediately + * \sa VL6180_InitData(), VL6180_GetOffsetCalibrationData() + * @param dev The device + * @param offset Offset + * @return 0 on success + */ +VL6180_API int VL6180_SetOffsetCalibrationData(VL6180Dev_t dev, int8_t offset); + +/** + * @brief Set Cross talk compensation rate + * + * @par Function Description + * It programs register @a #SYSRANGE_CROSSTALK_COMPENSATION_RATE + * + * @param dev The device + * @param Rate Compensation rate (9.7 fix point) see datasheet for details + * @return 0 on success + */ +VL6180_API int VL6180_SetXTalkCompensationRate(VL6180Dev_t dev, FixPoint97_t Rate); + +/** @} */ + + + + +/** @defgroup api_ll_misc Misc functions + * @brief Misc functions + * @ingroup api_ll + * @{ + */ + +/** + * Set Group parameter Hold state + * + * @par Function Description + * Group parameter holds @a #SYSTEM_GROUPED_PARAMETER_HOLD enable safe update (non atomic across multiple measure) by host + * \n The critical register group is composed of: \n + * #SYSTEM_INTERRUPT_CONFIG_GPIO \n + * #SYSRANGE_THRESH_HIGH \n + * #SYSRANGE_THRESH_LOW + * + * + * @param dev The device + * @param Hold Group parameter Hold state to be set (on/off) + * @return 0 on success + */ +VL6180_API int VL6180_SetGroupParamHold(VL6180Dev_t dev, int Hold); + +/** + * @brief Set new device i2c address + * + * After completion the device will answer to the new address programmed. + * + * @sa AN4478: Using multiple VL6180's in a single design + * @param dev The device + * @param NewAddr The new i2c address (8 bits) + * @return 0 on success + */ +VL6180_API int VL6180_SetI2CAddress(VL6180Dev_t dev, uint8_t NewAddr); + +/** + * @brief Fully configure gpio 0/1 pin : polarity and functionality + * + * @param dev The device + * @param pin gpio pin 0 or 1 + * @param IntFunction Pin functionality : either #GPIOx_SELECT_OFF or #GPIOx_SELECT_GPIO_INTERRUPT_OUTPUT (refer to #SYSTEM_MODE_GPIO1 register definition) + * @param ActiveHigh Set active high polarity, or active low see @a ::IntrPol_e + * @return 0 on success + */ +VL6180_API int VL6180_SetupGPIOx(VL6180Dev_t dev, int pin, uint8_t IntFunction, int ActiveHigh); + + +/** + * @brief Set interrupt pin polarity for the given GPIO + * + * @param dev The device + * @param pin Pin 0 or 1 + * @param active_high select active high or low polarity using @ref IntrPol_e + * @return 0 on success + */ +VL6180_API int VL6180_SetGPIOxPolarity(VL6180Dev_t dev, int pin, int active_high); + +/** + * Select interrupt functionality for the given GPIO + * + * @par Function Description + * Functionality refer to @a SYSTEM_MODE_GPIO0 + * + * @param dev The device + * @param pin Pin to configure 0 or 1 (gpio0 or gpio1)Note that gpio0 is chip enable at power up ! + * @param functionality Pin functionality : either #GPIOx_SELECT_OFF or #GPIOx_SELECT_GPIO_INTERRUPT_OUTPUT (refer to #SYSTEM_MODE_GPIO1 register definition) + * @return 0 on success + */ +VL6180_API int VL6180_SetGPIOxFunctionality(VL6180Dev_t dev, int pin, uint8_t functionality); + +/** + * @brief Disable and turn to Hi-Z gpio output pin + * + * @param dev The device + * @param pin The pin number to disable 0 or 1 + * @return 0 on success + */ +VL6180_API int VL6180_DisableGPIOxOut(VL6180Dev_t dev, int pin); + +/** + * @def msec_2_i2cloop + * @brief Number of I2C polling loop (an 8 bit register) to run for maximal wait time. + * + * @par Function Description + * When polling via I2C the overall time is mainly the I2C transaction time because it is a slow bus + * one 8 bit register poll on I2C bus timing is shown below: \n + * start + addr_w(a) + 2x8bit index(a) + stop + start + addr_rd(a) + 1x8bit data_rd(a) + stop \n + * 1 8 1 2*(8+1) 1 1 8 1 8 1 1 \n + * so 49 serial bits + * + * @param time_ms Time to wait in milli second 10 + * @param i2c_khz I2C bus frequencies in KHz for instance 400 + * @return The number of loops (at least 1) + */ +#define msec_2_i2cloop(time_ms, i2c_khz) (((time_ms) * (i2c_khz) / 49) + 1) + +/** @} */ + + + +/** + * polarity use in @a VL6180_SetupGPIOx() , @a VL6180_SetupGPIO1() + */ +typedef enum { + INTR_POL_LOW = 0, /*!< set active low polarity best setup for falling edge */ + INTR_POL_HIGH = 1, /*!< set active high polarity best setup for rising edge */ +} IntrPol_e; + +/** @defgroup api_ll_intr Interrupts management functions + * @brief Interrupts management functions + * @ingroup api_ll + * @{ + */ + +/** + * @brief Get all interrupts cause + * + * @param dev The device + * @param status Ptr to interrupt status. You can use @a IntrStatus_t::val + * @return 0 on success + */ +VL6180_API int VL6180_GetInterruptStatus(VL6180Dev_t dev, uint8_t *status); + +/** + * @brief Clear given system interrupt condition + * + * @par Function Description + * Clear given interrupt cause by writing into register #SYSTEM_INTERRUPT_CLEAR register. + * @param dev The device + * @param IntClear Which interrupt source to clear. Use any combinations of #INTERRUPT_CLEAR_RANGING , #INTERRUPT_CLEAR_ERROR. + * @return 0 On success + */ +VL6180_API int VL6180_ClearInterrupt(VL6180Dev_t dev, uint8_t IntClear); + +/** + * @brief Clear error interrupt + * + * @param dev The device + * @return 0 On success + */ + #define VL6180_ClearErrorInterrupt(dev) VL6180_ClearInterrupt(dev, INTERRUPT_CLEAR_ERROR) + +/** + * @brief Clear All interrupt causes (range+error) + * + * @param dev The device + * @return 0 On success + */ +#define VL6180_ClearAllInterrupt(dev) VL6180_ClearInterrupt(dev, INTERRUPT_CLEAR_ERROR|INTERRUPT_CLEAR_RANGING) + +/** @} */ + + +/** @defgroup api_reg API Register access functions + * @brief Registers access functions called by API core functions + * @ingroup api_ll + * @{ + */ + +/** + * Write VL6180 single byte register + * @param dev The device + * @param index The register index + * @param data 8 bit register data + * @return success + */ +VL6180_API int VL6180_WrByte(VL6180Dev_t dev, uint16_t index, uint8_t data); +/** + * Thread safe VL6180 Update (rd/modify/write) single byte register + * + * Final_reg = (Initial_reg & and_data) |or_data + * + * @param dev The device + * @param index The register index + * @param AndData 8 bit and data + * @param OrData 8 bit or data + * @return 0 on success + */ +VL6180_API int VL6180_UpdateByte(VL6180Dev_t dev, uint16_t index, uint8_t AndData, uint8_t OrData); +/** + * Write VL6180 word register + * @param dev The device + * @param index The register index + * @param data 16 bit register data + * @return 0 on success + */ +VL6180_API int VL6180_WrWord(VL6180Dev_t dev, uint16_t index, uint16_t data); +/** + * Write VL6180 double word (4 byte) register + * @param dev The device + * @param index The register index + * @param data 32 bit register data + * @return 0 on success + */ +VL6180_API int VL6180_WrDWord(VL6180Dev_t dev, uint16_t index, uint32_t data); + +/** + * Read VL6180 single byte register + * @param dev The device + * @param index The register index + * @param data pointer to 8 bit data + * @return 0 on success + */ +VL6180_API int VL6180_RdByte(VL6180Dev_t dev, uint16_t index, uint8_t *data); + +/** + * Read VL6180 word (2byte) register + * @param dev The device + * @param index The register index + * @param data pointer to 16 bit data + * @return 0 on success + */ +VL6180_API int VL6180_RdWord(VL6180Dev_t dev, uint16_t index, uint16_t *data); + +/** + * Read VL6180 dword (4byte) register + * @param dev The device + * @param index The register index + * @param data pointer to 32 bit data + * @return 0 on success + */ +VL6180_API int VL6180_RdDWord(VL6180Dev_t dev, uint16_t index, uint32_t *data); + + +/** + * Read VL6180 multiple bytes + * @note required only if #VL6180_HAVE_MULTI_READ is set + * @param dev The device + * @param index The register index + * @param data pointer to 8 bit data + * @param nData number of data bytes to read + * @return 0 on success + */ +VL6180_API int VL6180_RdMulti(VL6180Dev_t dev, uint16_t index, uint8_t *data, int nData); + +/** @} */ + + + + +#ifdef __cplusplus +} +#endif + +#endif /* VL6180_API_H_ */ diff --git a/main_prog/Drivers/BSP/vl6180/vl6180_cfg.h b/main_prog/Drivers/BSP/vl6180/vl6180_cfg.h new file mode 100644 index 0000000..bef53a3 --- /dev/null +++ b/main_prog/Drivers/BSP/vl6180/vl6180_cfg.h @@ -0,0 +1,104 @@ +/******************************************************************************* +Copyright � 2019, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + +/** + * @file VL6180_cfg.h + * + * Proximity configuration + */ + +#ifndef VL6180_CFG_H_ +#define VL6180_CFG_H_ + +/** @defgroup api_config Configuration + * @brief API static configuration + */ + + + +/** @ingroup api_config + * @{*/ + + +/** + * @def VL6180_UPSCALE_SUPPORT + * @brief Configure up-scale capabilities and default up-scale factor for ranging operations + * + * @li 1 : Fixed scaling by 1 (no up-scaling support) + * @li 2 : Fixed scaling by 2 + * @li 3 : Fixed scaling by 3 + * @li -1 -2 -3 : Run time programmable through @a VL6180_UpscaleSetScaling(). Default scaling factore is -VL6180_UPSCALE_SUPPORT \n + */ +#define VL6180_UPSCALE_SUPPORT -3 + + +/** + * @def VL6180_HAVE_DMAX_RANGING + * @brief Enable DMax calculation for ranging applications. + * + * When set to 1, __Dmax__ is returned by API typically when @a VL6180_RangePollMeasurement() high level + * function is called (this is returned in @a VL6180_RangeData_t structure). + * __Dmax__ is an estimation of the maximum distance (in mm) the product can report a valid distance of a 17% target for + * the current ambient light conditions (__Dmax__ decreases when ambient light increases). __Dmax__ should be used only + * when the product is not able to return a valid distance (no object or object is too far from the ranging sensor). + * Typically, this is done by checking the __errorStatus__ field of the @a VL6180_RangeData_t structure returned by + * the @a VL6180_RangePollMeasurement() function. + * You may refer to ::RangeError_u to get full list of supported error codes. + * @warning Dmax is estimated for a 17% grey target. If the real target has a reflectance lower than 17%, report Dmax could be over-estimated + */ +#define VL6180_HAVE_DMAX_RANGING 1 + +/** + * @def VL6180_WRAP_AROUND_FILTER_SUPPORT + * @brief Enable wrap around filter (WAF) feature + * + * In specific conditions, when targeting a mirror or a very reflective metal, a __wrap around__ effect can occur internally to the + * ranging product which results in returning a wrong distance (under-estimated). Goal of the WAF is to detect this wrap arround effect + * and to filter it by returning a non-valid distance : __errorStatus__ set to 16 (see ::RangeError_u) + * @warning Wrap-around filter can not be used when device is running in continuous mode + * + * @li 0 : Filter is not supported, no filtering code is included in API + * @li 1 : Filter is supported and active by default + * @li -1 : Filter is supported but is not active by default @a VL6180_FilterSetState() can turn it on and off at any time + */ +#define VL6180_WRAP_AROUND_FILTER_SUPPORT 1 + +/** + * @def VL6180_EXTENDED_RANGE + * @brief Enable extended ranging support + * + * Device that do not formally support extended ranging should only be used with a scaling factor of 1. + * Correct operation with scaling factor other than 1 (>200mm ) is not granted by ST. + */ +#define VL6180_EXTENDED_RANGE 0 + + +#endif +/** @} */ // end of api_config + +/* VL6180_CFG_H_ */ diff --git a/main_prog/Drivers/BSP/vl6180/vl6180_def.h b/main_prog/Drivers/BSP/vl6180/vl6180_def.h new file mode 100644 index 0000000..0d71800 --- /dev/null +++ b/main_prog/Drivers/BSP/vl6180/vl6180_def.h @@ -0,0 +1,677 @@ +/******************************************************************************* +Copyright © 2019, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + +/** + * @file VL6180_def.h + * + * @brief Type definitions for vl6180 api. + * + */ + + +#ifndef _VL6180_DEF +#define _VL6180_DEF + +/** API major version */ +#define VL6180_API_REV_MAJOR 1 +/** API minor version */ +#define VL6180_API_REV_MINOR 3 +/** API sub version */ +#define VL6180_API_REV_SUB 0 + +#define VL6180_STR_HELPER(x) #x +#define VL6180_STR(x) VL6180_STR_HELPER(x) + +#include "vl6180_cfg.h" +#include "vl6180_types.h" + +/* + * check configuration macro raise error or warning and suggest a default value + */ + +#ifndef VL6180_UPSCALE_SUPPORT +#error "VL6180_UPSCALE_SUPPORT not defined" +/* TODO you must define value for upscale support in your vl6180_cfg.h */ +#endif + +#ifndef VL6180_HAVE_DMAX_RANGING +#error "VL6180_HAVE_DMAX_RANGING not defined" +/* TODO you may remove or comment these #error and keep the default below or update your vl6180_cfg.h .h file */ +/** + * force VL6180_HAVE_DMAX_RANGING to not supported when not part of cfg file + */ +#define VL6180_HAVE_DMAX_RANGING 0 +#endif + +#ifndef VL6180_EXTENDED_RANGE +#define VL6180_EXTENDED_RANGE 1 +#endif + +#ifndef VL6180_WRAP_AROUND_FILTER_SUPPORT +#error "VL6180_WRAP_AROUND_FILTER_SUPPORT not defined ?" +/* TODO you may remove or comment these #error and keep the default below or update vl6180_cfg.h file */ +/** + * force VL6180_WRAP_AROUND_FILTER_SUPPORT to not supported when not part of cfg file + */ +#define VL6180_WRAP_AROUND_FILTER_SUPPORT 0 +#endif + + + +#ifndef VL6180_HAVE_MULTI_READ +# define VL6180_HAVE_MULTI_READ 0 +#endif + +/** + * Force VL6180_CACHED_REG to default 0 when not defined + */ +#ifndef VL6180_CACHED_REG +# define VL6180_CACHED_REG 0 +#else +# define VL6180_FIRST_CACHED_INDEX 0x04D +# define VL6180_LAST_CACHED_INDEX (VL6180_FIRST_CACHED_INDEX+55) +# define VL6180_CACHED_REG_CNT (VL6180_LAST_CACHED_INDEX-VL6180_FIRST_CACHED_INDEX+1) +#endif + +/**************************************** + * PRIVATE define do not edit + ****************************************/ + +/** Maximal buffer size ever use in i2c */ +#define VL6180_MAX_I2C_XFER_SIZE 8 /* At present time it 6 byte max but that can change */ + +#if VL6180_UPSCALE_SUPPORT < 0 +/** + * @def VL6180_HAVE_UPSCALE_DATA + * @brief is defined if device data structure has data so when user configurable up-scale is active + */ +#define VL6180_HAVE_UPSCALE_DATA /* have data only for user configurable up-scale config */ +#endif + +#if VL6180_WRAP_AROUND_FILTER_SUPPORT +/** + * @def VL6180_HAVE_WRAP_AROUND_DATA + * @brief is defined if device data structure has filter data so when active in cfg file + */ +#define VL6180_HAVE_WRAP_AROUND_DATA +#endif + + +#if VL6180_WRAP_AROUND_FILTER_SUPPORT || VL6180_HAVE_DMAX_RANGING + #define VL6180_HAVE_RATE_DATA +#endif + +/** Error and warning code returned by API + * + * negative value are true error mostly fatal\n + * positive value are warning most of time it's ok to continue\n + */ +enum VL6180_ErrCode_t { + API_NO_ERROR = 0, + CALIBRATION_WARNING = 1, /*!< warning invalid calibration data may be in used \a VL6180_InitData() \a VL6180_GetOffsetCalibrationData \a VL6180_SetOffsetCalibrationData*/ + MIN_CLIPED = 2, /*!< warning parameter passed was clipped to min before to be applied */ + NOT_GUARANTEED = 3, /*!< Correct operation is not guaranteed typically using extended ranging on vl6180 */ + + API_ERROR = -1, /*!< Unqualified error */ + INVALID_PARAMS = -2, /*!< parameter passed is invalid or out of range */ + NOT_SUPPORTED = -3, /*!< function is not supported in current mode or configuration */ + RANGE_ERROR = -4, /*!< device report a ranging error interrupt status */ + TIME_OUT = -5, /*!< aborted due to time out */ +}; + +/** + * Filtered result data structure range data is to be used + */ +typedef struct RangeFilterResult_tag { + uint16_t range_mm; /*!< Filtered ranging value */ + uint16_t rawRange_mm; /*!< raw range value (scaled) */ + uint32_t filterError; /*!< current filter error code */ +} RangeFilterResult_t; + +/** + * "small" unsigned data type used in filter + * + * if data space saving is not a concern it can be change to platform native unsigned int + */ +typedef uint32_t FilterType1_t; + +/** + * @def FILTER_NBOF_SAMPLES + * @brief sample history len used for wrap around filtering + */ +#define FILTER_NBOF_SAMPLES 10 +/** + * Wrap around filter internal data + */ +struct FilterData_t { + uint32_t MeasurementIndex; /*!< current measurement index */ + uint32_t MeasurementsSinceLastFlush; /*!< Number of measurements done since last time buffer has been flushed */ + uint16_t LastTrueRange[FILTER_NBOF_SAMPLES]; /*!< filtered/corrected distance history */ + uint32_t LastReturnRates[FILTER_NBOF_SAMPLES]; /*!< Return rate history */ + uint16_t StdFilteredReads; /*!< internal use */ + FilterType1_t Default_ZeroVal; /*!< internal use */ + FilterType1_t Default_VAVGVal; /*!< internal use */ + FilterType1_t NoDelay_ZeroVal; /*!< internal use */ + FilterType1_t NoDelay_VAVGVal; /*!< internal use */ + FilterType1_t Previous_VAVGDiff; /*!< internal use */ + uint32_t FilteringOnGoingConsecutiveStates; /*!< internal use */ + uint32_t filterError; /*!< current filter error code */ +}; + +#if VL6180_HAVE_DMAX_RANGING +typedef int32_t DMaxFix_t; +struct DMaxData_t { + uint32_t ambTuningWindowFactor_K; /*!< internal algo tuning (*1000) */ + + DMaxFix_t retSignalAt400mm; /*!< intermediate dmax computation value caching @a #SYSRANGE_CROSSTALK_COMPENSATION_RATE and private reg 0x02A */ + /* int32_t RegB8; */ /*!< register 0xB8 cached to speed reduce i2c traffic for dmax computation */ + /* place all word data below to optimize struct packing */ + /* int32_t minSignalNeeded; */ /*!< optimized computation intermediate base on register cached value */ + int32_t snrLimit_K; /*!< cached and optimized computation intermediate from @a #SYSRANGE_MAX_AMBIENT_LEVEL_MULT */ + uint16_t ClipSnrLimit; /*!< Max value for snr limit */ + /* place all byte data below to optimize packing */ + /* uint8_t MaxConvTime; */ /*!< cached max convergence time @a #SYSRANGE_MAX_CONVERGENCE_TIME*/ +}; +#endif + +struct RangeIgnoreData_t { + uint16_t ValidHeight; + uint16_t IgnoreThreshold; + uint8_t Enabled; +}; +/** + * @struct VL6180DevData_t + * + * @brief Per VL6180 device St private data structure \n + * End user should never access any of these field directly + * + * These must never access directly but only via VL6180Dev/SetData(dev, field) macro + */ +struct VL6180DevData_t { + + uint32_t Part2PartAmbNVM; /*!< backed up NVM value */ + uint32_t XTalkCompRate_KCps; /*! Cached XTlak Compensation Rate */ + + uint16_t EceFactorM; /*!< Ece Factor M numerator */ + uint16_t EceFactorD; /*!< Ece Factor D denominator*/ + + struct RangeIgnoreData_t RangeIgnore; + +#ifdef VL6180_HAVE_UPSCALE_DATA + uint8_t UpscaleFactor; /*!< up-scaling factor*/ +#endif + +#ifdef VL6180_HAVE_WRAP_AROUND_DATA + uint8_t WrapAroundFilterActive; /*!< Filter on/off */ + struct FilterData_t FilterData; /*!< Filter internal data state history ... */ +#endif + +#if VL6180_CACHED_REG + uint8_t CacheFilled; /*!< Set if valid data got fetched use to control when to fill up register cache */ + uint8_t CachedRegs[VL6180_CACHED_REG_CNT]; /*!< Cache register storage */ +#endif +#if VL6180_HAVE_DMAX_RANGING + struct DMaxData_t DMaxData; + uint8_t DMaxEnable; +#endif + int8_t Part2PartOffsetNVM; /*!< backed up NVM value */ +}; + + +/** + * @struct VL6180_RangeData_t + * @brief Range and any optional measurement data. + */ +typedef struct { + int32_t range_mm; /*!< range distance in mm. */ + int32_t signalRate_mcps; /*!< signal rate (MCPS)\n these is a 9.7 fix point value, which is effectively a measure of target reflectance.*/ + uint32_t errorStatus; /*!< Error status of the current measurement. \n see @a ::RangeError_u @a VL6180_GetRangeStatusErrString() */ + + +#ifdef VL6180_HAVE_RATE_DATA + uint32_t rtnAmbRate; /*!< Return Ambient rate in KCount per sec related to \a RESULT_RANGE_RETURN_AMB_COUNT */ + uint32_t rtnRate; /*!< Return rate in KCount per sec related to \a RESULT_RANGE_RETURN_SIGNAL_COUNT */ + uint32_t rtnConvTime; /*!< Return Convergence time \a RESULT_RANGE_RETURN_CONV_TIME */ + uint32_t refConvTime; /*!< Reference convergence time \a RESULT_RANGE_REFERENCE_CONV_TIME */ +#endif + + +#if VL6180_HAVE_DMAX_RANGING + uint32_t DMax; /*!< DMax when applicable */ +#endif + +#ifdef VL6180_HAVE_WRAP_AROUND_DATA + RangeFilterResult_t FilteredData; /*!< Filter result main range_mm is updated */ +#endif +} VL6180_RangeData_t; + + +/** use where fix point 9.7 bit values are expected + * + * given a floating point value f it's .7 bit point is (int)(f*(1<<7))*/ +typedef uint16_t FixPoint97_t; + +/** lux data type */ +typedef uint32_t lux_t; + + +/** + * @brief Range status Error code + * + * @a VL6180_GetRangeStatusErrString() if configured ( @a #VL6180_RANGE_STATUS_ERRSTRING ) + * related to register @a #RESULT_RANGE_STATUS and additional post processing + */ +typedef enum { + NoError = 0, /*!< 0 0b0000 NoError */ + VCSEL_Continuity_Test, /*!< 1 0b0001 VCSEL_Continuity_Test */ + VCSEL_Watchdog_Test, /*!< 2 0b0010 VCSEL_Watchdog_Test */ + VCSEL_Watchdog, /*!< 3 0b0011 VCSEL_Watchdog */ + PLL1_Lock, /*!< 4 0b0100 PLL1_Lock */ + PLL2_Lock, /*!< 5 0b0101 PLL2_Lock */ + Early_Convergence_Estimate,/*!< 6 0b0110 Early_Convergence_Estimate */ + Max_Convergence, /*!< 7 0b0111 Max_Convergence */ + No_Target_Ignore, /*!< 8 0b1000 No_Target_Ignore */ + Not_used_9, /*!< 9 0b1001 Not_used */ + Not_used_10, /*!< 10 0b1010 Not_used_ */ + Max_Signal_To_Noise_Ratio, /*!< 11 0b1011 Max_Signal_To_Noise_Ratio*/ + Raw_Ranging_Algo_Underflow,/*!< 12 0b1100 Raw_Ranging_Algo_Underflow*/ + Raw_Ranging_Algo_Overflow, /*!< 13 0b1101 Raw_Ranging_Algo_Overflow */ + Ranging_Algo_Underflow, /*!< 14 0b1110 Ranging_Algo_Underflow */ + Ranging_Algo_Overflow, /*!< 15 0b1111 Ranging_Algo_Overflow */ + + /* code below are addition for API/software side they are not hardware*/ + RangingFiltered = 0x10, /*!< 16 0b10000 filtered by post processing*/ + DataNotReady = 0x12, /*!< 18 0b10011 New data sample not ready */ + +} RangeError_u; + + +/** @defgroup device_regdef Device registers & masks definitions + * @brief Device registers and masks definitions + */ + + +/** @ingroup device_regdef + * @{*/ + +/** + * The device model ID + */ +#define IDENTIFICATION_MODEL_ID 0x000 +/** + * Revision identifier of the Device for major change. + */ +#define IDENTIFICATION_MODULE_REV_MAJOR 0x003 +/** + * Revision identifier of the Device for minor change. + */ +#define IDENTIFICATION_MODULE_REV_MINOR 0x004 + + +/** + * @def SYSTEM_MODE_GPIO0 + * @brief Configures polarity and select which function gpio 0 serves. + * Gpio0 is chip enable at power up ! Be aware of all h/w implication of turning it to output. + * Same definition as #SYSTEM_MODE_GPIO1 + * @ingroup device_regdef + */ +#define SYSTEM_MODE_GPIO0 0x010 +/** + * @def SYSTEM_MODE_GPIO1 + * @brief Configures polarity and select what ranging functionality gpio pin serves. + * + * Function can be #GPIOx_SELECT_OFF #GPIOx_SELECT_GPIO_INTERRUPT_OUTPUT.\n + * Same definition apply to register GPIO0 that is used as chip enable at power up. + * @ingroup device_regdef + */ +#define SYSTEM_MODE_GPIO1 0x011 + /** gpio pad POLARITY mask in #SYSTEM_MODE_GPIO1 (and/or 0) write 1 to set active high polarity (positive edge) */ + #define GPIOx_POLARITY_SELECT_MASK 0x20 + /** gpio pad Function select shift in #SYSTEM_MODE_GPIO1 or 0 */ + #define GPIOx_FUNCTIONALITY_SELECT_SHIFT 1 + /** gpio pad Function select mask in #SYSTEM_MODE_GPIO1 or 0 */ + #define GPIOx_FUNCTIONALITY_SELECT_MASK (0xF< AutoThreshHigh * max_raneg => scale ++ */ +#define AutoThreshLow 33 /*auto scale low thresh => AutoThreshHigh * max_raneg => scale ++ */ +#define ErrRangeDispTime 0 /* Set to 800 ms to display error code when no target os detected */ +#if ErrRangeDispTime == 0 +/* supress Warning[Pe186]: pointless comparison of unsigned integer with zero */ +# ifdef __ARMCC_VERSION /* ARM/KEIL */ +# pragma diag_suppress 186 +# endif /* _ARMCC_VERSION */ +# ifdef __ICCARM__ /* IAR */ +# pragma diag_suppress=Pe186 +# endif /* _ARMCC_VERSION */ +#endif + +#define AlrmDispTime 800 + +#define AlarmKeepDispTime 250 /* alarm message retain time after it fires */ +volatile int IntrFired=0; + +extern volatile uint32_t SensorsEnabled; + + + +void AbortErr( const char * msg ){ + State.mode= WaitForReset; +} + +void DoScalingSwap(int scaling){ + + State.mode = ScaleSwap; + TimeStarted=g_TickCnt; +} +uint8_t allowIT = 0; +void vl6180_init (void) +{ + allowIT = 0; + HAL_GPIO_WritePin(CS_PROXIMITY_GPIO_Port, CS_PROXIMITY_Pin, GPIO_PIN_RESET); + HAL_Delay(200); + HAL_GPIO_WritePin(CS_PROXIMITY_GPIO_Port, CS_PROXIMITY_Pin, GPIO_PIN_SET); + HAL_Delay(200); + VL6180_WaitDeviceBooted(theVL6180Dev); + VL6180_InitData(theVL6180Dev); + allowIT = 1; + HAL_GPIO_WritePin(CS_PROXIMITY_GPIO_Port, CS_PROXIMITY_Pin, GPIO_PIN_RESET); + HAL_Delay(200); + HAL_GPIO_WritePin(CS_PROXIMITY_GPIO_Port, CS_PROXIMITY_Pin, GPIO_PIN_SET); + HAL_Delay(200); + VL6180_WaitDeviceBooted(theVL6180Dev); + VL6180_InitData(theVL6180Dev); + State.InitScale=VL6180_UpscaleGetScaling(theVL6180Dev); + State.FilterEn=VL6180_FilterGetState(theVL6180Dev); + VL6180_Prepare(theVL6180Dev); + VL6180_RangeSetMaxConvergenceTime(theVL6180Dev, 20); + VL6180_RangeSetInterMeasPeriod(theVL6180Dev, 25); + //State.InitScale=VL6180_UpscaleGetScaling(theVL6180Dev); + /* Enable Dmax calculation only if value is displayed (to save computation power) */ + //VL6180_DMaxSetState(theVL6180Dev, DMaxDispTime>0); + VL6180_ClearAllInterrupt(theVL6180Dev); + VL6180_RangeStartContinuousMode(theVL6180Dev); +} + + +int VL6180_I2CRead(VL6180Dev_t addr, uint8_t *buff, uint8_t len){ + int status; + status = HAL_I2C_Master_Receive(&hi2c2, addr, buff, len , def_i2c_time_out); + if( status ){ + MX_I2C2_Init(); + } + + return status; +} + +int VL6180_I2CWrite(VL6180Dev_t addr, uint8_t *buff, uint8_t len){ + int status; + status = HAL_I2C_Master_Transmit(&hi2c2, addr, buff, len , def_i2c_time_out); + if( status ){ + MX_I2C2_Init(); + } + return status; +} + + +void RangeState(void) { + HAL_GPIO_TogglePin(LED2_GPIO_PORT, LED2_Pin); + int status; + uint16_t hlimit; + uint8_t scaling; + VL6180_RangeGetMeasurement(theVL6180Dev, &Range ); + scaling = VL6180_UpscaleGetScaling(theVL6180Dev); + if (Range.errorStatus) { + AbortErr("Er r"); + return; + } + + hlimit = VL6180_GetUpperLimit(theVL6180Dev); + if (Range.range_mm >= (hlimit * AutoThreshHigh) / 100 && scaling < 3 && State.AutoScale) { + VL6180_UpscaleSetScaling(theVL6180Dev, scaling + 1); + } + if (Range.range_mm < (hlimit * AutoThreshLow) / 100 && scaling > 1 && State.AutoScale) { + VL6180_UpscaleSetScaling(theVL6180Dev, scaling - 1); + } + + if (Range.errorStatus) { + /* no valid ranging*/ + if (State.OutofRAnge) { +#if VL6180_HAVE_DMAX_RANGING + if (g_TickCnt - TimeStarted >= ErrRangeDispTime && g_TickCnt - TimeStarted < ErrRangeDispTime + DMaxDispTime ){ + sprintf(buffer, "d%3d", (int)Range.DMax); + } + else + +#endif + if(g_TickCnt - TimeStarted < ErrRangeDispTime ) + { + + sprintf(buffer, "rE%2d", (int) Range.errorStatus); + } + else{ + State.OutofRAnge=0; /* back to out of range display */ + TimeStarted=g_TickCnt; + } + } + else { + int FilterEn; +#if VL6180_WRAP_AROUND_FILTER_SUPPORT + FilterEn = VL6180_FilterGetState(theVL6180Dev); +#else +#endif + if( g_TickCnt - TimeStarted > OutORangeDispfTime ) { + State.OutofRAnge = 1; + TimeStarted = g_TickCnt; + } + } + } + else { + State.OutofRAnge = 0; + TimeStarted = g_TickCnt; + range = (range * alpha + Range.range_mm * ((1 << 16) - alpha)) >> 16; + sprintf(buffer, "r%3d", (int) range); + if (State.AutoScale) { + if (scaling == 1) { + buffer[0] = '_'; + } + else + if (scaling == 2) + buffer[0] = '='; + else + buffer[0] = '~'; + } + + } + + if (changeScale == 1) { + changeScale = 0; + TimeStarted = g_TickCnt; + + State.ScaleSwapCnt++; + if (State.ScaleSwapCnt % (max_scale + 1) == max_scale) { + State.AutoScale = 1; + scaling = max_scale; + } + else { +#if ALLOW_DISABLE_WAF_FROM_BLUE_BUTTON + /* togle filtering every time we roll over all scaling(pass by autoscale) */ + if (State.AutoScale) + State.FilterEn = !State.FilterEn; +#endif + State.AutoScale = 0; + scaling = State.InitScale + (State.ScaleSwapCnt % max_scale); + if (scaling > max_scale) + scaling = scaling - (max_scale); + } + + status = VL6180_UpscaleSetScaling(theVL6180Dev, scaling); + if (status<0) { + AbortErr("ErUp"); + State.mode = InitErr; + } + else { + /* do not check status may fail when filter support not active */ + VL6180_FilterSetState(theVL6180Dev, State.FilterEn); + DoScalingSwap(scaling); + } + } +} +void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) +{ + if (GPIO_Pin == GPIO_PIN_0) + { + RangeState(); + if (Range.errorStatus == 0) + { + __NOP(); + } + VL6180_ClearAllInterrupt(theVL6180Dev); + } + else + { + + } + +} +/* USER CODE END 4 */ \ No newline at end of file diff --git a/main_prog/vl6180/App/vl6180_app.h b/main_prog/vl6180/App/vl6180_app.h new file mode 100644 index 0000000..4db3395 --- /dev/null +++ b/main_prog/vl6180/App/vl6180_app.h @@ -0,0 +1,9 @@ +// +// Created by Professional on 7/31/2023. +// + +#ifndef MYPROJECT_VL6180_APP_H +#define MYPROJECT_VL6180_APP_H + +#endif //MYPROJECT_VL6180_APP_H +void vl6180_init (void); diff --git a/main_prog/vl6180/Target/vl6180_appcfg.h b/main_prog/vl6180/Target/vl6180_appcfg.h new file mode 100644 index 0000000..b00ac33 --- /dev/null +++ b/main_prog/vl6180/Target/vl6180_appcfg.h @@ -0,0 +1,92 @@ + +/******************************************************************************* +Copyright © 2014, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + + +/* + * vl6180_appcfg.h + * + */ + +#ifndef VL6180_APPCFG_H_ +#define VL6180_APPCFG_H_ + + +/** + * @def VL6180_SINGLE_DEVICE_DRIVER + * @brief enable lightweight single vl6180 device driver + * + * value 1 => single device capable + * Configure optimized APi for single device driver with static data and minimal use of ref pointer \n + * limited to single device driver or application in non multi thread/core environment \n + * + * value 0 => multiple device capable user must review "device" structure and type in porting files + * @ingroup Configuration + */ +#define VL6180_SINGLE_DEVICE_DRIVER 1 + + +/** + * @def VL6180_RANGE_STATUS_ERRSTRING + * @brief when define include range status Error string and related + * + * The string table lookup require some space in read only area + * @ingroup Configuration + */ +#define VL6180_RANGE_STATUS_ERRSTRING 1 + +/** + * @def VL6180_SAFE_POLLING_ENTER + * + * @brief Ensure safe polling method when set + * + * Polling for a condition can be hazardous and result in infinite looping if any previous interrupt status + * condition is not cleared. \n + * Setting these flags enforce error clearing on start of polling method to avoid it. + * the drawback are : \n + * @li extra use-less i2c bus usage and traffic + * @li potentially slower measure rate. + * If application ensure interrupt get clear on mode or interrupt configuration change + * then keep option disabled. \n + * To be safe set these option to 1 + * @ingroup Configuration + */ +#define VL6180_SAFE_POLLING_ENTER 0 + + +/** + * @brief Enable function start/end logging + * + * requires porting @a #LOG_FUNCTION_START @a #LOG_FUNCTION_END @a #LOG_FUNCTION_END_FMT + * @ingroup Configuration + */ +#define VL6180_LOG_ENABLE 0 + + + +#endif /* VL6180_APPCFG_H_ */ diff --git a/main_prog/vl6180/Target/vl6180_i2c.c b/main_prog/vl6180/Target/vl6180_i2c.c new file mode 100644 index 0000000..71a2861 --- /dev/null +++ b/main_prog/vl6180/Target/vl6180_i2c.c @@ -0,0 +1,241 @@ + +/******************************************************************************* +Copyright © 2019, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + +/** + * @file vl6180_i2c.c + * + * Copyright (C) 2019 ST MicroElectronics + * + * provide variable word size byte/Word/dword VL6180 register access via i2c + * + */ +#include "vl6180_i2c.h" + +#ifndef I2C_BUFFER_CONFIG +#error "I2C_BUFFER_CONFIG not defined" +/* TODO you must define value for I2C_BUFFER_CONFIG in configuration or platform h */ +#endif + + +#if I2C_BUFFER_CONFIG == 0 + /* GLOBAL config buffer */ + uint8_t i2c_global_buffer[VL6180_MAX_I2C_XFER_SIZE]; + + #define DECL_I2C_BUFFER + #define VL6180_GetI2cBuffer(dev, n_byte) i2c_global_buffer + +#elif I2C_BUFFER_CONFIG == 1 + /* ON STACK */ + #define DECL_I2C_BUFFER uint8_t LocBuffer[VL6180_MAX_I2C_XFER_SIZE]; + #define VL6180_GetI2cBuffer(dev, n_byte) LocBuffer +#elif I2C_BUFFER_CONFIG == 2 + /* user define buffer type declare DECL_I2C_BUFFER as access via VL6180_GetI2cBuffer */ + #define DECL_I2C_BUFFER +#else +#error "invalid I2C_BUFFER_CONFIG " +#endif + + +int VL6180_WrByte(VL6180Dev_t dev, uint16_t index, uint8_t data){ + int status; + uint8_t *buffer; + DECL_I2C_BUFFER + VL6180_I2C_USER_VAR + + VL6180_GetI2CAccess(dev); + + buffer=VL6180_GetI2cBuffer(dev,3); + buffer[0]=index>>8; + buffer[1]=index&0xFF; + buffer[2]=data; + + status=VL6180_I2CWrite(dev, buffer,(uint8_t)3); + VL6180_DoneI2CAcces(dev); + return status; +} + +int VL6180_WrWord(VL6180Dev_t dev, uint16_t index, uint16_t data){ + int status; + DECL_I2C_BUFFER + uint8_t *buffer; + VL6180_I2C_USER_VAR + + VL6180_GetI2CAccess(dev); + + buffer=VL6180_GetI2cBuffer(dev,4); + buffer[0]=index>>8; + buffer[1]=index&0xFF; + buffer[2]=data>>8; + buffer[3]=data&0xFF; + + status=VL6180_I2CWrite(dev, buffer,(uint8_t)4); + VL6180_DoneI2CAcces(dev); + return status; +} + +int VL6180_WrDWord(VL6180Dev_t dev, uint16_t index, uint32_t data){ + VL6180_I2C_USER_VAR + DECL_I2C_BUFFER + int status; + uint8_t *buffer; + + + VL6180_GetI2CAccess(dev); + buffer=VL6180_GetI2cBuffer(dev,6); + buffer[0]=index>>8; + buffer[1]=index&0xFF; + buffer[2]=data>>24; + buffer[3]=(data>>16)&0xFF; + buffer[4]=(data>>8)&0xFF;; + buffer[5]=data&0xFF; + status=VL6180_I2CWrite(dev, buffer,(uint8_t)6); + VL6180_DoneI2CAcces(dev); + + return status; +} + +int VL6180_UpdateByte(VL6180Dev_t dev, uint16_t index, uint8_t AndData, uint8_t OrData){ + VL6180_I2C_USER_VAR + int status; + uint8_t *buffer; + DECL_I2C_BUFFER + + VL6180_GetI2CAccess(dev); + + buffer=VL6180_GetI2cBuffer(dev,3); + buffer[0]=index>>8; + buffer[1]=index&0xFF; + + status=VL6180_I2CWrite(dev, (uint8_t *)buffer,(uint8_t)2); + if( !status ){ + /* read data direct onto buffer */ + status=VL6180_I2CRead(dev, &buffer[2],1); + if( !status ){ + buffer[2]=(buffer[2]&AndData)|OrData; + status=VL6180_I2CWrite(dev, buffer, (uint8_t)3); + } + } + + VL6180_DoneI2CAcces(dev); + + return status; +} + +int VL6180_RdByte(VL6180Dev_t dev, uint16_t index, uint8_t *data){ + VL6180_I2C_USER_VAR + int status; + uint8_t *buffer; + DECL_I2C_BUFFER + + VL6180_GetI2CAccess(dev); + + buffer=VL6180_GetI2cBuffer(dev,2); + buffer[0]=index>>8; + buffer[1]=index&0xFF; + + status=VL6180_I2CWrite(dev, buffer, (uint8_t)2); + if( !status ){ + status=VL6180_I2CRead(dev, buffer,1); + if( !status ){ + *data=buffer[0]; + } + } + VL6180_DoneI2CAcces(dev); + + return status; +} + +int VL6180_RdWord(VL6180Dev_t dev, uint16_t index, uint16_t *data){ + VL6180_I2C_USER_VAR + int status; + uint8_t *buffer; + DECL_I2C_BUFFER + + VL6180_GetI2CAccess(dev); + + buffer=VL6180_GetI2cBuffer(dev,2); + buffer[0]=index>>8; + buffer[1]=index&0xFF; + + status=VL6180_I2CWrite(dev, buffer, (uint8_t)2); + if( !status){ + status=VL6180_I2CRead(dev, buffer,2); + if( !status ){ + /* VL6180 register are Big endian if cpu is be direct read direct into *data is possible */ + *data=((uint16_t)buffer[0]<<8)|(uint16_t)buffer[1]; + } + } + VL6180_DoneI2CAcces(dev); + return status; +} + +int VL6180_RdDWord(VL6180Dev_t dev, uint16_t index, uint32_t *data){ + VL6180_I2C_USER_VAR + int status; + uint8_t *buffer; + DECL_I2C_BUFFER + + VL6180_GetI2CAccess(dev); + buffer=VL6180_GetI2cBuffer(dev,4); + + buffer[0]=index>>8; + buffer[1]=index&0xFF; + + status=VL6180_I2CWrite(dev, (uint8_t *) buffer, (uint8_t)2); + if( !status ){ + status=VL6180_I2CRead(dev, buffer,4); + if( !status ){ + /* VL6180 register are Big endian if cpu is be direct read direct into data is possible */ + *data=((uint32_t)buffer[0]<<24)|((uint32_t)buffer[1]<<16)|((uint32_t)buffer[2]<<8)|((uint32_t)buffer[3]); + } + } + VL6180_DoneI2CAcces(dev); + return status; +} + + +int VL6180_RdMulti(VL6180Dev_t dev, uint16_t index, uint8_t *data, int nData){ + VL6180_I2C_USER_VAR + int status; + uint8_t *buffer; + DECL_I2C_BUFFER + + VL6180_GetI2CAccess(dev); + buffer=VL6180_GetI2cBuffer(dev,2); + + buffer[0]=index>>8; + buffer[1]=index&0xFF; + + status=VL6180_I2CWrite(dev, (uint8_t *) buffer, (uint8_t)2); + if( !status ){ + status=VL6180_I2CRead(dev, data, nData); + } + VL6180_DoneI2CAcces(dev); + return status; +} diff --git a/main_prog/vl6180/Target/vl6180_i2c.h b/main_prog/vl6180/Target/vl6180_i2c.h new file mode 100644 index 0000000..8c3cc8e --- /dev/null +++ b/main_prog/vl6180/Target/vl6180_i2c.h @@ -0,0 +1,166 @@ +/* + * $Date: 2015-01-08 14:30:24 +0100 (Thu, 08 Jan 2015) $ + * $Revision: 2039 $ + */ + +/** + * @file vl6180_i2c.h + * + * @brief CCI interface to "raw i2c" translation layer + */ + +#ifndef VL6180_I2C_H_ +#define VL6180_I2C_H_ + +#include "vl6180_platform.h" + +/** + * @defgroup cci_i2c CCI to RAW I2C translation layer + * + * This optional tranlation layer is implemented in __platform/cci-i2c__ directory. If user uses this translation layer for his platform, only @a VL6180_I2CRead() and + * @a VL6180_I2CWrite() functions need to be implemented. Also, some code adaption (via macro) is required for multi-threading and for multiple device support. + * + * File vl6180_i2c.c implements device register access via raw i2c access. If the targeted application and platform has no multi-thread, no multi-cpu and uses single + * device, then nothing else is required than the 2 mandatory function : @a VL6180_I2CRead() and @a VL6180_I2CWrite().\n + * In other cases, review and customize @a VL6180_GetI2CAccess() and @a VL6180_DoneI2CAccess() functions as well as @a #VL6180_I2C_USER_VAR macro. This should be enough + * to conform to a wide range of platform OS and application requirements .\n + * + * If your configured i2c for per device buffer via @a #I2C_BUFFER_CONFIG == 2, you must implement @a VL6180_GetI2cBuffer() + * + * __I2C Port sample__ \n + * A __linux kernel__ port need a "long flags" var for its spin_lock in all functions. the following code example declares a spin lock "lock" in the custom device structure. \n + * @code +struct MyVL6180Dev_t { + struct VL6180DevData_t StData; + ... + spinlock_t i2c_lock; +}; +typedef struct MyVL6180Dev_t *VL6180Dev_t; + +#define VL6180_I2C_USER_VAR unsigned long flags; +#define GetI2CAccess(dev) spin_lock_irqsave(dev->i2c_lock, flags) +#define DoneI2CAccess(dev) spin_unlock_irqrestore(dev->i2c_lock,flags) +@endcode + +* __POSIX pthread__ application porting could be as follows :\n +* @code +struct MyVL6180Dev_t { + struct VL6180DevData_t StData; + ... + pthread_mutex_t *lock; +}; +typedef struct MyVL6180Dev_t *VL6180Dev_t; + +#define VL6180_I2C_USER_VAR //no need +#define VL6180_GetI2CAccess(dev) pthread_mutex_lock(dev->lock) +#define VL6180_DoneI2CAcces(dev) pthread_mutex_unlock(dev->lock) + * @endcode + */ + +/** + * @def I2C_BUFFER_CONFIG + * + * @brief Configure device register I2C access + * + * @li 0 : one GLOBAL buffer \n + * Use one global buffer of MAX_I2C_XFER_SIZE byte in data space \n + * This solution is not multi-device compliant nor multi-thread cpu safe \n + * It can be the best option for small 8/16 bit MCU without stack and limited ram (STM8s, 80C51 ...) + * + * @li 1 : ON_STACK/local \n + * Use local variable (on stack) buffer \n + * This solution is multi-thread with use of i2c resource lock or mutex see @a VL6180_GetI2CAccess() \n + * + * @li 2 : User defined \n + * Per device potentially dynamic allocated. Requires @a VL6180_GetI2cBuffer() to be implemented. + * @ingroup Configuration + */ +#define I2C_BUFFER_CONFIG 1 + +/** + * @brief Write data buffer to VL6180 device via i2c + * @param dev The device to write to + * @param buff The data buffer + * @param len The length of the transaction in byte + * @return 0 on success + * @ingroup cci_i2c + */ +int VL6180_I2CWrite(VL6180Dev_t dev, uint8_t *buff, uint8_t len); + +/** + * + * @brief Read data buffer from VL6180 device via i2c + * @param dev The device to read from + * @param buff The data buffer to fill + * @param len The length of the transaction in byte + * @return 0 on success + * @ingroup cci_i2c + */ +int VL6180_I2CRead(VL6180Dev_t dev, uint8_t *buff, uint8_t len); + + +/** + * @brief Declare any required variables used by i2c lock (@a VL6180_DoneI2CAccess() and @a VL6180_GetI2CAccess()) + * and buffer access : @a VL6180_GetI2cBuffer() + * + * @ingroup cci_i2c + */ +#define VL6180_I2C_USER_VAR + +/** + * @brief Acquire lock or mutex for access to i2c data buffer and bus.\n + * Delete the default VL6180_GetI2CAccess 'do-nothing' macro below if you decide to implement this function. + * + * This function is used to perform i2c bus level and multiple access locking required for multi thread/proccess system.\n + * Multiple access (read and update) will lock once and do multiple basic i2c rd/wr to complete the overall transfer.\n + * When no locking is needed this can be a void macro.\n + * + * @param dev the device + * @ingroup cci_i2c + */ +void VL6180_GetI2CAccess(VL6180Dev_t dev); + +/** + * @def VL6180_GetI2CAccess + * @brief Default 'do-nothing' macro for @a VL6180_GetI2CAccess(). Delete if used. + * @ingroup cci_i2c + */ +#define VL6180_GetI2CAccess(dev) (void)0 /* TODO delete if function used */ + +/** + * @brief Release acquired lock or mutex for i2c access.\n + * Delete default VL6180_DoneI2CAccess 'do-nothing' macro below if implementing that function. + * + * This function is used to release the acquired lock. + * @param dev The device + * @ingroup cci_i2c + */ +void VL6180_DoneI2CAccess(VL6180Dev_t dev); + +/** @def VL6180_DoneI2CAcces + * @brief Default 'do-nothing' macro for @a VL6180_DoneI2CAcces(). Delete if used. + * @ingroup cci_i2c + */ +#define VL6180_DoneI2CAcces(dev) (void)0 /*TODO delete if function used */ + +/** + * @brief Provided data buffer for i2c access for at least n_byte. + * + * You must implement it when i2c @a #I2C_BUFFER_CONFIG is set to 2 (User defined).\n + * This is used used in the context of #VL6180_I2C_USER_VAR + * + * @param dev The device + * @param n_byte Minimal number of byte + * @return The buffer (cannot fail return not checked) + * @ingroup cci_i2c + */ +uint8_t *VL6180_GetI2cBuffer(VL6180Dev_t dev, int n_byte); +#if I2C_BUFFER_CONFIG == 2 +#error /* TODO add your macro of code here for VL6180_GetI2cBuffer */ +#endif + + + + + +#endif /* VL6180_I2C_H_ */ diff --git a/main_prog/vl6180/Target/vl6180_platform.h b/main_prog/vl6180/Target/vl6180_platform.h new file mode 100644 index 0000000..a7d31c5 --- /dev/null +++ b/main_prog/vl6180/Target/vl6180_platform.h @@ -0,0 +1,115 @@ +/******************************************************************************* +Copyright © 2019, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + + + +/* vl6180_platform.h STM32 Nucelo F401 single device using generic cci-i2c + * trace via swo port some GnuArm eclipse toolset */ + +#ifndef VL6180_PLATFORM +#define VL6180_PLATFORM + + +#include "vl6180_appcfg.h" +#include "vl6180_def.h" + + + +#define VL6180_DEV_DATA_ATTR + +#define ROMABLE_DATA +/* #define ROMABLE_DATA __attribute__ ((section ("user_rom"))) */ + + + +#if VL6180_LOG_ENABLE +/* dot not include non ansi here trace was a case :( */ +#ifdef TRACE +#include "diag/trace.h" +extern volatile uint32_t g_TickCnt; +#define LOG_GET_TIME() g_TickCnt +#else +/* these is nto stm32 vl6180 GNuArm eclpse build*/ +#define trace_printf(...) (void)0 +#define LOG_GET_TIME() (int)0 /* add your code here expect to be an integer native (%d) type value */ +#endif + + + +#define LOG_FUNCTION_START(fmt, ... ) \ + trace_printf("beg %s start @%d\t" fmt "\n", __func__, LOG_GET_TIME(), ##__VA_ARGS__) + +#define LOG_FUNCTION_END(status)\ + trace_printf("end %s @%d %d\n", __func__, LOG_GET_TIME(), (int)status) + +#define LOG_FUNCTION_END_FMT(status, fmt, ... )\ + trace_printf("End %s @%d %d\t"fmt"\n" , __func__, LOG_GET_TIME(), (int)status, ##__VA_ARGS__) + +#define VL6180_ErrLog(msg, ... )\ + do{\ + trace_printf("ERR in %s line %d\n" msg, __func__, __LINE__, ##__VA_ARGS__);\ + }while(0) + +#else /* VL6180_LOG_ENABLE no logging */ + void OnErrLog(void); + #define LOG_FUNCTION_START(...) (void)0 + #define LOG_FUNCTION_END(...) (void)0 + #define LOG_FUNCTION_END_FMT(...) (void)0 + #define VL6180_ErrLog(... ) OnErrLog() +#endif + + +#if VL6180_SINGLE_DEVICE_DRIVER + typedef uint8_t VL6180Dev_t; + +#else /* VL6180_SINGLE_DEVICE_DRIVER */ + + struct MyVL6180Dev_t { + struct VL6180DevData_t Data; + #if I2C_BUFFER_CONFIG == 2 + uint8_t i2c_buffer[VL6180_MAX_I2C_XFER_SIZE]; + #define VL6180_GetI2cBuffer(dev, n) ((dev)->i2c_buffer) + #endif + }; + typedef struct MyVL6180Dev_t *VL6180Dev_t; + +#define VL6180DevDataGet(dev, field) (dev->Data.field) +#define VL6180DevDataSet(dev, field, data) (dev->Data.field)=(data) + +#endif /* #else VL6180_SINGLE_DEVICE_DRIVER */ + +void VL6180_PollDelay(VL6180Dev_t dev); + +void DISP_ExecLoopBody(void); +#define VL6180_PollDelay(dev) DISP_ExecLoopBody(); + + +#endif /* VL6180_PLATFORM */ + + + diff --git a/main_prog/vl6180/Target/vl6180_types.h b/main_prog/vl6180/Target/vl6180_types.h new file mode 100644 index 0000000..dba5bd8 --- /dev/null +++ b/main_prog/vl6180/Target/vl6180_types.h @@ -0,0 +1,62 @@ +/******************************************************************************* +Copyright © 2014, STMicroelectronics International N.V. +All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions are met: + * Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + * 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. + * Neither the name of STMicroelectronics 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, FITNESS FOR A PARTICULAR PURPOSE, AND +NON-INFRINGEMENT OF INTELLECTUAL PROPERTY RIGHTS ARE DISCLAIMED. +IN NO EVENT SHALL STMICROELECTRONICS INTERNATIONAL N.V. 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. +********************************************************************************/ + +#ifndef VL6180_TYPES_H_ +#define VL6180_TYPES_H_ + + +#include +#include /* these is for NULL */ + +#ifndef NULL +#error "review NULL definition or add required include " +#endif + +#if !defined(STDINT_H) && !defined(_GCC_STDINT_H) && !defined(__STDINT_DECLS) && !defined(_STDINT) && !defined(_STDINT_H) + +#pragma message("Please review type definition of STDINT define for your platform and add to list above ") + + /* + * target platform do not provide stdint or use a different #define than above + * to avoid seeing the message below addapt the #define list above or implement + * all type and delete these pragma + */ + +typedef unsigned int uint32_t; +typedef int int32_t; + +typedef unsigned short uint16_t; +typedef short int16_t; + +typedef unsigned char uint8_t; + +typedef signed char int8_t; + +#endif /* _STDINT_H */ + +#endif /* VL6180_TYPES_H_ */