Locator for a moving body
First Claim
1. A locator for location and direction detections of moving bodies comprising:
- a magnetic direction sensor for outputting direction data;
a gyro for outputting angular speed data;
a direction variation computing means for computing a direction variation quantity within an assigned time from a difference of said direction data of said magnetic direction sensor;
an angular speed integrating means for computing an angle variation quantity within said assigned time from an integral value of said angular speed data of said gyro; and
a normal judgement means for said magnetic direction sensor which compares said direction variation quantity within said assigned time with said angle variation quantity within said assigned time, and in the case that a difference between the compared quantities is over a first predetermined value, judges that an error has occurred in said direction data of said magnetic direction sensor, and after judgement of an occurrence of said error and when said difference between said direction variation quantity and said angle variation quantity is below a second predetermined value, judges that said direction data of said magnetic direction sensor has returned to normalcy.
1 Assignment
0 Petitions
Accused Products
Abstract
In a locator for location and direction detections of moving bodies which employs, in the direction detection, a magnetic direction sensor for outputting direction data and a gyro for outputting angular speed data, the locator for location and direction detections of moving bodies comprising a normal judgement function for the magnetic direction sensor which compares a direction variation quantity within an assigned time which is obtained from the difference of the direction data of the magnetic direction sensor, and an angle variation quantity within the assigned time which is obtained from an integral value of the angular speed data of the gyro, and in the case that the difference between the compared quantities is over a first predetermined value, judges that an error has occurred in the direction data of the magnetic direction sensor. After judgement of an occurrence of the error and when the difference between the direction variation quantity and the angle variation quantity is below a second predetermined value, it is judged that the direction data of the magnetic direction sensor has returned to normalcy.
21 Citations
7 Claims
-
1. A locator for location and direction detections of moving bodies comprising:
-
a magnetic direction sensor for outputting direction data; a gyro for outputting angular speed data; a direction variation computing means for computing a direction variation quantity within an assigned time from a difference of said direction data of said magnetic direction sensor; an angular speed integrating means for computing an angle variation quantity within said assigned time from an integral value of said angular speed data of said gyro; and a normal judgement means for said magnetic direction sensor which compares said direction variation quantity within said assigned time with said angle variation quantity within said assigned time, and in the case that a difference between the compared quantities is over a first predetermined value, judges that an error has occurred in said direction data of said magnetic direction sensor, and after judgement of an occurrence of said error and when said difference between said direction variation quantity and said angle variation quantity is below a second predetermined value, judges that said direction data of said magnetic direction sensor has returned to normalcy. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
Specification