Solid state orientation sensor with 360 degree measurement capability
The device is a miniature, self-contained solid state orientation sensor. The unit utilizes three magnetometers and three accelerometers to calculate pitch, roll, and yaw (compass heading) angles relative to the earth's magnetic and gravitational fields. The three orientation angles are output in digital RS232 or optional multi-drop RS485. The device can also be programmed to provide raw accelerometer and magnetometer data in true physical units. The device is capable of measuring angles from 0 to 360 degrees on the yaw axis, 0 to 360 degrees on the pitch axis, and −70 to +70 degrees on the roll axis. The yaw output is compensated for errors due to pitch and roll using embedded algorithms. Applications include fast solid state compassing, robotics, virtual reality, down-hole well drilling, and body position tracking for biomedical and multimedia applications.
1. A solid state orientation sensor, comprising:
a plurality of solid state magnetic field sensors;
a plurality of solid state accelerometers;
a microprocessor that includes a programmable digital filter, said microprocessor capable of using data from said magnetic field sensors and from said accelerometers to calculate compass heading over 360 degrees and pitch over 360 degrees wherein said digital filter is used to minimize error in data from said accelerometers caused by inertial inputs to said accelerometers, wherein said programmable digital filter is adaptive to data from said magnetic field sensors and from said accelerometers.
2. An orientation sensor as recited in claim 1 , wherein filter cutoff of said programmable digital filter is programmable.