Formulation of a new gradient descent MARG orientation algorithm: Case study on robot teleoperation

Samuel Wilson, Henry Eberle, Yoshikatsu Hayashi, Sebastian O.H. Madgwick, Alison McGregor, Xingjian Jing, Ravi Vaidyanathan

Research output: Journal article publicationJournal articleAcademic researchpeer-review

65 Citations (Scopus)


We introduce a novel magnetic angular rate gravity (MARG) sensor fusion algorithm for inertial measurement. The new algorithm improves the popular gradient descent (ʻMadgwick’) algorithm increasing accuracy and robustness while preserving computational efficiency. Analytic and experimental results demonstrate faster convergence for multiple variations of the algorithm through changing magnetic inclination. Furthermore, decoupling of magnetic field variance from roll and pitch estimation is proven for enhanced robustness. The algorithm is validated in a human-machine interface (HMI) case study. The case study involves hardware implementation for wearable robot teleoperation in both Virtual Reality (VR) and in real-time on a 14 degree-of-freedom (DoF) humanoid robot. The experiment fuses inertial (movement) and mechanomyography (MMG) muscle sensing to control robot arm movement and grasp simultaneously, demonstrating algorithm efficacy and capacity to interface with other physiological sensors. To our knowledge, this is the first such formulation and the first fusion of inertial measurement and MMG in HMI. We believe the new algorithm holds the potential to impact a very wide range of inertial measurement applications where full orientation necessary. Physiological sensor synthesis and hardware interface further provides a foundation for robotic teleoperation systems with necessary robustness for use in the field.

Original languageEnglish
Pages (from-to)183-200
Number of pages18
JournalMechanical Systems and Signal Processing
Publication statusPublished - 1 Sept 2019


  • Human-machine interface (HMI)
  • inertial measurement unit (IMU)
  • Inertial sensor fusion
  • mechatronic sensing
  • Robot teleoperation
  • Wearable sensors

ASJC Scopus subject areas

  • Control and Systems Engineering
  • Signal Processing
  • Civil and Structural Engineering
  • Aerospace Engineering
  • Mechanical Engineering
  • Computer Science Applications


Dive into the research topics of 'Formulation of a new gradient descent MARG orientation algorithm: Case study on robot teleoperation'. Together they form a unique fingerprint.

Cite this