driver_hmc5883l_basic.c

Go to the documentation of this file.

 
#include "driver_hmc5883l_basic.h"
 
static hmc5883l_handle_t gs_handle;        

uint8_t hmc5883l_basic_init(void)
{
    uint8_t res;
    
    /* link interface function */
    DRIVER_HMC5883L_LINK_INIT(&gs_handle, hmc5883l_handle_t);
    DRIVER_HMC5883L_LINK_IIC_INIT(&gs_handle, hmc5883l_interface_iic_init);
    DRIVER_HMC5883L_LINK_IIC_DEINIT(&gs_handle, hmc5883l_interface_iic_deinit);
    DRIVER_HMC5883L_LINK_IIC_READ(&gs_handle, hmc5883l_interface_iic_read);
    DRIVER_HMC5883L_LINK_IIC_WRITE(&gs_handle, hmc5883l_interface_iic_write);
    DRIVER_HMC5883L_LINK_DELAY_MS(&gs_handle, hmc5883l_interface_delay_ms);
    DRIVER_HMC5883L_LINK_DEBUG_PRINT(&gs_handle, hmc5883l_interface_debug_print);
    
    /* hmc5883l init */
    res = hmc5883l_init(&gs_handle);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: init failed.\n");
        
        return 1;
    }
    
    /* set average sample */
    res = hmc5883l_set_average_sample(&gs_handle, HMC5883L_BASIC_DEFAULT_AVERAGE_SAMPLE);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: set average sample failed.\n");
        (void)hmc5883l_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set data output rate */
    res = hmc5883l_set_data_output_rate(&gs_handle, HMC5883L_BASIC_DEFAULT_DATA_OUTPUT_RATE);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: set data output rate failed.\n");
        (void)hmc5883l_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set mode */
    res = hmc5883l_set_mode(&gs_handle, HMC5883L_BASIC_DEFAULT_MODE);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: set mode failed.\n");
        (void)hmc5883l_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set gain */
    res = hmc5883l_set_gain(&gs_handle, HMC5883L_BASIC_DEFAULT_GAIN);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: set gain failed.\n");
        (void)hmc5883l_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set enable high speed iic */
    res = hmc5883l_enable_high_speed_iic(&gs_handle);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: enable high speed iic failed.\n");
        (void)hmc5883l_deinit(&gs_handle);
        
        return 1;
    }
    
    /* start continuous read */
    res = hmc5883l_start_continuous_read(&gs_handle);
    if (res != 0)
    {
        hmc5883l_interface_debug_print("hmc5883l: start continuous read failed.\n");
        (void)hmc5883l_deinit(&gs_handle);
        
        return 1;
    }
    
    return 0;
}

uint8_t hmc5883l_basic_read(float m_gauss[3])
{
    int16_t raw[3];
    
    /* read x,y,z data */
    if (hmc5883l_continuous_read(&gs_handle, (int16_t *)raw, m_gauss) != 0)
    {
        return 1;
    }
    else
    {
        return 0;
    }
}

uint8_t hmc5883l_basic_deinit(void)
{
    uint8_t res;
    
    /* stop continuous read*/
    res = hmc5883l_stop_continuous_read(&gs_handle);
    if (res != 0)
    {
        return 1;
    }
    
    /* close hmc5883l */
    if (hmc5883l_deinit(&gs_handle) != 0)
    {
        return 1;
    }
    else
    {
        return 0;
    }
}