Professional Documents
Culture Documents
A Novel Kalman Filter For Human Motion Tracking With An Inertial-Based Dynamic Inclinometer
A Novel Kalman Filter For Human Motion Tracking With An Inertial-Based Dynamic Inclinometer
Abstract—Goal: Design and development of a linear Kalman fil- measuring the angular velocity and the acceleration, respec-
ter to create an inertial-based inclinometer targeted to dynamic tively, of the body segment they are attached to; oftentimes,
conditions of motion. Methods: The estimation of the body atti- IMUs integrate a three-axis magnetic sensor to sense the earth’s
tude (i.e., the inclination with respect to the vertical) was treated
as a source separation problem to discriminate the gravity and the magnetic field. One task for which IMUs are used concerns the
body acceleration from the specific force measured by a triaxial estimation of the 3-D orientation (pitch, roll and heading angles)
accelerometer. The sensor fusion between triaxial gyroscope and of the body segment relative to an inertial reference frame [3],
triaxial accelerometer data was performed using a linear Kalman [4]. For some applications like fall detection one may be just
filter. Wrist-worn inertial measurement unit data from ten partic- interested in estimating the attitude (pitch and roll angles), in
ipants were acquired while performing two dynamic tasks: 60-s
sequence of seven manual activities and 90 s of walking at natu- which case the magnetic sensor may be not necessary [5]–[7].
ral speed. Stereophotogrammetric data were used as a reference. The 3-D orientation can be computed by integrating the gyro-
A statistical analysis was performed to assess the significance of scope output from known initial conditions. However, the errors
the accuracy improvement over state-of-the-art approaches. Re- incurred during integration tend to increase unbounded over
sults: The proposed method achieved, on an average, a root mean time, because of low-frequency drifts and wideband measure-
square attitude error of 3.6° and 1.8° in manual activities and lo-
comotion tasks (respectively). The statistical analysis showed that, ment noise affecting the gyroscope output [8]. The 3-D orienta-
when compared to few competing methods, the proposed method tion can also be computed using the accelerometer and magnetic
improved the attitude estimation accuracy. Conclusion: A novel sensor output when the body segment is motionless, in locations
Kalman filter for inertial-based attitude estimation was presented where the earth’s magnetic field is known, or can be accurately
in this study. A significant accuracy improvement was achieved measured [9]. Sensor fusion methods for orientation estimation
over state-of-the-art approaches, due to a filter design that better
matched the basic optimality assumptions of Kalman filtering. Sig- determination can be designed using approaches based either
nificance: Human motion tracking is the main application field of on Kalman filtering [3], [4], [10], [11] or nonlinear complemen-
the proposed method. Accurately discriminating the two compo- tary filtering [12], [13]. In this paper, we stick to the former
nents present in the triaxial accelerometer signal is well suited for approach; this decision was not intended to bias the preference
studying both the rotational and the linear body kinematics. between the two approaches, which is well beyond the scope
Index Terms—Accelerometer, attitude estimation, human mo- of this paper. It is noted that the orientation errors can become
tion tracking, inertial sensors, Kalman filtering. large due to external acceleration and magnetic disturbance.
The problem with a three-axis accelerometer being used for
I. INTRODUCTION attitude estimation (leveling) is that it is sensitive to both the
reaction to the earth’s gravitational field and the acceleration
HANKS to recent advances in the technology of micro-
T electromechanical systems, sensor devices have become
available, the size, power consumption and cost of which are
the sensor is subject to because of the body motion (external
acceleration) [6], [11], [14]. As a matter of fact, humans move in
such a manner that the external acceleration is time-varying and
suited to the design of wearable sensor systems for several can be high in dynamic conditions, i.e., fast motions, in contrast
applications in biomedical engineering and health informatics with the situation when the human body takes static or quasi-
[1], [2]. An example of this technology trend is given by the static postures (slow motions). In conditions of slow motions
availability of inertial measurement units (IMUs). IMUs inte- the gravity acceleration dominates the external acceleration, and
grate a three-axis gyroscope and a three-axis accelerometer for the three-axis accelerometer can provide accurate estimates of
attitude [15]. To achieve high accuracy in conditions of fast
Manuscript received December 11, 2014; revised February 5, 2015 and March
5, 2015; accepted March 5, 2015. Date of publication March 9, 2015; date of motions, it is necessary to discriminate between the gravity
current version July 15, 2015. This work was supported by the Italian Min- acceleration and the external acceleration.
istry of Education and Research under the relevant national interest project “A Kalman filters (KFs) and extended Kalman filters (EKFs) are
Quantitative and Multifactorial Approach for Estimating and Preventing the
Risk of Falls in Elderly People,” and by the EC funded Project I-DONT-FALL the preferred sensor fusion methods for estimating the attitude
“Integrated Prevention and Detection Solutions Tailored to the Population and (orientation) using IMUs [14]. Different approaches to their de-
Risk Factors Associated With Falls” (CIP-ICT-PSP-2011-5-297225). Asterisk sign have been proposed to deal with the problem of the external
indicates corresponding author.
∗ G. Ligorio is with the BioRobotics Institute, Scuola Superiore Sant’Anna, acceleration, i.e., the threshold-based switching approach and
Pisa 56025, Italy (e-mail: g.ligorio@sssup.it). the acceleration model-based approach [6].
A. M. Sabatini is with Scuola Superiore Sant’Anna. In the threshold-based approach, also known as vector selec-
Color versions of one or more of the figures in this paper are available online
at http://ieeexplore.ieee.org. tion, the measured acceleration is screened before being used in
Digital Object Identifier 10.1109/TBME.2015.2411431 the KF update [3], [16]. The norm of the measured acceleration
0018-9294 © 2015 IEEE. Personal use is permitted, but republication/redistribution requires IEEE permission.
See http://www.ieee.org/publications standards/publications/rights/index.html for more information.
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
2034 IEEE TRANSACTIONS ON BIOMEDICAL ENGINEERING, VOL. 62, NO. 8, AUGUST 2015
is tested against the magnitude of the gravity acceleration g gyroscope output, while the GM model is used to predict the
(g = 9.81 m/s2 ), or the directions of the measured accelera- body-frame external acceleration.
tion and the predicted gravity acceleration, resolved in the body Although the credibility of the stochastic modeling approach
frame, are compared. When the norm and/or the directional dif- for describing the external acceleration is uncertain, few basic
ferences exceed given threshold values, the measured accelera- assumptions that help making a Kalman-based filter optimal
tion is not retained by the KF [14], [17]. Alternatively, the weight are satisfied in our design: 1) the state transition model and the
given to the measured acceleration in updating the state estimate measurement model are both linear; 2) the measurement noise
may be adapted according to the values of the norm and/or the is white Gaussian noise with zero mean and known covariance
directional differences. In [11], the measurement noise covari- matrix. Usually, these assumptions are not met by most Kalman-
ance matrix was augmented in a component-wise fashion by based filters for attitude estimation, either because of the need
using an additive term, whose magnitude was proportional to for linearization of the process and/or measurement equations
the components of the innovation vector that are related to the [14], or because the process and/or measurement noise covari-
acceleration. ance matrices are state-dependent, e.g., [6], [19]. In particular,
On the other hand, the model-based approaches predict the it is known that linearization errors due to, e.g., wrong initial
external acceleration by means of an a priori model. In [18], conditions or incorrect modeling, affect filter convergence and
the body-frame coordinates of the gravity acceleration and the statistical consistency [19], [20].
earth’s magnetic field were treated as system’s state components Experimental testing was done with a wrist-worn IMU, while
and estimated using a KF, with the advantage of a great sim- subjects performed different tasks. Insights were provided into
plification in the formulation of the measurement model. The the operation of the proposed sensor fusion method, compared
KF prediction step was driven using the measured angular ve- with the sensor fusion methods proposed in [6], [14] and with
locity; however, in the KF update step external acceleration and the time integration of the gyroscope output. Based on reference
magnetic disturbances were both assumed to be zero. A Kalman measurements of attitude and external acceleration that were ob-
mechanization was presented in [6] for estimating the attitude tained using a stereophotogrammetric system, the performance
and the external acceleration. In a similar fashion to [18], the of the tested methods were assessed empirically and compared
state vector included the body-frame coordinates of the grav- with a statistical analysis.
ity acceleration and the body-frame external acceleration was
modeled with a first-order Gauss–Markov (GM) stochastic pro- II. METHODS
cess. The KF prediction step was implemented by predicting the
body-frame gravity acceleration (within the filter, using the gy- A. Notation and Reference Frames
roscope output), and the external acceleration (outside the filter, The reference frames necessary to the filter development are
using the GM model). The measured acceleration was compen- the navigation frame and the body frame. The navigation frame
sated for the predicted external acceleration and plugged into the {n} is earth-fixed; the Z-axis points downwards so that it is
measurement equation, giving rise to an identity matrix map- aligned with the gravity. The body frame {b}—attached to the
ping from the state to the measurements. Finally, the external IMU case—is the frame where the inertial sensor measurements
acceleration was updated by subtracting the updated estimate are delivered in. We intend to estimate the following quantities:
of the body-frame gravity acceleration from the measured ac- 1) the attitude of the IMU case relative to the navigation frame;
celeration. The main problem with the KF proposed in [6] is and 2) the external acceleration the IMU case is subject to
the correlation between prediction and update. In fact, predic- because of the body motion.
tion errors are responsible for correlated measurement errors, With gbk and abk we denote, respectively, the representation
because of the way the measurement are defined. of the gravity acceleration and the external acceleration in the
In this paper, we propose a Kalman-based sensor fusion body frame {b} at the kth sample time. Henceforth, 0n and In
method that aims at discriminating the gravity vector and the indicate the n × n null and identity matrices, respectively.
external acceleration in the specific force measured from the
accelerometer. The attitude (roll and pitch angles) is then com-
puted from the body-frame gravity outside the KF framework, B. Algorithm Development
using standard formulae. Compared to [6] the novelty is that the The basic task that the proposed KF attempts to accomplish
external acceleration is inserted in the system’s state together is the discrimination between the gravity acceleration and the
with the gravity, both resolved in the body frame. Thereby, external acceleration, namely the two components of the specific
the KF measurement equation describes the specific force as force actually measured by the IMU accelerometer
the sum of two components that add together in a linear and
time-invariant fashion. In other words, we cast the problem of fkb = −gkb + abk . (1)
estimating the attitude using inertial sensor measurements as an
instance of the classical source separation problem. The two acceleration components are stacked together to form
Moreover, the prediction of the external acceleration is de- the vector state
coupled from observations in the measurement equations of our b
gk
algorithm, in contrast with [6]. In our design, the KF predic- xk = . (2)
tion step of the body-frame gravity acceleration is driven by the abk
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
LIGORIO AND SABATINI: NOVEL KF FOR HUMAN MOTION TRACKING WITH AN INERTIAL-BASED DYNAMIC INCLINOMETER 2035
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
2036 IEEE TRANSACTIONS ON BIOMEDICAL ENGINEERING, VOL. 62, NO. 8, AUGUST 2015
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
LIGORIO AND SABATINI: NOVEL KF FOR HUMAN MOTION TRACKING WITH AN INERTIAL-BASED DYNAMIC INCLINOMETER 2037
obtained were similar among different motor tasks and among The RMSE θ of each variable θ of interest was computed as a
different subjects (standard deviation less than 0.3 Hz). Thus, function of the discrete time using the following equation:
the cutoff frequency value was conservatively set to 6 Hz for all
trials. Misalignment occurring between the marker frame and RMSEθ (kTs ) =
the body frame was preliminarily estimated and compensated
k
1
using the method proposed in [23]. (θest (iTs ) − θref (iTs ))2 , k = 1, ..., N (13)
The calibration of the accelerometer was checked using the k i=1
following approach. First, three static trials were acquired where
each IMU axis was consecutively aligned with the gravity direc- where θest (i Ts ) and θref (i Ts ) are the estimated and reference
tion for one minute. A plumb line was used to verify the correct value of θ at the time instant iTs , respectively. The sequence
alignment of each axis with the vertical line. The average gravity RMSEθ (kTs ) was used to produce the time plots, while its
acceleration measured along each axis was computed, and its final value, i.e., RMSEθ = RMSEθ (N Ts )was involved in the
value compared to g, and to zero, for the two components lying statistical analyses. The reference values were null when the es-
in the horizontal plane. As the maximal difference between the timations errors were involved in computing the RMSE values,
measured acceleration and g, or zero, never exceeded 0.02 m/s2 , in the case of RMSEatt , RMSEpitch and RMSEroll .
the accelerometer was considered as properly calibrated. The Limited to Method A and Method B, the components of the
magnetic sensor was calibrated as described in [14]. The IMU reference external acceleration were subtracted from the cor-
was freely rotated about each of the three local axes for about responding components of the estimated external acceleration
60 s, and the offset and scale factor of the magnetic sensor were to compute RMSE x , RMSEy and RMSEz and the performance
estimated. metric RMSEt = RMSE2x + RMSE2y + RMSE2z .
The gyroscope bias was estimated by averaging the measured
The statistical analysis aimed at answering the following
angular velocity during the initial rest period at the beginning
questions concerning the attitude estimates: 1) the effect of the
of each trial; the estimated bias was then subtracted from all
factor method, so as to state the significance of differences exist-
gyroscope measurements made during the trial.
ing in the level of accuracy between each sensor fusion method
All methods were initialized using accelerometer data at the
(Methods A through C) and Method D; 2) the effect of the fac-
beginning of each experimental trial, for computing either the
tor task, so as to state the significance of differences existing
gravity in the body frame (Method A, B, and D), or the initial
in the level of accuracy between manual routine and locomo-
quaternion (Method C, [14]).
tion tasks. To answer 1) a repeated measures one-way ANOVA
was conducted with within-subject effect method (four levels,
E. Accuracy Assessment and Statistical Analysis corresponding to Method A through Method D), separately for
each motion task; the RMSEatt was the dependent variable. To
The marker trajectories were processed to compute marker-
answer 2) an independent samples t-test was applied, for each
based estimates of pitch and roll angles (reference attitude)
method, to the RMSEatt values obtained in the manual routine
[24]. The quaternion from the body frame to the navigation
and locomotion tasks.
frame was computed, from which the quaternion describing
The statistical analysis aimed at assessing the effects of the
only the attitude was derived (reference quaternion, qref ); the
factors method and task. As for the factor method, a paired sam-
estimates of the reference attitude and Euler angles (pitch and
ples t-test was conducted separately for each motion task to state
roll) were derived using standard methods [21]. It should be
the significance of differences existing in the level of accuracy
noted that the stereo-photogrammetric errors [25] propagate to
between methods; the RMSEt was the dependent variable. As
the angles of interest in this study causing a maximal inaccuracy
for the factor task, an independent samples t-test was applied,
of 0.5°. The central-time finite-difference approximation to the
for each method, to the RMSEt values obtained in the manual
second derivative of the coordinates of the centroid of the four IR
routine and locomotion tasks.
markers was taken to generate the external acceleration, which
The statistical analysis was performed using IBM SPSS
was rotated in the body frame using the quaternion from the body
Statistics software package (IMB SPSS Statistics 22, SPSS IBM,
frame to the navigation frame, yielding the reference external
New York, USA).
acceleration.
The estimated quaternion qest describing only the attitude,
was computed from the estimated gravity (Method A, B, and D) F. Filter Tuning
or from the full quaternion (Method C) [9]. The error quaternion Four tuning parameters were required by Method A and
qe = qest ⊗ q−1 ref was then derived (⊗ denote the quaternion Method B, namely: the standard deviation of the gyroscope
product). The scalar part of the quaternion error was involved measurement noise, which enters the process noise covariance
in computing the attitude error [14]; the errors incurred in the matrix Qk −1 via (8); the standard deviation of the accelerometer
pitch and roll angles were derived from the quaternion error measurement noise, which determines the isotropic measure-
using standard conversion formulae. ment noise covariance matrix R; the task-dependent parameters
The accuracy assessment for all Methods A through D was ca and cb , which enter the calculation of Qk −1 (Method A)
performed using the root mean square error (RMSE) metric. or help to introduce an element of adaptation in the matrix R
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
2038 IEEE TRANSACTIONS ON BIOMEDICAL ENGINEERING, VOL. 62, NO. 8, AUGUST 2015
Fig. 3. Tuning results: (a) RMSEs obtained for the attitude estimation in the manual routine task; (b) RMSEs obtained for the external acceleration in the manual
routine task; (c) RMSEs obtained for the attitude estimation in the locomotion task; (d) RMSEs obtained for the external acceleration in the locomotion task—The
black solid lines refer to the tuning results for method B. The colored dashed lines refer to method A, when the parameter cb was varied.
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
LIGORIO AND SABATINI: NOVEL KF FOR HUMAN MOTION TRACKING WITH AN INERTIAL-BASED DYNAMIC INCLINOMETER 2039
TABLE II
TUNING PARAMETERS FOR METHOD C
Fig. 5. (a) RMSE p itch , RMSE ro ll , RMSE a tt boxplots for the four tested
methods. (b) RMSEt boxplots for Method A and Method B—locomotion task.
Fig. 4. (a) RMSE p itch , RMSE ro ll , RMSE a tt boxplots for the four tested
methods. (b) RMSEt boxplots for Method A and Method B—manual routine
task.
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
2040 IEEE TRANSACTIONS ON BIOMEDICAL ENGINEERING, VOL. 62, NO. 8, AUGUST 2015
Fig. 7. Representative trial of the manual routine task. (a) Reference atti- Fig. 8. Representative trial of the locomotion task. (a) Reference attitude; (b)
tude; (b) Norm of the reference acceleration; (c) RMSE a tt for the four tested Norm of the reference acceleration; (c) RMSE a tt for the four tested methods;
methods; d) RMSE t for Method A and Method B. (d) RMSE t for Method A and Method B.
For each tested method, independent samples t-tests were T ∼ 30 s) [see Fig. 7(c)]. The external acceleration estimation
conducted on the RMSEatt obtained in the locomotion and errors increased over time too. It is noted in the RMSEatt time
manual routine tasks. Statistical significance of the indepen- plot that the error growth rate of Method D was faster than for
dent samples t-test was achieved for all methods (p < 0.01), other tested methods. The RMSEt time plots of Method A and
after verifying that the assumption of equal variance was not Method B look very similar to each other [see Fig. 7(d)]. Fig. 8
violated in all cases (Levene’s test—Method A: F = 0.16, p = shows the time plots of (a) the reference attitude angle, (b) the
0.70; Method B: F = 1.00, p = 0.33; Method C: F = 3.88, norm of the reference acceleration, (c) the RMSEatt and (d) the
p = 0.06; Method D: F = 0.91, p = 0.35). RMSEt time plots, for one representative trial of the locomo-
The RMSEt values were submitted to a paired sam- tion task. Although the reference acceleration norm tended to be
ples t-test. For the locomotion task, the significant differ- smaller than in the case of the manual routine trial of Fig. 7(b),
ence SD between Method B and Method A and the related it is apparent from Fig. 8(b) that no resting periods occurred,
95% confidence interval CI were as follows: SD = 0.02m/s2 because of the swinging motion of the instrumented upper limb.
(CI[0.01m/s2 0.03m/s2 ], p < 0.05); the marginal mean for The acceptance rate of the acceleration measurements by the
Method A was 1.31 m/s2 . For the manual routine task, the threshold-based switching approach implemented in Method C
significant difference SD between Method B and Method was less than 1%, on average. The mean value of the reference
A and the related 95% confidence interval CI were as fol- acceleration norm averaged across trials was 3.32 ± 1.10 m/s2 ;
lows: SD = 0.04m/s2 (CI[0.02m/s2 0.07m/s2 ], p < 0.01); the the maximum value was 9.29 ± 2.26 m/s2 . As above, the attitude
marginal mean for Method A was 1.72 m/s2 . errors incurred by Method D grew faster than those incurred,
For both tested methods, independent samples t-tests were e.g., by Method A [see Fig. 8(c)]. The RMSEt time plots of
conducted on the RMSEt obtained in the locomotion and manual Method A and Method B look very similar to one another [see
routine tasks. Statistical significance of the independent samples Fig. 8(d)].
t-test was achieved (p < 0.05), after verifying that the assump- Finally, limited to Method A, the time plots of the estimation
tion of equal variance was not violated in both cases (Levene’s errors, either for the attitude or the external acceleration, are
test—Method A: F = 0.37, p = 0.55; Method B: F = 0.47, reported for another representative trial of the manual routine
p = 0.50). task, together with the corresponding norm of the reference
Fig. 7 shows time plots of (a) the reference attitude angle, external acceleration (see Fig. 9).
(b) the norm of the reference acceleration, (c) the RMSEatt
and (d) the RMSEt for one representative trial of the manual
routine task. Some resting periods are seen to occur during the IV. DISCUSSIONS
trial [see Fig. 7(b)]. The acceptance rate of the acceleration The filter tuning of Method A is very simple. As reported
measurements by the threshold-based switching approach im- in Fig. 3, filter performance seems not to change significantly
plemented in Method C was about 22%, on average. The mean over a broad interval of values of ca (true, within the limits of
value of the reference acceleration norm averaged across trials the present investigation), which simplified our choice (for both
was 2.05 ± 0.60 m/s2 (mean value ± standard deviation); the motion tasks, ca = 0.01). The difference in the values of cb ,
maximum value was 14.44 ± 6.53 m/s2 . The attitude estimation and the fact that the process noise levels were higher for the
errors tended to grow over time, with a somewhat steep in- locomotion task than for the manual routine task [see (10)], can
crease observed at the onset of the brushing teeth activity (time be given the following interpretation: When the process noise
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
LIGORIO AND SABATINI: NOVEL KF FOR HUMAN MOTION TRACKING WITH AN INERTIAL-BASED DYNAMIC INCLINOMETER 2041
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
2042 IEEE TRANSACTIONS ON BIOMEDICAL ENGINEERING, VOL. 62, NO. 8, AUGUST 2015
to consider other stochastic models, such as the higher-order at the wrist, the proposed method achieved good attitude es-
autoregressive model adopted, e.g., in [5]. timation accuracy: on average, RMSEatt = 3.6◦ (about 60-s
The factor task was significant when we submitted all meth- long sequence of various manual activities of daily living) and
ods (RMSEatt ) and Methods A–B (RMSEt ) to statistical RMSEatt = 1.8◦ (90-s long walking at natural speed).
analysis. The results of this analysis show that all methods Further developments of the present study are in the follow-
tended to be more accurate during the locomotion task than ing directions: 1) to assess the effects of using higher-order
during the manual routine task. Under this regard, the man- autoregressive models for the external acceleration; 2) to per-
ual routine task would be considered more challenging than form gyro-bias compensation for tracking longer motion tasks;
the locomotion task. However, it comes as a surprise that 3) to extend the proposed approach to magneto/inertial measure-
Method D performed differently in the two motion tasks: The ment units in order to encompass other reference and measured
marginal means were RMSEatt = 2.50◦ ± 0.91◦ (locomotion vectors, i.e., the earth’s magnetic field.
task) and RMSEatt = 9.29◦ ± 4.51◦ (manual routine task), in
spite that random walk integration of gyroscope measurement
noise would have had a slightly greater effect on the longer ACKNOWLEDGMENT
locomotion task (lasting about 90 s) rather than on the manual The authors would like to thank A. Cappozzo and his col-
routine task, which lasted about 60–70 s. As shown in Figs. 7–8, leagues at the Department of Movement, Human and Health
the dynamic range of attitude was much larger for the manual Sciences, University of Rome “Foro Italico,” where the exper-
routine task than for the locomotion task, which may explain iments providing the data for this paper were planned and per-
the different level of performance in the presence of residual formed. They would also like to thank them for the intensely
calibration errors of the gyro. stimulating discussions during the progress of the study.
Finally, the plots in Fig. 9 reveal the extent to which the
accuracy of Method A was restored when the external acceler-
ation was small, namely when conditions of slow motions were REFERENCES
met during the motion task. Our results confirm those reported
by [6]. The Test B in [6] was characterized by a reference [1] H. Zhou and H. Hu, “Human motion tracking for rehabilitation—A sur-
vey,” Biomed. Signal Process. Control, vol. 3, pp. 1–18, 2008.
acceleration norm with mean value 3.06 m/s2 and maximum [2] W. Tao et al., “Gait analysis using wearable sensors,” Sensors, vol. 12,
value 16.71 m/s2 , which are comparable to those measured for pp. 2255–2283, 2012.
the manual routine task, although the duration of Test B was [3] A. M. Sabatini, “Quaternion-based extended Kalman filter for determining
orientation by inertial and magnetic sensing,” IEEE Trans. Biomed. Eng.,
limited to about 10 s. The plots in Fig. 9 also show that the vol. 53, no. 7, pp. 1346–1356, Jul. 2006.
acceleration estimation error is not negligible with respect to [4] X. Yun and E. R. Bachmann, “Design, implementation, and experimen-
the norm of the reference external acceleration. In addition to tal results of a quaternion-based kalman filter for human body motion
tracking,” IEEE Trans. Robot., vol. 22, no. 6, pp. 1216–1227, Dec. 2006.
the aforementioned problem of adopting a stochastic approach [5] H. J. Luinge and P. H. Veltink, “Inclination measurement of human move-
to modeling the external acceleration, we have also to consider ment using a 3-D accelerometer with autocalibration,” IEEE Trans. Neural
that the accelerometer output is influenced by jolting shocks and Syst. Rehabil. Eng., vol. 12, no. 1, pp. 112–121, Mar. 2004.
[6] J. K. Lee et al., “Estimation of attitude and external acceleration using
vibrations from impacts of the body with the ground and tremu- inertial sensor measurement during various dynamic conditions,” IEEE
lous motions of the body, which can add to the error budget of Trans. Instrum. Meas., vol. 61, no. 8, pp. 2262–2273, Aug. 2012.
the external acceleration estimates since the stereophotogram- [7] G. Wu and X. Shuwan, “Portable preimpact fall detector with iner-
tial sensors,” IEEE Trans. Neural Syst. Rehabil. Eng., vol. 16, no. 2,
metric reference data are much less affected by them. pp. 178–183, Apr. 2008.
[8] A. M. Sabatini, “Inertial sensing in biomechanics: A survey of compu-
tational techniques bridging motion analysis and personal navigation,” in
Computational Intelligence for Movement Sciences: Neural Networks and
V. CONCLUSION Other Emerging Techniques. Hershey, PA, USA: Idea Group, 2006.
In this paper, a KF-based method was proposed to discrim- [9] X. Yun et al., “A simplified quaternion-based algorithm for orientation
estimation from earth gravity and magnetic field measurements,” IEEE
inate between the external acceleration and the gravity accel- Trans. Instrum. Meas., vol. 57, no. 3, pp. 638–650, Mar. 2008.
eration. The main feature of the proposed method lies in the [10] J. K. Lee and E. J. Park, “A fast quaternion-based orientation optimizer via
incorporation of the external acceleration into the system’s state virtual rotation for human motion tracking,” IEEE Trans. Biomed. Eng.,
vol. 56, no. 5, pp. 1574–1582, May 2009.
(via a first-order GM stochastic model), together with the grav- [11] Y. S. Suh, “Orientation estimation using a quaternion-based indirect
ity acceleration, both resolved in the body frame. This choice of Kalman filter with adaptive estimation of external acceleration,” IEEE
system’s state variables leads to design a linear Kalman-based Trans. Instrum. Meas., vol. 59, no. 12, pp. 3296–3305, Dec. 2010.
[12] S. O. Madgwick et al., “Estimation of IMU and MARG orientation using
estimator. An important limitation of the proposed approach lies a gradient descent algorithm,” in Proc. IEEE Rehabil. Robots Int. Conf.,
in the difficulty to use a stochastic model for describing the ac- 2011, pp. 1–7.
celeration of human motions. Consequently, the prediction of [13] R. Mahony et al., “Nonlinear complementary filters on the special orthog-
onal group,” IEEE Trans. Autom. Control, vol. 53, no. 5, pp. 1203–1218,
the components of the state vector describing the external accel- Jun. 2008.
eration may be inaccurate, although useful from the viewpoint [14] A. M. Sabatini, “Estimating three-dimensional orientation of human body
of estimating the attitude. parts by inertial/magnetic sensing,” Sensors, vol. 11, pp. 1489–1525, 2011.
[15] P. H. Veltink et al., “Detection of static and dynamic activities us-
When tested in conditions of dynamic motions, i.e., manual ing uniaxial accelerometers,” IEEE Trans. Rehabil. Eng., vol. 4, no. 4,
routine and locomotion tasks, with subjects wearing the IMU pp. 375–385, Dec. 1996.
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.
LIGORIO AND SABATINI: NOVEL KF FOR HUMAN MOTION TRACKING WITH AN INERTIAL-BASED DYNAMIC INCLINOMETER 2043
[16] J. K. Lee and E. J. Park, “Minimum-order kalman filter with vector selector [22] E. Bergamini et al., “Estimating orientation using magnetic and inertial
for accurate estimation of human body orientation,” IEEE Trans. Robot., sensors and different sensor fusion approaches: Accuracy assessment in
vol. 25, no. 5, pp. 1196–1201, Oct. 2009. manual and locomotion tasks,” Sensors, vol. 14, pp. 18625–18649, 2014.
[17] T. Harada et al., “Development of a tiny orientation estimation device [23] J. Chardonnens et al., “An effortless procedure to align the local frame of
to operate under motion and magnetic disturbance,” Int. J. Robots. Res., an inertial measurement unit to the local frame of another motion capture
vol. 26, pp. 547–559, 2007. system,” J. Biomechanics, vol. 45, pp. 2297–2300, 2012.
[18] R. Zhu and Z. Zhaoying, “A real-time articulated human motion tracking [24] G. S. Faber et al., “A novel method for assessing the 3-D orienta-
using tri-axis inertial/magnetic sensors package,” IEEE Trans. Neural Syst. tion accuracy of inertial/magnetic sensors,” J .Biomechanics, vol. 46,
Rehabil. Eng., vol. 12, no. 2, pp. 295–302, Jun. 2004. pp. 2745–2751, 2013.
[19] D. Choukroun et al., “Novel quaternion Kalman filter,” IEEE Trans. [25] L. Chiari et al., “Human movement analysis using stereophotogrammetry:
Aerosp. Electron. Syst., vol. 42, no. 1, pp. 174–190, Jan. 2006. Part 2: Instrumental errors,” Gait Posture, vol. 21, pp. 197–211, 2005.
[20] Y. Bar-Shalom et al., Estimation With Applications to Tracking and Nav- [26] R. Takeda et al., “Gait analysis using gravitational acceleration measured
igation: Theory Algorithms and Software. New York, NY, USA: Wiley, by wearable sensors,” J. Biomechanics, vol. 42, pp. 223–233, 2009.
2004.
[21] M. D. Shuster, “A survey of attitude representations,” Navigation, vol. 8,
pp. 439–517, 1993. Authors’ photographs and biographies not available at the time of publication.
Authorized licensed use limited to: INSTITUTO FEDERAL DO ESPIRITO SANTO. Downloaded on July 30,2020 at 01:45:13 UTC from IEEE Xplore. Restrictions apply.