AMiRo-OS

/*

* 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;

}