lis2dh12_obj.cpp

// Copyright 2015-2016 Espressif Systems (Shanghai) PTE LTD
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at

//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
#include <stdio.h>
#include "esp_log.h"
#include "driver/i2c.h"
#include "iot_i2c_bus.h"
#include "iot_lis2dh12.h"

CLis2dh12::CLis2dh12(CI2CBus *p_i2c_bus, uint8_t addr)
{
    bus = p_i2c_bus;
    m_sensor_handle = iot_lis2dh12_create(bus->get_bus_handle(), addr);

    lis2dh12_config_t  lis2dh12_config;
    iot_lis2dh12_get_config(m_sensor_handle, &lis2dh12_config);
    lis2dh12_config.temp_enable = LIS2DH12_TEMP_DISABLE;
    lis2dh12_config.odr = LIS2DH12_ODR_1HZ;
    lis2dh12_config.opt_mode = LIS2DH12_OPT_NORMAL;
    lis2dh12_config.z_enable = LIS2DH12_ENABLE;
    lis2dh12_config.y_enable = LIS2DH12_ENABLE;
    lis2dh12_config.x_enable = LIS2DH12_ENABLE;
    lis2dh12_config.bdu_status = LIS2DH12_DISABLE;
    lis2dh12_config.fs = LIS2DH12_FS_16G;
    iot_lis2dh12_set_config(m_sensor_handle, &lis2dh12_config);
}

CLis2dh12::~CLis2dh12()
{
    iot_lis2dh12_delete(m_sensor_handle, false);
    m_sensor_handle = NULL;
}

uint8_t CLis2dh12::id()
{
    uint8_t id;
    iot_lis2dh12_get_deviceid(m_sensor_handle, &id);
    return id;
}

uint16_t CLis2dh12::ax()
{
    uint16_t acc_val;
    iot_lis2dh12_get_x_acc(m_sensor_handle, &acc_val);
    return acc_val;
}

uint16_t CLis2dh12::ay()
{
    uint16_t acc_val;
    iot_lis2dh12_get_y_acc(m_sensor_handle, &acc_val);
    return acc_val;
}

uint16_t CLis2dh12::az()
{
    uint16_t acc_val;
    iot_lis2dh12_get_z_acc(m_sensor_handle, &acc_val);
    return acc_val;
}