AMiRo-OS

#include <alld_VL53L1X.h>

//#include "vl53l1_platform.h"

#include <vl53l1_api.h>

// #include "vl53l1_platform_log.h"

// #include "stm32xxx_hal.h"

#include <string.h>

apalExitStatus_t hello_world(void){

    return APAL_STATUS_OK;

}

/**

 * @brief Set the GPIO1 to a specific state.

 * @param[in]   ledp        The LED driver object.

 * @param[in]   led_state   The state to set the LED to.

 * @return                  An indicator whether the call was successful.

 */

apalExitStatus_t vl53l1x_GPIO1_set(const VL53L1XDriver* const vlx, const gpio_lld_state_t state)

{

  apalDbgAssert(vlx != NULL);

  return apalControlGpioSet(vlx->xshut, (state == GPIO_LLD_STATE_ON) ? APAL_GPIO_ON : APAL_GPIO_OFF);

}

// #define I2C_TIME_OUT_BASE   10

// #define I2C_TIME_OUT_BYTE   1

// #ifdef VL53L1_LOG_ENABLE

// #define trace_print(level, ...) VL53L1_trace_print_module_function(VL53L1_TRACE_MODULE_PLATFORM, level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)

// #define trace_i2c(...) VL53L1_trace_print_module_function(VL53L1_TRACE_MODULE_NONE, VL53L1_TRACE_LEVEL_NONE, VL53L1_TRACE_FUNCTION_I2C, ##__VA_ARGS__)

// #endif

// #ifndef HAL_I2C_MODULE_ENABLED

// #warning "HAL I2C module must be enable "

// #endif

//extern I2C_HandleTypeDef hi2c1;

//#define VL53L0X_pI2cHandle    (&hi2c1)

/* when not customized by application define dummy one */

// #ifndef VL53L1_GetI2cBus

/** This macro can be overloaded by user to enforce i2c sharing in RTOS context

 */

// #   define VL53L1_GetI2cBus(...) (void)0

// #endif

// #ifndef VL53L1_PutI2cBus

/** This macro can be overloaded by user to enforce i2c sharing in RTOS context

 */

// #   define VL53L1_PutI2cBus(...) (void)0

// #endif

#define I2C_TIME_OUT_BASE   10

#define I2C_TIME_OUT_BYTE   1

uint8_t _I2CBuffer[256] = { 0 };

uint8_t rx_buf[256];

uint8_t tx_buf[256];

int _I2CWrite(VL53L1_DEV Dev, uint8_t *pdata, uint32_t count) {

    int status = 0;

    int i2c_time_out = 1000 * (I2C_TIME_OUT_BASE + count * I2C_TIME_OUT_BYTE);

    apalExitStatus_t status2 = apalI2CMasterTransmit(Dev->vl53l1x.i2cd, Dev->vl53l1x.addr, pdata, count, rx_buf, 0, 100);

    return status;

}

int _I2CRead(VL53L1_DEV Dev, uint8_t *pdata, uint32_t count) {

   int status = 0;

//   apalI2CMasterReceive(Dev->vl53l1x->i2cd, Dev->vl53l1x->addr, uint8_t* const rxbuf, const size_t rxbytes, const apalTime_t timeout)

   return status;

}

// TODO: Needs to be defined

VL53L1_Error VL53L1_WriteMulti(VL53L1_DEV Dev, uint16_t index, uint8_t *pdata, uint32_t count) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

// the ranging_sensor_comms.dll will take care of the page selection

VL53L1_Error VL53L1_ReadMulti(VL53L1_DEV Dev, uint16_t index, uint8_t *pdata, uint32_t count) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

VL53L1_Error VL53L1_WrByte(VL53L1_DEV Dev, uint16_t index, uint8_t data) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    // printf("Starting to write byte: %X\n", data);

     int32_t status_int;

    _I2CBuffer[0] = index>>8;

    _I2CBuffer[1] = index&0xFF;

    _I2CBuffer[2] = data;

    _I2CWrite(Dev, _I2CBuffer, 3);

    return Status;

}

VL53L1_Error VL53L1_WrWord(VL53L1_DEV Dev, uint16_t index, uint16_t data) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

VL53L1_Error VL53L1_WrDWord(VL53L1_DEV Dev, uint16_t index, uint32_t data) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

VL53L1_Error VL53L1_UpdateByte(VL53L1_DEV Dev, uint16_t index, uint8_t AndData, uint8_t OrData) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

VL53L1_Error VL53L1_RdByte(VL53L1_DEV Dev, uint16_t index, uint8_t *data) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    uint8_t indx[2] = { index >> 8, index & 0xFF };

    apalExitStatus_t status2 = apalI2CMasterTransmit(Dev->vl53l1x.i2cd, Dev->vl53l1x.addr, indx, 2, data, 1, 0);

    return Status;

}

VL53L1_Error VL53L1_RdWord(VL53L1_DEV Dev, uint16_t index, uint16_t *data) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

VL53L1_Error VL53L1_RdDWord(VL53L1_DEV Dev, uint16_t index, uint32_t *data) {

    VL53L1_Error Status = VL53L1_ERROR_NONE;

    return Status;

}

VL53L1_Error VL53L1_GetTickCount(

        uint32_t *ptick_count_ms)

{

        VL53L1_Error status  = VL53L1_ERROR_NONE;

        return status;

}

//#define trace_print(level, ...) \

//        _LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_PLATFORM, \

//        level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)

//#define trace_i2c(...) \

//        _LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_NONE, \

//        VL53L1_TRACE_LEVEL_NONE, VL53L1_TRACE_FUNCTION_I2C, ##__VA_ARGS__)

VL53L1_Error VL53L1_GetTimerFrequency(int32_t *ptimer_freq_hz)

{

        VL53L1_Error status  = VL53L1_ERROR_NONE;

        return status;

}

VL53L1_Error VL53L1_WaitMs(VL53L1_Dev_t *pdev, int32_t wait_ms){

        VL53L1_Error status  = VL53L1_ERROR_NONE;

        return status;

}

VL53L1_Error VL53L1_WaitUs(VL53L1_Dev_t *pdev, int32_t wait_us){

        VL53L1_Error status  = VL53L1_ERROR_NONE;

        return status;

}

VL53L1_Error VL53L1_WaitValueMaskEx(

        VL53L1_Dev_t *pdev,

        uint32_t      timeout_ms,

        uint16_t      index,

        uint8_t       value,

        uint8_t       mask,

        uint32_t      poll_delay_ms)

{

        VL53L1_Error status  = VL53L1_ERROR_NONE;

        return status;

}