Open-source Qibla finder with tilt compensation using 9-DoF IMU and GPS

After doing research on available designs on the internet for Qiblah compass devices, I found that the available ones are very few and miss an important feature of tilt compensation. As this device need obviously to be accurate, thus giving importance to improving accuracy is way more important than visual and sound effects. Therefore, I decided to build an open-source qiblah locator device built using Arduino, Magnetometer, GPS and an OLED display with proper documentation.

Open-source qibla finder with tilt compensation using 9-DoF IMU and GPS connected with Arduino

The first time I thought about the project was ten months ago, and after a study of what the project requires, I knew that I would need a Magnetometer and GPS receiver. That is why I bought Adafruit Mini GPS PA1010D and BMI270 shuttle board. The BMI270 with the BMM150 magnetometer is found in Arduino Nano 33 BLE Sense Rev2 too. Finally, I bought monochrome 0.91″ 128×32 I2C OLED Display to display the notifications to the user. 

To reap, this Qiblah compass has the following features: 

Project repository on GitHub. The circuit was tested within the city in which I live. I hope anyone rebuilds it to confirm the correctness of the Qiblah location in his area.

IMU series:

Magnetometer

The qiblah is a geographical direction, and to determine the geographical direction we use the magnetometer. Using it we can calculate the direction angle thanks to the geomagnetic field. The principle of calculating the direction using earth’s magnetic field is simple and shown in the figure below.

An illustrative image showing the sensor chip horizontally on a flat surface with the X-axis facing the field towards the north.

The angle can be calculated using the well-known trigonometric law:

By applying this equation, the calculated direction did not match my mobile compass. After searching about that problem, I found that the magnetometer suffers from distortion resulting from close magnetic fields generated by nearby circuits or magentis or from nearby materials that cause distortion of the geomagnetic field. This is called Soft iron calibration and Hard iron calibration. For this purpose, I wrote a detailed article on calibrating the magnetometer. Refer to it for a better understanding.

We will use the Motion Sensor Calibration Tool, which includes visualizing the received values and displaying statistics about them to ensure that they are good for the calibration process. It calculates the calibration matrices for the two types of Hard iron and Soft iron. The sensor values are sent to the program via serial communication at a speed of 115200 as follows:

Raw:acc_x,acc_y,acc_z,gyro_x,gyro_y,gyro_z,mag_x*10,mag_y*10,mag_z*10
To enable the circuit output needed for calibration, the value of the MOTION_CAL_SOFT macro is set to 1.

Be aware that the points in the 3D sphere of the calibration tool satisfy: 

After the calibration matrix is calculated it is used in code to be used each time. There is a detailed lesson on using the Motion Sensor Calibration Tool program on YouTube for those who want to clarify it.

// Mag. calibration
// Hard ironing
//B
#define B1 -3.48
#define B2 0.42
#define B3 -5.78

//Soft ironing
//H column1
#define H11 1.036
#define H21 -0.023
#define H31 0.009
//H column2
#define H12 -0.023
#define H22 1.010
#define H32 -0.008
//H column3
#define H13 0.009
#define H23 -0.008
#define H33 0.956
/**********************/ 

After the calibration matrices are calculated, we use them in code. I recommend to refer to a detailed explanation of how to use the Motion Sensor Calibration Tool on Youtube.

Finally, the declination angle should be determined in the code. Use magnetic-declination.com to determine users depending on your location. 

The difference between geographic pole and magnetic pole. This is called declination angle. 

OLED Display Screen

The used OLED screen from Adafruit has 128 pixels in width and 32 pixels in height. We will use 2 libraries Adafruit_GFX and Adafruit_SSD1306 to drive the Monochrome 0.91″ 128×32 I2C OLED Display.

To convert an image to be shown in the screen, we need to convert the image to a byte array. We will use LCD Assistant and although it is designed to work on Windows, it can run using Wine on Linux.

We import the BMP image from File>Load image, and use the following settings:

To get the array, we do File>Save output. We use the generated array in the code using drawBitmap function. 

To check the official documentation of the APIs used with the display like clearDisplay, display, setTextSize, and setCursor, the reader must refer to the official documentation

GPS Receiver

The code can operate using the magnetometer only, which gives the geographical direction which will be compared to the Qiblah’s angle. This is in the case of using the device on a fixed longitude and latitude. The latitude and longitude are set using constants in the program, YOUR_LAT and YOUR_LONG. To get the longitude and latitude, you can use the website latlong.net.

The code is also designed to work, if GPS is enabled, to calculate the Qibla direction when GPS_EN is set to 1. The receiver used works with the Adafruit_GPS library and is the Adafruit Mini GPS receiver. The GPS need to have what is called a “fix” in order to operate. The fix can not be achieved commonly without an open sky.

Tilt Compensation 

Most of the qiblah devices do not discuss the error caused by tilting the device, including pitching and rolling. It assumes to work on a flat surface which is an ideal case. The equation used in the magnetometer to calculate the direction assumes to have a flat surface. The solution of that problem is to preprocess the Magnetometer and tilt compensation. This plainly means to emulate that the device is on a flat surface, so the direction equation will be true.

The error of the compass was caused by the tilt. The compensated compass angle was almost not affected by tilting the device.

A lot of application notes discuss the tilt compensation, and I recommend  Infineon-AN2272. It was explained in detail the frames and rotation matrixes in the third part of the published IMU serise. The rotation matrix used for tilt compensation is: 

The first part of the published IMU serise discusses in detail how to calculate the pitch and roll angles. 

Calculating Qiblah angle

The equation derived and used to calculate the Qiblah is found below. The correct qibla reference is used to get the equation.

is the prayer longtidude 

is the prayer latitude

is Kaaba longitude which is  21.422510

is Kaaba latitude which is 39.826168

References

http://nurlu.narod.ru/qibla.pdf 

https://www.mikrocontroller.net/attachment/292888/AN4248.pdf

https://www.nxp.com/files-static/sensors/doc/app_note/AN3461.pdf

https://www.infineon.com/dgdl/Infineon-AN2272_PSoC_1_Sensing_Magnetic_Compass_with_Tilt_Compensation-ApplicationNotes-v04_00-EN.pdf

Exit mobile version