# US 2015/0149104 A1 · Motion Tracking Solutions Using a Self Correcting Three Sensor Architecture

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2015/0149104 A1
- Document ID: US20150149104A1
- Status: Published application
- Kind: A1
- Application number: 14/550,894
- Filed: 2014-11-21
- Published: 2015-05-28
- Earliest claimed: 2013-11-22
- Inventors: John Baker; Remigio Perales
- Web page: https://patentgrep.com/patent/US20150149104A1

## CPC

- G01R 33/0035: {Calibration of single magnetic sensors, e.g. integrated calibration}
- G01C 21/1654: {with electromagnetic compass}
- G01C 25/005: {initial alignment, calibration or starting-up of inertial devices}
- G01R: MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES (indicating correct tuning of resonant circuits H03J3/12)
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)

## Abstract

A system of sensors including 1) an accelerometer, 2) a magnetometer, and 3) a gyroscope, combined with a zero crossing error correction algorithm, as well as a method of using those sensors with the zero crossing error correction algorithm, for orientation motion tracking applications, including sports and athletics training, animation for motion picture and computer gaming industry, 3D joysticks, and peripherals for computer gaming industry, as well as medical and health diagnosis and monitoring systems.

## Claims

### Claim 1

A system for tracking motion and calculating error corrected orientations, comprising:
A sensor node, which comprises an accelerometer, gyroscope and magnetometer, and which is attached to a segment of a subject that is expected to move;
Means for instantaneous raw sensor data to pass from the sensor node to a microcontroller unit (MCU);
An MCU which receives raw sensor data from the sensor nodes;
Means for performing data processing and/or analysis on the sensor data, computing the orientation of the sensor node as well as for applying the zero crossing error correction algorithm to the computed orientation to correct errors; and
Means for providing power to all components of the system.

### Claim 2 (depends on 1)

The system of claim 1, where an MCU is located on the sensor node.

### Claim 3 (depends on 1)

The system of claim 1, where a sensor node is attached to a moveable segment of a subject and more than one moveable segment has a sensor node attached to it.

### Claim 4 (depends on 1)

The system of claim 1, where multiple sensor nodes send raw sensor data to one MCU.

### Claim 5 (depends on 1)

The system of claim 1, where the MCU serves, partially or totally, as the means for applying the zero crossing algorithm to the non-corrected orientation data to correct errors, and where the MCU additionally serves as means for storing data.

### Claim 6 (depends on 1)

The system of claim 1, where the MCU serves as means for raw sensor data, non-corrected orientation data, and/or error corrected orientation data to pass to the means for storing data.

### Claim 7 (depends on 1)

The system of claim 1, where the sensor node additionally comprises more than one of any of: accelerometer, gyroscope, magnetometer, or MCU.

### Claim 8 (depends on 1)

The system of claim 1, where the sensor node additionally comprises a GPS device.

### Claim 9 (depends on 1)

The system of claim 1, where the MCU serves as the means for applying the zero crossing algorithm to the non-corrected orientation data to correct errors.

### Claim 10 (depends on 1)

The system of claim 1, where the means for applying the zero crossing algorithm to the non-corrected orientation data to correct errors is located on the same “unit” as the MCU.

### Claim 11 (depends on 1)

The system of claim 1, where the sensor node, MCU and means for applying the zero crossing algorithm to the non-corrected orientation data to correct errors are on the same “unit”.

### Claim 12 (depends on 1)

The system of claim 1, which additionally comprises:
Means for storing data; and
Means for data to pass to the means for storing data.

### Claim 13 (depends on 1)

The system of claim 1, which additionally comprises:
Means for converting the error corrected orientation data to a graphical representation of the orientation and movement of a subject or segments to which sensor nodes are attached;
Means for display of the graphical representation of the orientation and movement of the subject or segments to which the sensor node or nodes are attached; and
Means for graphical representation data to pass to the means for display.

### Claim 14 (depends on 13)

The system of claim 13, where the graphical representation is displayed in real time.

### Claim 15 (depends on 13)

The system of claim 13, where the graphical representation is displayed at a later time.

### Claim 16 (depends on 1)

The system of claim 1, which additionally comprises a means for analyzing the error corrected orientation data and comparing the error corrected orientation data to other data.

### Claim 17 (depends on 1)

The system of claim 1, which additionally comprises a means for the MCU to send control signals to the sensor node.

### Claim 18 (depends on 1)

The system of claim 1, which additionally comprises a means for sending control signals to the subject or segment to which the sensor node is attached.

### Claim 19 (depends on 1)

The system of claim 1, where a sensor node or nodes are placed on the ground, or on a stationary object in contact with the ground, for the purpose of measuring seismic activity.

### Claim 20

A method of tracking motion and calculating error corrected orientations, comprising the steps of:
Aligning the axes of an accelerometer, gyroscope, and magnetometer on a sensor node;
Attaching a sensor node to the subject or segment of a subject to be tracked;
Capturing instantaneous data over time from the accelerometer, gyroscope, and magnetometer comprising the sensor node;
Transferring all or a portion of the raw sensor data in sets over time from the sensor node to a processor;
Calculating with a processor the non-corrected orientation of the sensor node using each set of raw sensor data;
Monitoring the accelerometer data with a processor and identifying points in time where the magnitude of the acceleration is below a predefined threshold. These points in time are defined as the zero crossings; and
Applying with a processor the zero crossing error correction algorithm to each calculated orientation.

### Claim 21 (depends on 20)

