46 lines
1.2 KiB
C
46 lines
1.2 KiB
C
/*
|
|
* Example of using HMC5883L driver
|
|
*
|
|
* Part of esp-open-rtos
|
|
* Copyright (C) 2016 Ruslan V. Uss <unclerus@gmail.com>
|
|
* BSD Licensed as described in the file LICENSE
|
|
*/
|
|
#include <esp/uart.h>
|
|
#include <espressif/esp_common.h>
|
|
#include <stdio.h>
|
|
#include <i2c/i2c.h>
|
|
#include <hmc5883l/hmc5883l.h>
|
|
|
|
#define I2C_BUS 0
|
|
#define SCL_PIN 5
|
|
#define SDA_PIN 4
|
|
|
|
void user_init(void)
|
|
{
|
|
uart_set_baud(0, 115200);
|
|
printf("SDK version:%s\n\n", sdk_system_get_sdk_version());
|
|
|
|
i2c_init(I2C_BUS, SCL_PIN, SDA_PIN, I2C_FREQ_100K);
|
|
i2c_dev_t dev = {
|
|
.addr = HMC5883L_ADDR,
|
|
.bus = I2C_BUS,
|
|
};
|
|
|
|
while (!hmc5883l_init(&dev))
|
|
printf("Device not found\n");
|
|
|
|
hmc5883l_set_operating_mode(&dev, HMC5883L_MODE_CONTINUOUS);
|
|
hmc5883l_set_samples_averaged(&dev, HMC5883L_SAMPLES_8);
|
|
hmc5883l_set_data_rate(&dev, HMC5883L_DATA_RATE_07_50);
|
|
hmc5883l_set_gain(&dev, HMC5883L_GAIN_1090);
|
|
|
|
while (true)
|
|
{
|
|
hmc5883l_data_t data;
|
|
hmc5883l_get_data(&dev, &data);
|
|
printf("Magnetic data: X:%.2f mG, Y:%.2f mG, Z:%.2f mG\n", data.x, data.y, data.z);
|
|
|
|
for (uint32_t i = 0; i < 1000; i++)
|
|
sdk_os_delay_us(250);
|
|
}
|
|
}
|