resonator napisał(a):
Miałem rację, nie jest to ten sam układ, który deklaruje sprzedawcy modułów! Jeśli się dobrze przyjrzeć obudowie to można tam odczytać oznaczenie "DA5883". W necie wyczytałem że oryginalny producent układów o oznaczeniu "HMC5883" przestał produkować czy tam sprzedał prawa do produkcji, nie wnikałem o co chodziło. Sedno w tym, że teraz są to zupełnie inne układy o oznaczeniu "QMC5883L". Mają inny adres (0x0D), Inaczej poustawiane rejestry (program wyżej był poprawny a odczytywał z rejestrów zera, ponieważ były to rejestry od danych pomiaru, który nie był wyzwalany) i w ogóle wydaje mi się, że mają mniej opcji do konfigurowania.
Tak, to prawda, trzeba na to zwracać uwagę. Też kupowałem HMC5883L (L883), a otrzymałem QMC5883L (DA5883), który różni się od układu Honeywell'a.
Podobnie jak kolega resonator walczyłem z tym układem, jednak udało mi się stworzyć program do jego obsługi, lecz mam rażenie, że wyniki, które odczytuje strasznie szaleją (i chyba nie są poprawne(?)) - nie wiem :/
PS: resonator czy udało Ci się "opanować" odczyt z tego magnetometru?
Wrzucam swój kod:
[syntax=c]/* Podstawowe biblioteki */
#include <avr/io.h>
#include <avr/iom8.h>
#include <avr/pgmspace.h>
#include <avr/interrupt.h>
#include <stdlib.h>
#include <util/delay.h>
#include <math.h>
/* Biblioteki zewnętrzne */
#include "i2cmaster.h"
#include "UART_lib/UART.h"
/* Definicje */
#define QMC5883_I2C_ADDRESS 0x0D
char buffer[6];
int16_t raw_x = 0;
int16_t raw_y = 0;
int16_t raw_z = 0;
float headingDegrees = 0;
/* Functions */
void init_QMC5883L();
float getHeading();
/* Główna funkcja programu */
int main(void) {
UART_init(baud_rate_19200);
i2c_init();
init_QMC5883L();
/* Globalne przerwania */
//sei();
while(1) {
getHeading();
itoa(raw_x, buffer, 10);
UART_puts(buffer);
UART_puts(" ");
itoa(raw_y, buffer, 10);
UART_puts(buffer);
UART_puts(" ");
itoa(raw_z, buffer, 10);
UART_puts(buffer);
UART_puts(" ");
dtostrf(headingDegrees, 6, 2, buffer);
UART_puts(buffer);
UART_puts(" \r\n");
_delay_ms(100);
}
}
void init_QMC5883L(void) {
i2c_start((QMC5883_I2C_ADDRESS<<1) | I2C_WRITE);
i2c_write(0x0B);// QMC5883_SET_RESET_PERIOD0x0B
i2c_write(0x01);
i2c_stop();
i2c_start((QMC5883_I2C_ADDRESS<<1) | I2C_WRITE);
i2c_write(0x09);// QMC5883_REG_CONFIG_1
i2c_write(0b00000001|0b00001100|0b00010000|0b00000000);// QMC5883_MODE_CONTINOUS,QMC5883_ODR_200Hz,QMC5883_RNG_8G,QMC5883_OSR_512
i2c_stop();
}
float getHeading(void) {
i2c_start((QMC5883_I2C_ADDRESS<<1) | I2C_WRITE);
i2c_write(0x00);
i2c_stop();
i2c_rep_start((QMC5883_I2C_ADDRESS<<1) | I2C_READ);
raw_x = ((uint8_t)i2c_readAck())<<8;
raw_x |= i2c_readAck();
raw_z = ((uint8_t)i2c_readAck())<<8;
raw_z |= i2c_readAck();
raw_y = ((uint8_t)i2c_readAck())<<8;
raw_y |= i2c_readNak();
i2c_stop();
headingDegrees = atan2((double)raw_y,(double)raw_x) * 180 / 3.141592654 + 180;
return headingDegrees;
}[/syntax]
Tak w pewnym sensie. Na początku w jednym miejscu pomiar potrafił przeskakiwać o kilka stopni. Ja nie potrzebowałem zbyt dokładnego wyniku (starczyło by mi 30 stopni na kąt pełny
), więc zmieniłem rozdzielczość z 8G na 2G, częstotliwość wyników do 50Hz i końcowe przeliczanie na liczbę całkowitą. Teraz wynik waha się o 1-2 stopnie mówiąc oczywiście o obrocie względem osi prostopadłej do Ziemi, ja potrzebuje znać kierunek niezależnie od ułożenia sensora i z tym teraz się męczę.Statystyki: Napisane przez resonator — 28 wrz 2017, o 18:22
]]>
