10 #include "simpletools.h" 11 #include "compass3d.h" 17 i2c *bus = i2c_newbus(3, 2, 0);
22 compass_read(bus, &x, &y, &z);
23 print(
"%cx=%d, y=%d, z=%d%c\n",
24 HOME, x, y, z, CLREOL);
28 float heading = atan2(fy, fx) * 180.0/PI;
30 heading = (360.0 + heading);
31 print(
"heading = %.2f%c\n",