LSM9DS1 project - Follow a compass heading