driver_bmm150_interrupt.c

Go to the documentation of this file.

 
#include "driver_bmm150_interrupt.h"
 
static bmm150_handle_t gs_handle;                     

uint8_t bmm150_interrupt_irq_handler(void)
{
    if (bmm150_irq_handler(&gs_handle) != 0)
    {
        return 1;
    }
    
    return 0;
}

uint8_t bmm150_interrupt_init(bmm150_interface_t interface, bmm150_address_t addr_pin,
                              float low_threshold_ut, float high_threshold_ut, void (*callback)(uint8_t type))
{
    uint8_t res;
    int8_t reg;
    bmm150_bool_t enable;
 
    /* link interface function */
    DRIVER_BMM150_LINK_INIT(&gs_handle, bmm150_handle_t);
    DRIVER_BMM150_LINK_IIC_INIT(&gs_handle, bmm150_interface_iic_init);
    DRIVER_BMM150_LINK_IIC_DEINIT(&gs_handle, bmm150_interface_iic_deinit);
    DRIVER_BMM150_LINK_IIC_READ(&gs_handle, bmm150_interface_iic_read);
    DRIVER_BMM150_LINK_IIC_WRITE(&gs_handle, bmm150_interface_iic_write);
    DRIVER_BMM150_LINK_SPI_INIT(&gs_handle, bmm150_interface_spi_init);
    DRIVER_BMM150_LINK_SPI_DEINIT(&gs_handle, bmm150_interface_spi_deinit);
    DRIVER_BMM150_LINK_SPI_READ(&gs_handle, bmm150_interface_spi_read);
    DRIVER_BMM150_LINK_SPI_WRITE(&gs_handle, bmm150_interface_spi_write);
    DRIVER_BMM150_LINK_DELAY_MS(&gs_handle, bmm150_interface_delay_ms);
    DRIVER_BMM150_LINK_DEBUG_PRINT(&gs_handle, bmm150_interface_debug_print);
    DRIVER_BMM150_LINK_RECEIVE_CALLBACK(&gs_handle, callback);
    
    /* set the interface */
    res = bmm150_set_interface(&gs_handle, interface);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interface failed.\n");
       
        return 1;
    }
    
    /* set addr pin */
    res = bmm150_set_addr_pin(&gs_handle, addr_pin);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set addr pin failed.\n");
       
        return 1;
    }
    
    /* bmm150 initialization */
    res = bmm150_init(&gs_handle);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: init failed.\n");
       
        return 1;
    }
    
    /* power on */
    res = bmm150_set_power_on(&gs_handle, BMM150_BOOL_TRUE);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set power on failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set advanced self test normal mode */
    res = bmm150_set_advanced_self_test(&gs_handle, BMM150_ADVANCED_SELF_TEST_NORMAL);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set advanced self test failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* disable self test */
    res = bmm150_set_self_test(&gs_handle, BMM150_BOOL_FALSE);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set self test failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default data overrun */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_DATA_OVERRUN, BMM150_INTERRUPT_DEFAULT_INTERRUPT_DATA_OVERRUN);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default overflow */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_OVERFLOW, BMM150_INTERRUPT_DEFAULT_INTERRUPT_OVERFLOW);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default high threshold z */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_HIGH_THRESHOLD_Z, BMM150_INTERRUPT_DEFAULT_INTERRUPT_HIGH_THRESHOLD_Z);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default high threshold y */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_HIGH_THRESHOLD_Y, BMM150_INTERRUPT_DEFAULT_INTERRUPT_HIGH_THRESHOLD_Y);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default high threshold x */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_HIGH_THRESHOLD_X, BMM150_INTERRUPT_DEFAULT_INTERRUPT_HIGH_THRESHOLD_X);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default low threshold z */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_LOW_THRESHOLD_Z, BMM150_INTERRUPT_DEFAULT_INTERRUPT_LOW_THRESHOLD_Z);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default low threshold y */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_LOW_THRESHOLD_Y, BMM150_INTERRUPT_DEFAULT_INTERRUPT_LOW_THRESHOLD_Y);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default low threshold x */
    res = bmm150_set_interrupt(&gs_handle, BMM150_INTERRUPT_STATUS_LOW_THRESHOLD_X, BMM150_INTERRUPT_DEFAULT_INTERRUPT_LOW_THRESHOLD_X);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default data ready pin */
    res = bmm150_set_data_ready_pin(&gs_handle, BMM150_INTERRUPT_DEFAULT_DATA_READY_PIN);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set data ready pin failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default interrupt pin */
    res = bmm150_set_interrupt_pin(&gs_handle, BMM150_INTERRUPT_DEFAULT_INTERRUPT_PIN);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt pin failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default data ready pin polarity */
    res = bmm150_set_data_ready_pin_polarity(&gs_handle, BMM150_INTERRUPT_DEFAULT_DATA_READY_PIN_POLARITY);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set data ready pin polarity failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default interrupt latch */
    res = bmm150_set_interrupt_latch(&gs_handle, BMM150_INTERRUPT_DEFAULT_INTERRUPT_LATCH);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt latch failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default interrupt pin polarity */
    res = bmm150_set_interrupt_pin_polarity(&gs_handle, BMM150_INTERRUPT_DEFAULT_INTERRUPT_PIN_POLARITY);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set interrupt pin polarity failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* convert low threshold */
    res = bmm150_interrupt_threshold_convert_to_register(&gs_handle, low_threshold_ut, &reg);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: interrupt threshold convert to register failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set low threshold */
    res = bmm150_set_low_threshold(&gs_handle, reg);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set low threshold failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* convert high threshold */
    res = bmm150_interrupt_threshold_convert_to_register(&gs_handle, high_threshold_ut, &reg);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: interrupt threshold convert to register failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set high threshold */
    res = bmm150_set_high_threshold(&gs_handle, reg);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set high threshold failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* enable channel z */
    res = bmm150_set_channel_z(&gs_handle, BMM150_BOOL_TRUE);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set channel z failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* enable channel y */
    res = bmm150_set_channel_y(&gs_handle, BMM150_BOOL_TRUE);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set channel y failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* enable channel x */
    res = bmm150_set_channel_x(&gs_handle, BMM150_BOOL_TRUE);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set channel x failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default repxy number */
    res = bmm150_set_repxy_number(&gs_handle, BMM150_INTERRUPT_DEFAULT_REPXY);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set repxy number failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default repz number */
    res = bmm150_set_repz_number(&gs_handle, BMM150_INTERRUPT_DEFAULT_REPZ);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set repz number failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set default data rate */
    res = bmm150_set_data_rate(&gs_handle, BMM150_INTERRUPT_DEFAULT_DATA_RATE);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set data rate failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* set normal mode */
    res = bmm150_set_mode(&gs_handle, BMM150_MODE_NORMAL);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: set mode failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    /* clear interrupt status */
    res = bmm150_get_interrupt_status(&gs_handle, BMM150_INTERRUPT_STATUS_DATA_OVERRUN, &enable);
    if (res != 0)
    {
        bmm150_interface_debug_print("bmm150: get interrupt status failed.\n");
        (void)bmm150_deinit(&gs_handle);
        
        return 1;
    }
    
    return 0;
}

uint8_t bmm150_interrupt_read(float ut[3])
{
    int16_t raw[3];
    
    /* read data */
    if (bmm150_read(&gs_handle, raw, ut) != 0)
    {
        return 1;
    }
    
    return 0;
}

uint8_t bmm150_interrupt_deinit(void)
{
    /* set sleep mode */
    if (bmm150_set_mode(&gs_handle, BMM150_MODE_SLEEP) != 0)
    {
        return 1;
    }
    
    /* deinit */
    if (bmm150_deinit(&gs_handle) != 0)
    {
        return 1;
    }
    
    return 0;
}