/* * Copyright (c) 2017, STMicroelectronics - All Rights Reserved * * This file is part of VL53L1 Core and is dual licensed, * either 'STMicroelectronics * Proprietary license' * or 'BSD 3-clause "New" or "Revised" License' , at your option. * ******************************************************************************** * * 'STMicroelectronics Proprietary license' * ******************************************************************************** * * License terms: STMicroelectronics Proprietary in accordance with licensing * terms at www.st.com/sla0081 * * STMicroelectronics confidential * Reproduction and Communication of this document is strictly prohibited unless * specifically authorized in writing by STMicroelectronics. * * ******************************************************************************** * * Alternatively, VL53L1 Core may be distributed under the terms of * 'BSD 3-clause "New" or "Revised" License', in which case the following * provisions apply instead of the ones mentioned above : * ******************************************************************************** * * License terms: BSD 3-clause "New" or "Revised" License. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * * 3. Neither the name of the copyright holder nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * * ******************************************************************************** * */ /** * @file vl53l1_silicon_core.c * * @brief EwokPlus25 low level silicon LL Driver function definition */ #include "vl53l1_ll_def.h" #include "vl53l1_platform.h" #include "vl53l1_register_map.h" #include "vl53l1_core.h" #include "vl53l1_silicon_core.h" #define LOG_FUNCTION_START(fmt, ...) \ _LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__) #define LOG_FUNCTION_END(status, ...) \ _LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__) #define LOG_FUNCTION_END_FMT(status, fmt, ...) \ _LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, status, fmt, ##__VA_ARGS__) VL53L1_Error VL53L1_is_firmware_ready_silicon( VL53L1_DEV Dev, uint8_t *pready) { /** * Determines if the firmware is ready to range * * There are 2 different behaviors depending on whether * power force is enabled or not */ VL53L1_Error status = VL53L1_ERROR_NONE; VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev); uint8_t comms_buffer[5]; LOG_FUNCTION_START(""); /* read interrupt and power force reset status */ status = VL53L1_ReadMulti( Dev, VL53L1_INTERRUPT_MANAGER__ENABLES, comms_buffer, 5); if (status == VL53L1_ERROR_NONE) { pdev->dbg_results.interrupt_manager__enables = comms_buffer[0]; pdev->dbg_results.interrupt_manager__clear = comms_buffer[1]; pdev->dbg_results.interrupt_manager__status = comms_buffer[2]; pdev->dbg_results.mcu_to_host_bank__wr_access_en = comms_buffer[3]; pdev->dbg_results.power_management__go1_reset_status = comms_buffer[4]; if ((pdev->sys_ctrl.power_management__go1_power_force & 0x01) == 0x01) { if (((pdev->dbg_results.interrupt_manager__enables & 0x1F) == 0x1F) && ((pdev->dbg_results.interrupt_manager__clear & 0x1F) == 0x1F)) *pready = 0x01; else *pready = 0x00; } else { /* set ready flag if bit 0 is zero i.g G01 is in reset */ if ((pdev->dbg_results.power_management__go1_reset_status & 0x01) == 0x00) *pready = 0x01; else *pready = 0x00; } } LOG_FUNCTION_END(status); return status; }