354
Ariffin and Arsad [5] further demonstrated that by
using accelerometers, gyro sensors, and GNSS signals
to correct gyro sensors, due north could be detected
from multiple locations. Note that these studies have
the following issues.
− The utilization of these devices poses a significant
challenge due to their substantial physical
dimensions, which complicates their effective
transportation.
− The existence of a horizontal platform and a
mechanism capable of altering the azimuth angle is
imperative.
− Precise determination of the northward direction is
not feasible under an inclined condition due to the
utilization of an accelerometer in the calculation of
the angle.
− The verification process in instances where the
precise direction of due north remains unknown
has not been undertaken.
− The time required to detect due north is not
discussed in any detail.
The objective of this study is to develop a portable
due north detection system that can be utilized in non-
horizontal and magnetic disturbance environments,
which can be mounted on UUVs. The system is
composed of a low-cost MEMS sensor and a small 3-
axis turntable. The small 3-axis turntable has the
capacity to rotate 360° in each axis and has a function
that automatically searches for and maintains the
horizontal position. The signal measurement and
signal processing for the low-cost MEMS sensor is
performed by Raspberry Pi. Firstly, an investigation
was conducted into the horizontal holding
functionality of the proposed system. By measuring the
acceleration while rotating the proposed system, the
tilt of each axis can be obtained. The level can be
maintained by rotating the proposed system to
opposite direction to cancel the tilt. Based on these
studies, an experiment on due north detection was
conducted. In the experiment, the orientation of the
building at the measurement point was estimated from
a map, and then the proposed system was fixed. In the
initial experiment, the proposed system was rotated in
four distinct directions. The signals obtained were then
analyzed to identify the direction of each. The objective
of this experiment is to ascertain whether the proposed
system can accurately identify the four directions when
the device is rotated in a known direction.
Additionally, the coefficients to be employed in the
calculations were determined. Firstly, the proposed
system was rotated in 16 directions, and due north
detection was performed based on the results of fitting
a cosine curve to the obtained signals. In Section 1 the
background and objectives of this paper are described.
In Section 2, an overview of the proposed equipment is
provided. In Section 3 the signal processing methods
are explained in detail. In Section 4 the experimental
results and discussions are presented. Finally, in
Section 5 the obtained findings are summarized.
2 PROPOSED SYSTEM
The proposed system consists of a low-cost MEMS
sensor (acceleration: ADXL355 and angular velocity:
MPU9250) and a small 3-axis turntable. The small 3-
axis turntable utilizes a low-cost stepper motor (28BYJ-
48), capable of rotating 360° around the x-, y-, and z-
axes, respectively. The proposed system, coordinate
system, and rotation direction are illustrated in Figure
1. As illustrated in the figure, a stepper motor is
positioned around the MEMS sensor, thereby is not
possible of utilizing a magnetic sensor due to the
constant disruption of the magnetic field by the motor
drive. And the red arrows in the figure show the
coordinate system employed in the proposed system,
which is a right-handed system with the z-axis
pointing downward. The orange arrows in the figure
indicate the positive direction of rotation ϕ, θ, and ψ
indicate rotation about the x-, y-, and z- axes,
respectively. The stepper motor (28BYJ-48) utilized in
this study possesses a step angle of 5.63°/64 (output
shaft, gear reduction ratio 1/64), a mass of
approximately 35 g, and a rotational torque of 800 gf-
cm [6] In the proposed system, the angular velocities
regarding ϕ and θ, are configured to complete a 360°
rotation within 512 steps, while the angular velocity
regarding ψ, is configured to complete a 360° rotation
within 2048 steps. This is achieved through the
utilization of gears in the device. It is evident that ϕ and
θ rotate 7.03×10
-1
° in one step and ψ rotates 1.76×10
-1
°
in one step. The rotation is transmitted via Pulse Width
Modulation (PWM) control from the Raspberry Pi’s
four General Purpose Input/Output (GPIO) pins. The
PWM cycles were determined as 0.01 s through a
process of trial and error. The flow of signal processing
in the proposed system is illustrated in Figure 2.
Signals αn obtained from the accelerometer are
processed using the RKF to remove outliers. The
processed signals αn
r
are converted to rotation angles
using Equations 4 and 5. Furthermore, the data is
converted to rotation angles in the C-frame based on
Equations 6 and 7. These angles are then converted to
angular velocities, ωn
α
, through numerical
differentiation expressed by Equation 9. The angular
velocity, ωn
αr
, obtained from the final accelerometer, is
the consequence of the processing of ωn
α
with RKF.
Signals ωn
s
obtained from the gyro sensor are processed
using a RKF to remove outliers. The processed signals,
ωn
r
, are converted to angular velocities in the C-frame
using Equation 8. For due north estimation, the
weighted average value, ωn
f
, of the frequency
distribution of ωn
c
and ωn
αr
is used. This calculation is
performed using Equations 21 to 23.
Figure 1. Overview of proposed system, coordinate system,
and rotation direction.