CN112902828B - Angle calculation method - Google Patents

Angle calculation method Download PDF

Info

Publication number
CN112902828B
CN112902828B CN202110067897.XA CN202110067897A CN112902828B CN 112902828 B CN112902828 B CN 112902828B CN 202110067897 A CN202110067897 A CN 202110067897A CN 112902828 B CN112902828 B CN 112902828B
Authority
CN
China
Prior art keywords
angle
quaternions
axis
vectors
mould
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110067897.XA
Other languages
Chinese (zh)
Other versions
CN112902828A (en
Inventor
高照
祝小波
寇晓洁
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shaanxi Fuyin Prosthetic Co ltd
Original Assignee
Shaanxi Fuyin Prosthetic Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shaanxi Fuyin Prosthetic Co ltd filed Critical Shaanxi Fuyin Prosthetic Co ltd
Priority to CN202110067897.XA priority Critical patent/CN112902828B/en
Publication of CN112902828A publication Critical patent/CN112902828A/en
Application granted granted Critical
Publication of CN112902828B publication Critical patent/CN112902828B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/30Measuring arrangements characterised by the use of electric or magnetic techniques for measuring angles or tapers; for testing the alignment of axes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/004Measuring arrangements characterised by the use of electric or magnetic techniques for measuring coordinates of points
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Measuring Magnetic Variables (AREA)
  • Image Analysis (AREA)

Abstract

The invention discloses an angle calculation method, which comprises the following steps: establishing three dimension vectors corresponding to the object posture, and determining an initial model state of the object in space; the acceleration, angular velocity and magnetometer data of the collected object are brought into an algorithm to obtain quaternions describing the current gesture of the object; and respectively inserting the defined three-dimensional vectors into 0 to convert the vectors into quaternions, respectively carrying out rotation change calculation on the three quaternions according to the calculated quaternions to obtain three quaternions of the object after spatial rotation, taking the real parts of the three quaternions to obtain three vectors, respectively representing the coordinates of the axis of the object after rotation under a Cartesian coordinate system, and calculating the pitch angle, the roll angle and the yaw angle of the object according to the obtained three-dimensional vectors. The method eliminates the problem of dead lock of the universal joint of the Euler angle, and is a brand new angle calculation mode.

Description

Angle calculation method
Technical Field
The invention relates to the technical field of angle measurement, in particular to an angle calculation method.
Background
The angle measurement is applied to many aspects of daily life, such as measurement of the joint movement angle of a human body, the prior art is divided into a traditional detection mode and detection by using an MEMS device, the traditional detection mode uses a horizontal instrument and an angle caliper to detect, and the more advanced MEMS device has certain convenience for detecting the angle by fusing acceleration, angular velocity and Euler angle or quaternion generated by a magnetometer of the MEMS.
Because the traditional detection utilizes the characteristics of human error and inconvenience of a horizontal instrument or an angle caliper, the prior art mostly uses Euler angles or quaternions generated after data acquisition and data fusion of MEMS devices to detect, but the Euler angles have the problem of universal joint deadlock, when one rotating shaft is at a certain angle, the angle data of the other shaft is seriously influenced, and the quaternions are not favorable for understanding of people in the application field due to the very abstract expression mode, so the problem to be solved is urgent.
Disclosure of Invention
Aiming at the defects existing in the prior art, the invention aims to solve the technical problems of euler angle universal joint deadlock and quaternion display abstraction, and provides a brand-new angle calculation method.
In order to achieve the above task, the present invention adopts the following technical solutions:
the angle calculation method is characterized by comprising the following specific implementation steps:
step S1: the three dimension vectors corresponding to the object posture are established as follows: x (1, 0), y (0, 1, 0), z (0, 1), determining an initial model state of the object in space;
step S2: the acceleration, angular velocity and magnetometer data of the acquired object are brought into a madgwick algorithm to obtain quaternion q (w, x, y, z) describing the current gesture of the object;
step S3: respectively inserting 0 into the vectors of three dimensions defined in the step S1 to be converted into quaternions, marking the quaternions as qx0 (0, 1, 0), qy0 (0, 1, 0), qz0 (0, 1), and then respectively carrying out rotation change calculation on the three quaternions of qx0, qy0 and qz0 according to the quaternions q (w, x, y, z) obtained by calculation in the step S2 to obtain three quaternions of the object after spatial rotation, and taking the real parts of the three quaternions to obtain three vectors, wherein the three vectors respectively represent the coordinates of x, y and z axes of the object after rotation under a Cartesian coordinate system, and are marked as x1 (xx ', xy ', xz '), y1 (yx ', yy ', yz ') and z1 (zx ', zy, zz);
step S4: according to the three-dimensional vector obtained in the step S3, the pitch angle, the roll angle and the yaw angle of the object are obtained through the following calculation:
solving a pitch angle: selecting an x-axis vector x1 (xx ', xy', xz '), dividing xz' by 1 to obtain a sine value of a pitch angle, and then obtaining the pitch angle value by the inverse of the sine value, namely:
sinx=xz`/1;
pitch=arcsinx×180/π;
and (5) obtaining a yaw angle: selecting an x-axis vector x1 (xx ', xy', xz '), dividing the xy' coordinate by 1 to obtain a sine value of the yaw angle, and then obtaining the yaw angle value by the inverse of the sine value, namely:
sinz=xy`/1;
yaw=arcsinz×180/π;
and (5) calculating a roll angle: selecting a y-axis vector y1 (yx ', yy', yz '), dividing the yz' coordinate by 1 to obtain a sine value of the roll angle, and then obtaining the roll angle value by solving the inverse of the sine value, namely:
siny=yz`/1;
roll=arcsiny×180/π。
according to the present invention, the computation process of qx1, qy, qz1 calculated in step S3 is as follows:
first, a conjugated quaternion q-1 of quaternion q (w, x, y, z) is obtained, namely:
mould=w*w+x*x+y*y+z*z;
q-1=(w/mould,-x/mould,-y/mould,-z/mould);
the second step is to calculate three quaternions after rotation, wherein the calculation formula of the cross multiplication of the quaternions is as follows:
q×x=((wi*xi+wx*xi+wy*xz-wz*xy);
(wi*xy-wx*xz+wy*xi+wz*xx);
(wi*xz+wx*xy-wy*xx+wz*xi);
(wi*xi-wx*xx-wy*xy-wz*xz));
thus, qx1=qxqx0×q-1 can be finally obtained from qx0 to obtain the transformed object x-axis quaternion qx1 (xw ', xx', xy ', xz');
similarly, qy (yi ', yx', yy ', yz') and qz1 (zi ', zx', xy ', zz') can be obtained;
qx1, qy, the real part of qz1 is the x-axis, y-axis and z-axis coordinates of the object with changed posture in the cartesian coordinate system, and the coordinates are respectively expressed as: x1 (xx ', xy ', xz '), y1 (yx ', yy ', yz '), z1 (zx ', xy ', zz ').
The angle calculation method has the beneficial effects that the problem of dead lock of the universal joint of the Euler angle is solved, and the angle calculation method is a brand new angle calculation mode.
Drawings
FIG. 1 is a schematic flow chart of an angle calculation method of the present invention;
FIG. 2 is an illustration of an angle definition;
FIG. 3 is a pitch waveform;
FIG. 4 is a waveform of Euler angle pitch angle;
FIG. 5 is a waveform diagram of roll angle;
FIG. 6 is a waveform diagram of Euler angle roll angle;
FIG. 7 is a waveform diagram of yaw angle;
fig. 8 is a waveform diagram of euler angle yaw angle;
the present invention will be described in further detail with reference to the accompanying drawings and examples.
Detailed Description
As shown in fig. 1, the present embodiment provides an angle calculating method, including:
setting the sampling frequency of an angular velocity meter, an accelerometer and a magnetometer as 100Hz, calling a madgwick algorithm once every 100Hz, taking the values of the angular velocity, the acceleration and the magnetometer as input and then outputting quaternions q (w, x, y and z), and setting the deltaT of the madgwick algorithm, namely the sampling time interval as 1/100 seconds;
secondly, three vectors x (1, 0), y (0, 1, 0) and z (0, 1) corresponding to the object posture are established, and the initial model state of the object in the space is determined;
thirdly, inputting the acceleration, angular velocity and magnetometer data of the acquired object into a madgwick algorithm to obtain quaternion q (w, x, y, z) describing the current gesture of the object;
fourth, the vectors of three dimensions defined in the first step are respectively inserted into 0 to be changed into quaternions, and are marked as qx0 (0, 1, 0), qy0 (0, 1, 0), qz0 (0, 1), then the quaternions q (w, x, y, z) obtained by calculation according to S2 are respectively calculated on the three quaternions of qx0, qy0 and qz0 to obtain three quaternions of an object after space rotation, the real parts of the three quaternions are taken to obtain three vectors, the three vectors respectively represent the coordinates of x, y and z axes of the object after rotation in a Cartesian coordinate system, and are marked as x1 (xx ', xy ', xz '), y1 (yx '), yx ', yy ', yz 1 (zx, zz '), and the processes of calculating x1, y1, z1 are as follows,
firstly, a conjugated quaternion q-1 of quaternion q (w, x, y, z) is obtained:
mould=w*w+x*x+y*y+z*z;
q-1=(w/mould,-x/mould,-y/mould,-z/mould);
the second step of calculating the cross multiplication calculation formula of the quaternion after rotation is that
q×x=(wi*xi+wx*xi+wy*xz-wz*xy);
(wi*xy-wx*xz+wy*xi+wz*xx);
(wi*xz+wx*xy-wy*xx+wz*xi);
(wi*xi-wx*xx-wy*xy-wz*xz);
Thus, qx1=qxqx0×q-1 can be finally obtained from qx0 to obtain the transformed object x-axis quaternion qx1 (xw ', xx', xy ', xz');
similarly, qy (yi ', yx', yy ', yz') and qz1 (zi ', zx', xy ', zz') can be obtained;
the real parts of qx1, qy and qz1 are x-axis, y-axis and z-axis coordinates of the object with changed posture in a Cartesian coordinate system, and the coordinates are respectively x1 (xx ', xy ', xz '), y1 (yx ', yy ', yz ') and z1 (zx ', xy ', zz ');
fifthly, according to the three-dimensional vectors x1, y1 and z1 obtained in the fourth step, the pitch angle, the roll angle and the yaw angle of the object are obtained through the following calculation,
the pitch angle is calculated, an x-axis vector x1 (xx ', xy', xz ') is selected, xz' is divided by 1, the sine value of the pitch angle is calculated, and then the pitch angle value is calculated by inverting the sine value:
sinx=xz`/1;
pitch=arcsinx×180/π;
the yaw angle is calculated, an x-axis vector x1 (xx ', xy', xz ') is selected, the xy' coordinates are divided by 1 to calculate a sine value of the yaw angle, and then the sine value is inverted to calculate the yaw angle value:
sinz=xy`/1;
yaw=arcsinz×180/π;
the roll angle is calculated, a y-axis vector y1 (yx ', yy', yz ') is selected, the yz' coordinate is divided by 1 to calculate the sine value of the roll angle, and then the sine value is inverted to calculate the roll angle value:
siny=yz`/1;
roll=arcsiny×180/π。
as shown in FIG. 2, an angle definition is shown, wherein, when the pitch angle is X1, a point p1 (xx ', xz') is obtained by making a vertical line to an XOZ plane, and an included angle between a connecting line of p1 and an origin O and an X-axis positive half axis is defined as the pitch angle; wherein, the yaw angle is that a point p2 (xx ', xy') is obtained by making a vertical line from X1 to the XOY plane, and an included angle between a connecting line of p2 and an origin O and an X-axis positive half axis is defined as the yaw angle; the roll angle is that a point p3 (yy ', yz ') is obtained by making a perpendicular line from the Y1 plane to the YOZ plane, and an included angle between a connecting line of the yz ' and the origin O and a positive half axis of the Y axis is defined as the roll angle.
As shown in fig. 3 and 4, which are graphs showing the comparison waveforms of the pitch angle and the euler angle, wherein fig. 3 is a waveform in which an object obtained by using the angle calculation method of the present embodiment rotates 360 degrees around the Y axis from 0 degrees, and fig. 4 is a waveform in which an object obtained by using the euler angle rotates 360 degrees around the Y axis from 0 degrees, it can be seen that using the angle calculation method of the present embodiment, the obtained pitch angle variation trend is 0-90, 90-0,0- (-90), and the change of the pitch angle of the euler angle is 0-180, (-180) -0, and the obtained result does not affect the use of the angle calculation method given by the present embodiment as a whole.
As shown in fig. 5 and 6, which are respectively waveforms of roll angle and euler angle, in which fig. 5 is a waveform of an object rotated 360 degrees from 0 degrees around the X-axis by using the angle calculation method of the present embodiment, fig. 6 is a waveform of an object rotated 360 degrees from 0 degrees around the X-axis by using the euler angle, it is apparent from fig. 6 that there is a great change in pitch angle when the roll angle is around 90 degrees, which is in a state of a gimbal deadlock during which the pitch angle is always affected, and the pitch angle is gradually restored when the roll angle is restored from (-90) -0, and fig. 5 is a result obtained by using the angle calculation method of the present embodiment, it can be seen that the pitch angle and yaw angle of the object are not affected during the entire rotation.
Fig. 7 and 8 are waveform diagrams of yaw angle and euler angle yaw angle, respectively, in which fig. 7 is a waveform in which an object obtained by using the angle calculation method of the present embodiment is rotated 360 degrees around the Z axis from 0 degrees, and fig. 8 is a waveform in which an object obtained by using the euler angle is rotated 360 degrees around the Z axis from 0 degrees, it can be seen that using the calculation method of the present embodiment, yaw angle variation trend is 0-90, 90-0,0- (-90), and(-90) -0 undergoes four stages, and the pitch angle of the euler angle is changed to 0-360. In general, the results obtained with the calculation method given in this embodiment do not affect the use.

Claims (2)

1. The angle calculation method is characterized by comprising the following specific implementation steps:
step S1: the three dimension vectors corresponding to the object posture are established as follows: x (1, 0), y (0, 1, 0), z (0, 1), determining an initial model state of the object in space;
step S2: the acceleration, angular velocity and magnetometer data of the acquired object are brought into a madgwick algorithm to obtain quaternion q (w, x, y, z) describing the current gesture of the object;
step S3: respectively inserting vectors of three dimensions defined in the step S1 into 0 to be converted into quaternions, marking the quaternions as qx0 (0, 1, 0), qy0 (0, 1, 0), qz0 (0, 1), and then respectively carrying out rotation change calculation on the three quaternions of qx0, qy0 and qz0 according to the quaternions q (w, x, y, z) obtained by calculation in the step S2 to obtain three quaternions of the object after spatial rotation, taking the real parts of the three quaternions to obtain three vectors, wherein the three vectors respectively represent the coordinates of x, y and z axes of the object after rotation under a Cartesian coordinate system, and are marked as x1 (xx ', xy', xz '), y1 (yx', yy ', yz') and z1 (zx, zy ', zz');
step S4: according to the three-dimensional vector obtained in the step S3, the pitch angle, the roll angle and the yaw angle of the object are obtained through the following calculation:
solving a pitch angle: selecting an x-axis vector x1 (xx ', xy', xz '), dividing xz' by 1 to obtain a sine value of a pitch angle, and then obtaining the pitch angle value by the inverse of the sine value, namely:
sinx=xz`/1;
pitch=arcsinx×180/π;
and (5) obtaining a yaw angle: selecting an x-axis vector x1 (xx ', xy', xz '), dividing the xy' coordinate by 1 to obtain a sine value of the yaw angle, and then obtaining the yaw angle value by the inverse of the sine value, namely:
sinz=xy`/1;
yaw=arcsinz×180/π;
and (5) calculating a roll angle: selecting a y-axis vector y1 (yx ', yy', yz '), dividing the yz' coordinate by 1 to obtain a sine value of the roll angle, and then obtaining the roll angle value by solving the inverse of the sine value, namely:
siny=yz`/1;
roll=arcsiny×180/π。
2. the method of claim 1, wherein the calculating in step S3 is performed by qx1, qy1, and qz1 is performed by:
first, a conjugated quaternion q-1 of quaternion q (w, x, y, z) is obtained, namely:
mould=w*w+x*x+y*y+z*z;
q-1=(w/mould,-x/mould,-y/mould,-z/mould);
the second step is to calculate three quaternions after rotation, wherein the calculation formula of the cross multiplication of the quaternions is as follows:
q×x=((wi*xi+wx*xi+wy*xz-wz*xy);
(wi*xy-wx*xz+wy*xi+wz*xx);
(wi*xz+wx*xy-wy*xx+wz*xi);
(wi*xi-wx*xx-wy*xy-wz*xz);
thus, qx1=qxqx0×q-1 can be finally obtained from qx0 to obtain the transformed object x-axis quaternion qx1 (xw ', xx', xy ', xz');
similarly, qy (yi ', yx', yy ', yz') and qz1 (zi ', zx', xy ', zz') can be obtained;
qx1, qy, the real part of qz1 is the x-axis, y-axis and z-axis coordinates of the object with changed posture in the cartesian coordinate system, and the coordinates are respectively expressed as: x1 (xx ', xy ', xz '), y1 (yx ', yy ', yz '), z1 (zx ', xy ', zz ').
CN202110067897.XA 2021-01-19 2021-01-19 Angle calculation method Active CN112902828B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110067897.XA CN112902828B (en) 2021-01-19 2021-01-19 Angle calculation method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110067897.XA CN112902828B (en) 2021-01-19 2021-01-19 Angle calculation method

Publications (2)

Publication Number Publication Date
CN112902828A CN112902828A (en) 2021-06-04
CN112902828B true CN112902828B (en) 2023-09-08

Family

ID=76115451

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110067897.XA Active CN112902828B (en) 2021-01-19 2021-01-19 Angle calculation method

Country Status (1)

Country Link
CN (1) CN112902828B (en)

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2004101671A (en) * 2004-01-20 2005-07-20 Открытое акционерное общество "Опытно-конструкторское Бюро" Сокол" (RU) METHOD FOR MEASURING A MAGNETIC COURSE OF A MOBILE OBJECT AND A DEVICE FOR ITS IMPLEMENTATION
CN103153790A (en) * 2010-10-01 2013-06-12 希尔克瑞斯特实验室公司 Apparatuses and methods for estimating the yaw angle of a device in a gravitational reference system using measurements of motion sensors and a magnetometer attached to the device
CA2932782A1 (en) * 2015-06-12 2016-12-12 7725965 Canada Inc. Orientation model for inertial devices
CN107247157A (en) * 2017-05-10 2017-10-13 哈尔滨工程大学 Change the acquisition methods of Eulerian angles in a kind of quaternary number full-shape domain towards big attitude maneuver
CN107478223A (en) * 2016-06-08 2017-12-15 南京理工大学 A kind of human body attitude calculation method based on quaternary number and Kalman filtering
CN108458714A (en) * 2018-01-11 2018-08-28 山东大学 The Eulerian angles method for solving of acceleration of gravity is free of in a kind of attitude detection system
KR20190043306A (en) * 2017-10-18 2019-04-26 허윤선 3d coordinate measuring equipment
US10274318B1 (en) * 2014-09-30 2019-04-30 Amazon Technologies, Inc. Nine-axis quaternion sensor fusion using modified kalman filter
CN109765530A (en) * 2018-12-30 2019-05-17 成都汇蓉国科微系统技术有限公司 A kind of motion platform radar beam decoupling method
CN109931929A (en) * 2019-01-25 2019-06-25 南京薄幕软件科技有限公司 A kind of UAV Attitude calculation method based on quaternary number
KR102095135B1 (en) * 2018-12-31 2020-03-30 건국대학교 산학협력단 Method of positioning indoor and apparatuses performing the same
EP3669759A1 (en) * 2018-12-22 2020-06-24 Politechnika Lodzka System and method for dynamic posturography
CN111896007A (en) * 2020-08-12 2020-11-06 智能移动机器人(中山)研究院 Quadruped robot attitude calculation method for compensating foot-ground impact

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
AU2002230578A1 (en) * 2000-10-30 2002-05-15 Naval Postgraduate School Method and apparatus for motion tracking of an articulated rigid body
US7868610B2 (en) * 2006-06-09 2011-01-11 The Regents Of The University Of California Angular motion tracking sensor
FR2976353B1 (en) * 2011-06-07 2013-07-05 Movea SIMPLIFIED ESTIMATING METHOD OF OBJECT ORIENTATION AND ATTITUDE CENTER USING SUCH A METHOD
WO2016146130A1 (en) * 2015-03-13 2016-09-22 Sang Yinan Attitude detecting device
US10114464B2 (en) * 2015-06-30 2018-10-30 Stmicroelectronics S.R.L. Device and method for determination of angular position in three-dimensional space, and corresponding electronic apparatus
US10845195B2 (en) * 2015-07-01 2020-11-24 Solitonreach, Inc. System and method for motion based alignment of body parts
ITUB20155844A1 (en) * 2015-11-24 2017-05-24 Vinati S R L METHOD FOR ESTIMATING THE SETTING OF A PUSH-BUTTON PANEL FOR THE CONTROL OF OPERATING MACHINES
US20200141733A1 (en) * 2018-11-01 2020-05-07 Ndsu Research Foundation System to measure orientation and direction of a vehicle, usually an unmanned aerial system

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2004101671A (en) * 2004-01-20 2005-07-20 Открытое акционерное общество "Опытно-конструкторское Бюро" Сокол" (RU) METHOD FOR MEASURING A MAGNETIC COURSE OF A MOBILE OBJECT AND A DEVICE FOR ITS IMPLEMENTATION
CN103153790A (en) * 2010-10-01 2013-06-12 希尔克瑞斯特实验室公司 Apparatuses and methods for estimating the yaw angle of a device in a gravitational reference system using measurements of motion sensors and a magnetometer attached to the device
US10274318B1 (en) * 2014-09-30 2019-04-30 Amazon Technologies, Inc. Nine-axis quaternion sensor fusion using modified kalman filter
CA2932782A1 (en) * 2015-06-12 2016-12-12 7725965 Canada Inc. Orientation model for inertial devices
CN107478223A (en) * 2016-06-08 2017-12-15 南京理工大学 A kind of human body attitude calculation method based on quaternary number and Kalman filtering
CN107247157A (en) * 2017-05-10 2017-10-13 哈尔滨工程大学 Change the acquisition methods of Eulerian angles in a kind of quaternary number full-shape domain towards big attitude maneuver
KR20190043306A (en) * 2017-10-18 2019-04-26 허윤선 3d coordinate measuring equipment
CN108458714A (en) * 2018-01-11 2018-08-28 山东大学 The Eulerian angles method for solving of acceleration of gravity is free of in a kind of attitude detection system
EP3669759A1 (en) * 2018-12-22 2020-06-24 Politechnika Lodzka System and method for dynamic posturography
CN109765530A (en) * 2018-12-30 2019-05-17 成都汇蓉国科微系统技术有限公司 A kind of motion platform radar beam decoupling method
KR102095135B1 (en) * 2018-12-31 2020-03-30 건국대학교 산학협력단 Method of positioning indoor and apparatuses performing the same
CN109931929A (en) * 2019-01-25 2019-06-25 南京薄幕软件科技有限公司 A kind of UAV Attitude calculation method based on quaternary number
CN111896007A (en) * 2020-08-12 2020-11-06 智能移动机器人(中山)研究院 Quadruped robot attitude calculation method for compensating foot-ground impact

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于九轴惯性传感器的人体关节活动度测量方法研究;高照 等;《医疗卫生装备》;第43卷(第7期);14-22 *

Also Published As

Publication number Publication date
CN112902828A (en) 2021-06-04

Similar Documents

Publication Publication Date Title
TWI512548B (en) Moving trajectory generation method
Chang et al. Sensor glove based on novel inertial sensor fusion control algorithm for 3-D real-time hand gestures measurements
Du et al. Human–manipulator interface based on multisensory process via Kalman filters
EP3859495B1 (en) Systems and methods for tracking motion and gesture of heads and eyes
CN109550219B (en) Method and system for determining motion information and mobile device
CN106885566B (en) Wearable motion sensor and magnetic field interference resisting method thereof
CN107532907A (en) Posture detection equipment
CN108279773B (en) Data glove based on MARG sensor and magnetic field positioning technology
US10831272B1 (en) Kinematic model for hand position
CN108225370A (en) A kind of data fusion and calculation method of athletic posture sensor
Li et al. Real-time hand gesture tracking for human–computer interface based on multi-sensor data fusion
CN110398256B (en) Initial correction method for single posture of human body
CN112902828B (en) Angle calculation method
Katusin Glove for Augmented and Virtual Reality
Yang et al. Research on human motion monitoring method based on multi-joint constraint filter model
CN112890808B (en) Human body limb joint axis calibration device based on MEMS sensor
CN108196678A (en) Gesture operation method and the electronic equipment with gesture operation function
Ziying et al. Design and implementation of a MEMS-based attitude angle measuring system for moving objects
Widagdo et al. Limb motion tracking with inertial measurement units
Zhang et al. Improved extended Kalman fusion method for upper limb motion estimation with inertial sensors
Zhu et al. The design and implementation of 3d hand-based human-computer interaction platform
CN115005811B (en) Human body movement angle measuring method
Ding et al. The research of a new data glove based on MARG sensor and magnetic localization technology
Yi et al. A Decoupled-DCM Orientation Estimator for Eliminating Influence of Magnetic Interference on Roll Angle and Pitch Angle
Zhang et al. A novel human-robot interface using hybrid sensors with Kalman filters

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant