7 #include "simpletools.h" 10 void compass_init(
i2c *bus)
14 unsigned char contMode = 0x00;
15 int n = i2c_out(bus, 0x3C >> 1, modeReg, 1, &contMode, 1);
18 void compass_read(
i2c *bus,
int *px,
int *py,
int *pz)
20 int16_t x16, y16, z16;
23 i2c_in(bus, 0x3D >> 1, datRegTo3, 1, data, 6);
25 x16 = (data[0] << 8) | data[1];
26 z16 = (data[2] << 8) | data[3];
27 y16 = (data[4] << 8) | data[5];