The method of claim 20, where at the beginning, the magnetometer is additionally calibrated to correct for the presence of ferrous or magnetic materials in close proximity to the sensor node which produce a local magnetic field. Calibration steps are comprised of the following:
Measuring the direction of geomagnetic field with a magnetometer on a sensor node, while a sensor node is isolated from any other ferrous magnetic material;
Attaching the sensor node to the ferrous or magnetic material, while keeping track of gyroscope data to ascertain the position of the sensor node;
Using known data of geomagnetic field and orientation of sensor node and data from the magnetometer measuring the total magnetic field to calculate the local magnetic field due to the ferrous or magnetic material; and
Storing local magnetic field data to be subtracted from future magnetometer readings.

### Claim 22 (depends on 20)

The method of claim 20, where the output data rate (ODR) of the sensors is a constant fixed rate.

### Claim 23 (depends on 20)

The method of claim 20, where a processor additionally transmits instructions in real time to the sensor node to vary the output data rate (ODR) of the sensors, based on the rate of change of the orientations; so that the processor sends instructions to decrease ODR for slower motions, and increase ODR for faster motions. The threshold for ODR rate change may be based on the system power requirements (i.e. data transfer rates require less power) or based on real time display requirements (i.e. smooth graphical display requires faster ODR for fast motions).

### Claim 24 (depends on 20)

The method of claim 20, where raw sensor data is stored in memory, and later used to calculate orientations and error corrections.

### Claim 25 (depends on 20)

The method of claim 20, additionally comprising the step of transmitting error corrected orientation data to a means for storing the data.

### Claim 26 (depends on 20)

The method of claim 20, additionally comprising the step of using the error corrected orientation data to update the graphical representation of the orientation of an onscreen, displayed object.

### Claim 27 (depends on 20)

The method of claim 20, additionally comprising the steps of:
Measuring as a function of time the error corrected orientation, acceleration, and velocity data of a subject's body segments, including subjects that are athletes, patients, soldiers, trainees or workers;
Comparing the measured data with expected, ideal, or target orientations, accelerations, and/or velocities;
Calculating the difference between the measured motion data, and the target motion data; and
Using the calculated differences in magnitude, duration, frequency, or change over time as a diagnostic tool to determine health, fitness level, or skill of subject, or as a development tool to increase the performance or skill level of a subject.

### Claim 28 (depends on 20)

The method of claim 20, additionally comprising the step of using the error corrected orientations, accelerations, and velocities to determine the most productive, effective, or time efficient means of performing an action or task.

### Claim 29 (depends on 20)

The method of claim 20, where a processor monitors the accelerometer raw sensor data for zero crossings; where the processor sends raw sensor data of the gyroscope to a second processor for orientation determination; where the processor only sends raw sensor data from the magnetometer and accelerometer to the other processor when zero crossings are obtained;
where the second processor performs zero crossing error correction when it receives the accelerometer and magnetometer raw sensor data.

### Claim 30 (depends on 20)

The method of claim 20, additionally comprising the steps of:
Measuring the error corrected orientation of a subject or segment of a subject;
Comparing the measured orientations to the subject's or segment's desired or anticipated orientation;
Creating an orientation correction feedback loop where orientation correction instructions are calculated, quantifying the difference in measured vs desired orientations. These instructions are fed back to the subject or segment to make actual orientation adjustments.

### Claim 31 (depends on 20)

The method of claim 20, additionally comprising the steps of: sending instructions, either through programming or specific requests, to the subject or segment of a subject to perform certain motions or lack of motion, which periodically results in zero crossing accelerations.

### Claim 32 (depends on 20)

The method of claim 20, additionally comprising the step of:
Periodically transmitting instructions from the processor to the subject or segment to stop moving, causing periodic zero acceleration.

### Claim 33 (depends on 30)

A method of monitoring and correcting the position of solar panels, comprising the steps of claim 30, where the subject is mechanical component attached to a solar panel.

### Claim 34 (depends on 30)

A method of adjusting position and orientation of a vehicle, whether it be flying, driving, floating, or submersible, comprising the steps of claim 30, where the subject is a vehicle.

### Claim 35 (depends on 20)

A method of recording the position and movement of the endpoint of a segment, comprising the method of claim 20, and additionally comprising the steps of:
Using the error corrected orientation data, calculating with the processor the position of the endpoint of a segment; and
Displaying a graphical representation of the movement of the endpoint of the segment, which may be interpreted as drawing, painting, or writing.

### Claim 36 (depends on 20)

A method of deriving suggested modifications or adjustments to future movements of a subject or segment, and of tracking historical variations or anomalies relative to ideal or recommended motion of the subject or segment, comprising the method of claim 20.

### Claim 37 (depends on 20)

The method of claim 20, further comprised of using data concerning the speed or quality of completing tasks of biomechanical motion, to determine most time or cost efficient motion to accomplish such task.

### Claim 38 (depends on 20)

The method of claim 20, where the subjects to be tracked are elements of a portion or all of a construction project (e.g. individual beams, struts etc.), and additionally comprising the steps of: monitoring the subjects during construction and/or post construction for diagnostic (e.g. post-earthquake damage assessments) or other concerns.

### Claim 39

A method of calibrating a magnetometer to correct for the presence of ferrous or magnetic materials in close proximity to the sensor node which produce a local magnetic field. Calibration steps are comprised of the following:
Measuring the direction of the geomagnetic field with a magnetometer on a sensor node, while the sensor node is isolated from any other ferrous magnetic material;
Attaching the sensor node to the ferrous or magnetic material, while keeping track of gyroscope data to ascertain the position of the sensor node;
Using the known data of the geomagnetic field and orientation of the sensor node and data from the magnetometer measuring total magnetic field to calculate the local magnetic field due to the ferrous or magnetic material; and
Storing local magnetic field data to be subtracted from future magnetometer readings.
