JP2008281494A - Position detection portable terminal device, orientation determination method, and orientation determination program - Google Patents

Position detection portable terminal device, orientation determination method, and orientation determination program Download PDF

Info

Publication number
JP2008281494A
JP2008281494A JP2007127326A JP2007127326A JP2008281494A JP 2008281494 A JP2008281494 A JP 2008281494A JP 2007127326 A JP2007127326 A JP 2007127326A JP 2007127326 A JP2007127326 A JP 2007127326A JP 2008281494 A JP2008281494 A JP 2008281494A
Authority
JP
Japan
Prior art keywords
change amount
wearer
geomagnetic
azimuth
determined
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.)
Granted
Application number
JP2007127326A
Other languages
Japanese (ja)
Other versions
JP4900030B2 (en
Inventor
Yuichi Tashiro
雄一 田代
Hiroki Akano
広樹 赤野
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP2007127326A priority Critical patent/JP4900030B2/en
Publication of JP2008281494A publication Critical patent/JP2008281494A/en
Application granted granted Critical
Publication of JP4900030B2 publication Critical patent/JP4900030B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To easily determine orientation as the direction of the body of a wearing person. <P>SOLUTION: A terrestrial magnetism vector is acquired for each prescribed time from a magnetic sensor; the amount of change in terrestrial magnetism that is the amount of change in the size of the terrestrial magnetism vector during the prescribed amount of time is calculated; and the orientation of the wearing person is determined from the terrestrial magnetism vector acquired by the magnetic sensor, when the calculated amount of change in terrestrial magnetism is within the range of a prescribed threshold. When the amount of change in the terrestrial magnetism is outside the range of the prescribed threshold, the most recent orientation that is the orientation determined from the most recent terrestrial magnetism vector indicating the amount of change in terrestrial magnetism within the range of the prescribed threshold is adopted and determined as the orientation of the wearing person. Or, the amount-of-rotation addition azimuth that is the azimuth obtained by adding the amount of rotation acquired from a gyro sensor to the most recent azimuth is determined as the orientation of the wearing person. <P>COPYRIGHT: (C)2009,JPO&INPIT

Description

この発明は、位置検出携帯端末装置、方位決定方法および方位決定プログラムに関する。   The present invention relates to a position detection portable terminal device, a direction determination method, and a direction determination program.

従来より、GPS(Global Positioning System)と自律航法とを組み合わせることにより、装着者の現在位置を連続的に検出する携帯端末装置が普及している。   Conventionally, portable terminal devices that continuously detect a wearer's current position by combining GPS (Global Positioning System) and autonomous navigation have become widespread.

GPSは、GPS衛星からの信号を受信して、装着者の現在位置を検出するものであり、自律航法は、磁気センサが取得した地磁気ベクトルから装着者の身体の向き(方位)を算出し、加速度センサが取得した加速度情報から装着者の移動方向(前後左右)と移動距離を算出し、装着者の身体の向きと移動方向と移動距離から、装着者の現在位置を検出するものである。また、ジャイロセンサが取得した装着者の回転量も、装着者の身体の向き(方位)を算出する際に用いられる場合がある。   The GPS receives a signal from a GPS satellite and detects the current position of the wearer. Autonomous navigation calculates the orientation (azimuth) of the wearer's body from the geomagnetic vector acquired by the magnetic sensor, The movement direction (front and back, left and right) and movement distance of the wearer are calculated from the acceleration information acquired by the acceleration sensor, and the current position of the wearer is detected from the direction, movement direction, and movement distance of the wearer's body. In addition, the rotation amount of the wearer acquired by the gyro sensor may be used when calculating the direction (azimuth) of the wearer's body.

ここで、装着者が建物内や建物の影を移動しているなど、GPS衛星からの信号を良好に受信できない場合、上記した携帯端末装置は、自律航法を用いることで連続的に当該装着者の現在位置を検出する。   Here, when the wearer is not able to receive signals from GPS satellites satisfactorily, such as when the wearer is moving in the building or in the shadow of the building, the above-described mobile terminal device continuously uses the autonomous navigation to apply the wearer. Detect the current position of.

自律航法において、特許文献1では、移動距離を算出する際に用いられる歩幅を、加速度センサが取得した加速度情報に基づいて調整することにより、移動距離の算出精度を向上させる技術が開示されている。例えば、加速度が大きくなっている場合は、歩行リズムが早くなっていると判断し、歩幅を小さくするなどの調整を行なうことによって、移動距離の算出精度を向上させている。   In autonomous navigation, Patent Document 1 discloses a technique for improving the calculation accuracy of the moving distance by adjusting the stride used when calculating the moving distance based on the acceleration information acquired by the acceleration sensor. . For example, when the acceleration is large, it is determined that the walking rhythm is fast, and the calculation accuracy of the movement distance is improved by making adjustments such as reducing the stride.

また、自律航法において、地磁気ベクトルから装着者の身体の向き(方位)を算出しているが、装着者の周囲に、建物の鉄筋やエレベータの駆動系など磁界を発生する要因が存在する場合は、磁気センサが取得する地磁気ベクトルに誤差が生じてしまう。そこで、特許文献2では、地点ごとに正確な地磁気ベクトルの情報をテーブルとして保持し、磁気センサが取得した地磁気ベクトルの情報の信頼度を、当該地磁気ベクトルの情報を取得した地点(例えば、GPSによって取得した地点)と、当該テーブルとを参照して判定する技術が開示されている。例えば、信頼度が低いと判定された場合は、警告を発することにより、算出された方位は信頼できないと装着者に報知する。   In autonomous navigation, the wearer's body orientation (orientation) is calculated from the geomagnetic vector, but there are factors that generate magnetic fields around the wearer, such as building reinforcing bars and elevator drive systems. An error occurs in the geomagnetic vector acquired by the magnetic sensor. Therefore, in Patent Document 2, accurate geomagnetic vector information is stored as a table for each point, and the reliability of the geomagnetic vector information acquired by the magnetic sensor is determined by the point (for example, by GPS) where the geomagnetic vector information is acquired. A technique for determining with reference to the acquired point) and the table is disclosed. For example, if it is determined that the reliability is low, a warning is issued to notify the wearer that the calculated orientation is not reliable.

さらに、特許文献3では、外部磁場によって磁気センサが取得する地磁気ベクトルに誤差が生じる場所を精度低下位置として予め登録しておき、精度低下位置においては方位の算出を停止することで、信頼度の低い方位を装着者に報知することを回避する技術が開示されている。   Furthermore, in Patent Document 3, a location where an error occurs in the geomagnetic vector acquired by the magnetic sensor due to an external magnetic field is registered in advance as a position with reduced accuracy. A technique for avoiding notifying a wearer of a low orientation is disclosed.

特開2000−97722号公報JP 2000-97722 A 特許第3837533号公報Japanese Patent No. 3833733 特開2005−291935号公報JP 2005-291935 A

ところで、上記した磁気センサによって算出される方位の信頼性を判定する従来の技術は、地点ごとの正確な地磁気ベクトルの情報や精度低下位置の情報などを、装着者が携帯端末装置を使用する可能性のある場所すべてにおいて保持しなければならないので、装着者の体の向きとしての方位を簡易に決定できないという問題点があった。   By the way, the conventional technique for determining the reliability of the direction calculated by the magnetic sensor described above allows the wearer to use the portable terminal device for accurate geomagnetic vector information for each point, information on the position of reduced accuracy, etc. There is a problem in that the orientation as the orientation of the wearer's body cannot be easily determined because it must be held in all the characteristic places.

そこで、この発明は、上述した従来技術の課題を解決するためになされたものであり、装着者の体の向きとしての方位を簡易に決定することが可能になる位置検出携帯端末装置、方位決定方法および方位決定プログラムを提供することを目的とする。   Accordingly, the present invention has been made to solve the above-described problems of the prior art, and a position detection portable terminal device that can easily determine the orientation as the orientation of the wearer's body, orientation determination An object is to provide a method and orientation determination program.

上述した課題を解決し、目的を達成するため、請求項1に係る発明は、磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出手段と、前記地磁気変化量算出手段によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定手段と、を備えたことを特徴とする。   In order to solve the above-described problems and achieve the object, the invention according to claim 1 acquires a geomagnetic vector from a magnetic sensor every predetermined time, and uses a change amount of the magnitude of the geomagnetic vector at the predetermined time. When the geomagnetic change amount calculating means for calculating a certain geomagnetic change amount and the geomagnetic change amount calculated by the geomagnetic change amount calculating means are within a predetermined threshold range, the geomagnetic vector obtained from the magnetic sensor When the direction of the wearer is determined and the amount of geomagnetic change is outside the predetermined threshold range, the direction determined from the latest geomagnetic vector indicating the amount of geomagnetic change within the predetermined threshold range is used. Azimuth determining means for adopting and determining a certain latest azimuth as the azimuth of the wearer.

また、請求項2に係る発明は、上記の発明において、加速度センサが取得した加速度情報から前記装着者の歩行の有無を判定する歩行判定手段をさらに備え、前記方位決定手段は、前記地磁気変化量算出手段によって算出された地磁気変化量が所定の閾値の範囲内であり、かつ、前記歩行判定手段によって前記装着者の歩行有と判定された場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合、または、前記歩行判定手段によって前記装着者の歩行無と判定された場合は、前記最新方位を前記装着者の前記方位として採用して決定することを特徴とする。   The invention according to claim 2 is the above-mentioned invention, further comprising walking determination means for determining the presence or absence of the wearer's walking from the acceleration information acquired by the acceleration sensor, wherein the azimuth determining means is the amount of change in geomagnetism. When the geomagnetism change amount calculated by the calculation means is within a predetermined threshold range, and the walking determination means determines that the wearer is walking, the geomagnetic vector acquired from the magnetic sensor When the wearer determines the direction and the geomagnetic change is outside the predetermined threshold range, or when the walking determination means determines that the wearer is not walking, the latest direction is It is adopted and determined as the orientation of the wearer.

また、請求項3に係る発明は、上記の発明において、ジャイロセンサから前記装着者の回転量を取得する回転量取得手段をさらに備え、前記方位決定手段は、前記地磁気変化量算出手段によって算出された前記地磁気変化量が所定の閾値の範囲外である場合は、前記最新方位に前記回転量取得手段によって取得された前記回転量を加算した方位である回転量加算方位を前記装着者の前記方位として決定することを特徴とする。   The invention according to claim 3 is the above invention, further comprising a rotation amount acquisition means for acquiring the rotation amount of the wearer from a gyro sensor, wherein the direction determination means is calculated by the geomagnetic change amount calculation means. When the amount of geomagnetic change is outside a predetermined threshold range, a rotation amount addition azimuth that is a direction obtained by adding the rotation amount acquired by the rotation amount acquisition means to the latest azimuth is the azimuth of the wearer. It is determined as follows.

また、請求項4に係る発明は、上記の発明において、前記加速度センサから重力加速度を検知して前記装着者の体の傾きを算出する傾き算出手段をさらに備え、前記地磁気変化量算出手段は、前記傾き算出手段によって算出された前記傾きに基づいて、前記磁気センサから前記所定の時間ごとに前記地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における前記地磁気変化量として、前記地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出し、前記方位決定手段は、前記水平成分変化量および前記垂直成分変化量それぞれに設定された所定の閾値と、前記地磁気変化量算出手段によって算出された前記水平成分変化量および前記垂直成分変化量それぞれとに基づいて前記方位を決定することを特徴とする。   Further, the invention according to claim 4 is the above invention, further comprising an inclination calculating means for detecting a gravitational acceleration from the acceleration sensor and calculating an inclination of the wearer's body, wherein the geomagnetic change amount calculating means comprises: Based on the inclination calculated by the inclination calculating means, a horizontal component and a vertical component of the geomagnetic vector are obtained from the magnetic sensor every predetermined time, and the geomagnetism change amount at the predetermined time is used as the geomagnetic change amount. The horizontal component change amount and the vertical component change amount, which are the change amounts of the horizontal component and the vertical component of the vector, are respectively calculated, and the azimuth determining means is a predetermined set for each of the horizontal component change amount and the vertical component change amount. Based on a threshold value and each of the horizontal component change amount and the vertical component change amount calculated by the geomagnetic change amount calculating means. And determining the azimuth Te.

また、請求項5に係る発明は、上記の発明において、気圧センサから前記装着者が存在する場所の高度を算出する高度算出手段をさらに備え、前記方位決定手段は、前記高度ごとに設定された所定の閾値と、前記地磁気変化量算出手段によって算出された前記地磁気変化量と、前記高度算出手段によって算出された前記高度とに基づいて前記方位を決定することを特徴とする。   The invention according to claim 5 is the above invention, further comprising altitude calculation means for calculating the altitude of the place where the wearer is present from an atmospheric pressure sensor, wherein the direction determining means is set for each altitude. The azimuth is determined based on a predetermined threshold value, the geomagnetic change amount calculated by the geomagnetic change amount calculating means, and the altitude calculated by the altitude calculating means.

また、請求項6に係る発明は、装着者の体の向きとしての方位を決定する方位決定方法であって、磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出工程と、前記地磁気変化量算出工程によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定工程と、を含んだことを特徴とする。   The invention according to claim 6 is an azimuth determining method for determining an azimuth as a direction of a wearer's body, wherein a geomagnetic vector is acquired from a magnetic sensor at predetermined time intervals, and the geomagnetism at the predetermined time is determined. A geomagnetic change amount calculating step for calculating a geomagnetic change amount that is a change amount of a vector, and the magnetic sensor when the geomagnetic change amount calculated by the geomagnetic change amount calculating step is within a predetermined threshold range. Determines the azimuth of the wearer from the acquired geomagnetic vector, and if the geomagnetic change amount is out of the predetermined threshold range, the latest geomagnetism indicating the change amount within the predetermined threshold range. An azimuth determining step of adopting and determining the latest azimuth determined from the vector as the azimuth of the wearer.

また、請求項7に係る発明は、装着者の体の向きとしての方位を決定する方位決定方法をコンピュータに実行させる方位決定プログラムであって、磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出手順と、前記地磁気変化量算出手順によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定手順と、をコンピュータに実行させることを特徴とする。   The invention according to claim 7 is an azimuth determination program for causing a computer to execute an azimuth determination method for determining an azimuth as a direction of a wearer's body, and acquires a geomagnetic vector from a magnetic sensor at predetermined time intervals. A geomagnetism change amount calculating procedure for calculating a geomagnetism change amount which is a change amount of the magnitude of the geomagnetic vector at the predetermined time, and the geomagnetism change amount calculated by the geomagnetism change amount calculating procedure is within a predetermined threshold range. Is determined from the geomagnetic vector acquired by the magnetic sensor, and if the amount of change in geomagnetism is outside the range of the predetermined threshold, it is within the range of the predetermined threshold. An azimuth determination procedure that adopts and determines the latest azimuth, which is the azimuth determined from the latest geomagnetic vector indicating the amount of change, as the azimuth of the wearer. Characterized in that to execute the computer.

請求項1、6または7の発明によれば、磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における地磁気ベクトルの大きさの変化量である地磁気変化量を算出し、算出された地磁気変化量が所定の閾値の範囲内である場合は、磁気センサが取得した地磁気ベクトルから装着者の方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を装着者の方位として採用して決定するので、地点ごとの地磁気ベクトルの信頼度を判定するためのテーブルを別途保持せずに、地磁気変化量のみで磁気センサの取得した地磁気ベクトルの信頼度を容易に判定でき、装着者の体の向きとしての方位を簡易に決定することが可能になる。   According to the first, sixth, or seventh aspect of the present invention, a geomagnetic vector is acquired from a magnetic sensor every predetermined time, and a geomagnetic change amount that is a change amount of the geomagnetic vector at the predetermined time is calculated and calculated. When the amount of geomagnetism change is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and when the amount of geomagnetism change is outside the range of the predetermined threshold, Since the latest orientation, which is the orientation determined from the latest geomagnetic vector indicating the amount of geomagnetic change within the predetermined threshold range, is adopted as the wearer's orientation, the reliability of the geomagnetic vector for each point is determined. Without the need for a separate table, the reliability of the geomagnetic vector acquired by the magnetic sensor can be easily determined from the amount of geomagnetic change alone, and the orientation of the wearer's body can be easily determined It is possible to constant.

また、請求項2の発明によれば、加速度センサが取得した加速度情報から装着者の歩行の有無を判定し、算出された地磁気変化量が所定の閾値の範囲内であり、かつ、装着者の歩行有と判定された場合は、磁気センサが取得した地磁気ベクトルから装着者の方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合、または、装着者の歩行無と判定された場合は、最新方位を装着者の前記方位として採用して決定するので、例えば、周囲の環境によって磁気センサの取得した地磁気ベクトルの誤差が大きいにも係らず、歩行無であるために地磁気変化量が「0」である場合においても、取得した地磁気ベクトルを採用することを回避することができ、装着者の体の向きの方位を正確に決定することが可能になる。   According to the second aspect of the present invention, it is determined whether or not the wearer is walking from the acceleration information acquired by the acceleration sensor, the calculated geomagnetic variation is within a predetermined threshold range, and When it is determined that walking is performed, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and if the amount of geomagnetic change is outside the predetermined threshold range, or it is determined that the wearer is not walking In this case, since the latest direction is adopted as the direction of the wearer and determined, for example, the geomagnetism vector acquired by the magnetic sensor is large due to the surrounding environment, but the geomagnetic field Even when the amount of change is “0”, it is possible to avoid using the acquired geomagnetic vector, and it is possible to accurately determine the orientation of the direction of the wearer's body.

また、請求項3の発明によれば、ジャイロセンサから装着者の回転量を取得し、算出された地磁気変化量が所定の閾値の範囲外である場合は、最新方位にジャイロセンサから取得された回転量を加算した方位である回転量加算方位を装着者の方位として決定するので、例えば、地磁気ベクトルの誤差が大きく信頼度が低い際に、装着者の体が回転している場合であっても、最新方位を修正することができ、装着者の体の向きの方位をより正確に決定することが可能になる。   According to the invention of claim 3, the rotation amount of the wearer is acquired from the gyro sensor, and when the calculated geomagnetic change amount is outside the range of the predetermined threshold, it is acquired from the gyro sensor in the latest direction. Since the rotation amount addition azimuth that is the azimuth adding the rotation amount is determined as the wearer's azimuth, for example, when the wearer's body is rotating when the geomagnetic vector error is large and the reliability is low However, the latest orientation can be corrected, and the orientation of the direction of the wearer's body can be determined more accurately.

また、請求項4の発明によれば、加速度センサから重力加速度を検知して装着者の体の傾きを算出し、算出された傾きに基づいて、磁気センサから所定の時間ごとに地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における地磁気変化量として、地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出し、水平成分変化量および垂直成分変化量それぞれに設定された所定の閾値と、算出された水平成分変化量および垂直成分変化量それぞれとに基づいて方位を決定するので、磁気センサの取得した地磁気ベクトルにおいて、周囲の環境によって生じる誤差による信頼度の低下を、水平成分変化量および垂直成分変化量に分けてそれぞれ詳細に判定することができ、装着者の体の向きの方位をより簡易に決定することが可能になる。   According to the invention of claim 4, the gravitational acceleration is detected from the acceleration sensor to calculate the inclination of the wearer's body, and based on the calculated inclination, the horizontal direction of the geomagnetic vector is calculated from the magnetic sensor every predetermined time. The horizontal component change amount and the vertical component change amount are calculated as the horizontal component change amount and the vertical component change amount, respectively. Since the direction is determined based on the predetermined threshold value set for each vertical component change amount and the calculated horizontal component change amount and vertical component change amount respectively, the geomagnetic vector obtained by the magnetic sensor depends on the surrounding environment. Degradation of reliability due to errors that occur can be divided into horizontal component change amount and vertical component change amount, and can be judged in detail. Who made of the orientation of the orientation of the body and more possible to determine in a simple manner.

また、請求項5の発明によれば、気圧センサから装着者が存在する場所の高度を算出し、高度ごとに設定された所定の閾値と、算出された地磁気変化量と、算出された高度とに基づいて前記方位を決定するので、さらに、高度変化にともなう地磁気ベクトルそのものの変化にも容易に対応でき、装着者の体の向きの方位をより簡易かつ正確に決定することが可能になる。   According to the invention of claim 5, the altitude of the place where the wearer is present is calculated from the atmospheric pressure sensor, the predetermined threshold set for each altitude, the calculated geomagnetic variation, and the calculated altitude Therefore, the direction of the wearer's body can be determined more easily and accurately because it is possible to easily cope with a change in the geomagnetic vector itself accompanying a change in altitude.

以下に添付図面を参照して、この発明に係る位置検出携帯端末装置、方位決定方法および方位決定プログラムの実施例を詳細に説明する。なお、以下では、実施例1における位置検出携帯端末装置の概要および特徴、実施例1における位置検出携帯端末装置の構成および処理の手順、実施例1の効果を順に説明し、最後に、他の実施例について説明する。   Exemplary embodiments of a position detection portable terminal device, an azimuth determination method, and an azimuth determination program according to the present invention will be described below in detail with reference to the accompanying drawings. In the following, the outline and features of the position detection portable terminal device according to the first embodiment, the configuration and processing procedure of the position detection portable terminal device according to the first embodiment, and the effects of the first embodiment will be described in order. Examples will be described.

[用語の説明]
まず最初に、以下の実施例で用いる主要な用語を説明する。以下の実施例で用いる「磁気センサ」とは、地球の磁界の大きさおよび方向(3軸方向)の情報を含む地磁気ベクトルを取得するセンサのことであり、位置検出携帯端末装置は、「磁気センサ」が取得した地磁気ベクトルの情報に基づいて、当該位置検出携帯端末装置を装着する装着者の体の向きを算出して決定することができる。
[Explanation of terms]
First, main terms used in the following examples will be described. The “magnetic sensor” used in the following examples refers to a sensor that acquires a geomagnetic vector including information on the magnitude and direction (triaxial direction) of the earth's magnetic field. Based on the information of the geomagnetic vector acquired by the “sensor”, it is possible to calculate and determine the direction of the body of the wearer wearing the position detection portable terminal device.

また、「加速度センサ」とは、3軸方向の加速度情報を取得するセンサのことであり、位置検出携帯端末装置は、「加速度センサ」が取得した装着者の体の移動によって生じる3軸方向の加速度情報に基づいて、当該装着者の移動方向(前後左右)および移動距離を算出することができる。例えば、位置検出携帯端末装置は、「加速度センサ」が取得した3軸それぞれの加速度情報の最大値と最小値の差である振幅値に基づいて、移動方向および移動距離を算出することができる。さらに「加速度センサ」は、地球の重力(重力加速度)を取得するセンサでもあり、位置検出携帯端末装置は、「加速度センサ」が取得した重力加速度情報に基づいて、当該位置検出携帯端末装置の傾き、すなわち、当該装着者の体の傾きを算出することができる。   The “acceleration sensor” is a sensor that acquires acceleration information in three axes, and the position detection portable terminal device is a sensor in three axes that is generated by movement of the wearer's body acquired by the “acceleration sensor”. Based on the acceleration information, it is possible to calculate the movement direction (front and rear, left and right) and movement distance of the wearer. For example, the position detection portable terminal device can calculate the movement direction and the movement distance based on the amplitude value that is the difference between the maximum value and the minimum value of the acceleration information of each of the three axes acquired by the “acceleration sensor”. Furthermore, the “acceleration sensor” is also a sensor that acquires the gravity of the earth (gravity acceleration), and the position detection mobile terminal device is based on the gravitational acceleration information acquired by the “acceleration sensor”. That is, the inclination of the wearer's body can be calculated.

また、「気圧センサ」とは、高さ(高度)に応じて変動する気圧を取得するセンサであり、位置検出携帯端末装置は、「気圧センサ」が取得した気圧の値に基づいて、当該位置検出携帯端末装置の存在する高度、すなわち、当該装着者の存在する高度を算出することができる。また、「ジャイロセンサ」とは、回転量(具体的には、単位時間当たりの角速度)を取得するセンサであり、位置検出携帯端末装置は、「磁気センサ」が取得した地磁気ベクトルの情報と同様に、「ジャイロセンサ」が取得した回転量に基づいて、当該位置検出携帯端末装置を装着する装着者の体の向きを算出することができる。   In addition, the “barometric pressure sensor” is a sensor that acquires a barometric pressure that fluctuates according to height (altitude), and the position detection mobile terminal device uses the barometric pressure value acquired by the “barometric pressure sensor” to detect the position. The altitude at which the detected portable terminal device exists, that is, the altitude at which the wearer exists can be calculated. Further, the “gyro sensor” is a sensor that acquires a rotation amount (specifically, angular velocity per unit time), and the position detection portable terminal device is similar to the geomagnetic vector information acquired by the “magnetic sensor”. In addition, based on the rotation amount acquired by the “gyro sensor”, the orientation of the body of the wearer wearing the position detection portable terminal device can be calculated.

[実施例1における位置検出携帯端末装置の概要および特徴]
続いて、図1および図2を用いて、実施例1における位置検出携帯端末装置の主たる特徴を具体的に説明する。図1は、実施例1における位置検出携帯端末装置の概要を説明するための図であり、図2は、実施例1における位置検出携帯端末装置の特徴を説明するための図である。
[Outline and Features of Position Detection Portable Terminal Device in Embodiment 1]
Subsequently, main features of the position detection portable terminal device according to the first embodiment will be specifically described with reference to FIGS. 1 and 2. FIG. 1 is a diagram for explaining the outline of the position detection portable terminal device according to the first embodiment, and FIG. 2 is a diagram for explaining the features of the position detection portable terminal device according to the first embodiment.

実施例1における位置検出携帯端末装置は、装着者の向きとしての方位と、当該装着者の移動方向および移動距離とに基づいて当該装着者の位置を検出することを概要とする。すなわち、実施例1における位置検出携帯端末装置は、図1の(A)に示すように、装着者の腰などに装着され、当該装着者の向きとしての方位、移動方向および移動距離とに基づいて当該装着者の位置を、自律的に検出する。すなわち、GPS衛星からの信号といった外部装置からの情報を用いることなく、実施例1における位置検出携帯端末装置自身が備える各種センサから取得した情報に基づいて、装着者の位置を、自律的に検出する。   The position detection portable terminal device according to the first embodiment outlines that the position of the wearer is detected based on the orientation as the direction of the wearer and the movement direction and movement distance of the wearer. That is, as shown in FIG. 1A, the position detection portable terminal device according to the first embodiment is worn on the wearer's waist or the like, and is based on the orientation, movement direction, and movement distance as the wearer's orientation. And autonomously detecting the position of the wearer. That is, without using information from an external device such as a signal from a GPS satellite, the position of the wearer is autonomously detected based on information acquired from various sensors included in the position detection mobile terminal device itself in the first embodiment. To do.

例えば、実施例1における位置検出携帯端末装置は、図1の(A)に示すように、「時刻:t1」における装着者の体の向きとしての方位(以下、方位と記す)を、磁気センサが取得した地磁気ベクトルの情報に基づいて、「方位(体の向き):南」として取得し、「時刻:t1」から「時刻:t2」の間における当該装着者の移動方向および移動距離を、加速度センサが取得した装着者の体の移動によって生じる3軸方向の加速度情報に基づいて、「移動方向:前」および「移動距離:Xm」として取得する。ここで、実施例1における位置検出携帯端末装置は、これら方位、移動方向および移動距離の情報を、例えば、装着者の位置情報を管理する管理センターに送信する。そして、当該管理センターは、これらの情報を処理することにより、例えば、図1の(B)に示すように、装着者の位置情報を建物内の見取り図に対応付けた画像を作成して装着者の位置を把握するともに、当該位置検出携帯端末装置に作成した画像を送信する。これにより、位置検出携帯端末装置の装着者も、自分の現在位置を把握することができる。   For example, as shown in FIG. 1A, the position detection portable terminal device according to the first embodiment uses a magnetic sensor as the orientation of the wearer's body at “time: t1” (hereinafter referred to as an orientation). Is acquired as “azimuth (orientation): south” based on the acquired geomagnetic vector information, and the movement direction and movement distance of the wearer between “time: t1” and “time: t2” Based on the acceleration information in the triaxial directions generated by the movement of the wearer's body acquired by the acceleration sensor, it is acquired as “movement direction: front” and “movement distance: Xm”. Here, the position detection portable terminal device according to the first embodiment transmits information on the azimuth, the movement direction, and the movement distance to, for example, a management center that manages the position information of the wearer. Then, the management center processes these pieces of information to create an image in which the position information of the wearer is associated with the floor plan in the building as shown in FIG. And the created image is transmitted to the position detection portable terminal device. Thereby, the wearer of the position detection portable terminal device can also grasp his current position.

なお、本実施例では、携帯端末装置が位置検出のみを専用に行なう場合について説明するが、本発明はこれに限られるものではなく、例えば、本発明を適用したPDA(Personal Digital Assistant)やPC(Personal Computer)などの携帯端末装置が位置検出をさらに行なう場合であってもよい。   In this embodiment, the case where the portable terminal device performs only position detection will be described. However, the present invention is not limited to this, and for example, a PDA (Personal Digital Assistant) or PC to which the present invention is applied. A mobile terminal device such as (Personal Computer) may further perform position detection.

ここで、本発明は、装着者の体の向きとしての方位を簡易に決定することが可能になることに主たる特徴がある。この主たる特徴について簡単に説明すると、実施例1における位置検出携帯端末装置は、加速度センサ、ジャイロセンサ、磁気センサおよび気圧センサを備え、これら各種センサから取得した情報から方位決定に用いるデータを検出する。具体的には、気圧センサから取得した気圧の値に基づいて、装着者の存在する高度を算出する(図2の(A)の(1)および図2の(B)参照)。また、加速度センサから取得した重力加速度情報に基づいて、当該位置検出携帯端末装置の傾き、すなわち、当該装着者の体の傾きを算出する(図2の(A)の(2)および図2の(B)参照)。また、磁気センサから地磁気ベクトルの情報を取得し(図2の(A)の(3)参照)、ジャイロセンサから装着者の体の回転量を取得する(図2の(A)の(4)参照)。なお、加速度センサが取得した3軸方向の加速度情報に基づいて、当該装着者の歩行の有無も判定するが(図2の(A)の(2)参照)、これについては後述する。   Here, the present invention is mainly characterized in that it is possible to easily determine the orientation as the orientation of the wearer's body. This main feature will be briefly described. The position detection portable terminal device according to the first embodiment includes an acceleration sensor, a gyro sensor, a magnetic sensor, and an atmospheric pressure sensor, and detects data used for azimuth determination from information acquired from these various sensors. . Specifically, the altitude at which the wearer is present is calculated based on the pressure value acquired from the pressure sensor (see (1) in FIG. 2A and (B) in FIG. 2). Further, based on the gravitational acceleration information acquired from the acceleration sensor, the inclination of the position detection portable terminal device, that is, the inclination of the wearer's body is calculated ((2) in FIG. 2 (A) and FIG. 2). (See (B)). Further, information on the geomagnetic vector is acquired from the magnetic sensor (see (3) in FIG. 2A), and the rotation amount of the wearer's body is acquired from the gyro sensor ((4) in FIG. 2A). reference). It should be noted that the presence or absence of the wearer's walking is also determined based on the triaxial acceleration information acquired by the acceleration sensor (see (2) in FIG. 2A), which will be described later.

そして、実施例1における位置検出携帯端末装置は、磁気センサから所定の時間ごとに取得した地磁気ベクトルの大きさの変化量である地磁気変化量を算出する。その際、実施例1における位置検出携帯端末装置は、図2の(B)に示すように、算出された当該位置検出携帯端末装置(当該装着者の体)の傾きに基づいて、所定の時間ごと(例えば、2秒ごと)に地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における(例えば、2秒間における)地磁気変化量として、地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出する。   And the position detection portable terminal device in Example 1 calculates the amount of geomagnetism change that is the amount of change in the magnitude of the geomagnetic vector acquired from the magnetic sensor every predetermined time. At that time, as shown in FIG. 2B, the position detection portable terminal device according to the first embodiment performs a predetermined time based on the calculated inclination of the position detection portable terminal device (the body of the wearer). The horizontal component and the vertical component of the geomagnetic vector are acquired every time (for example, every 2 seconds), and the amount of change in the horizontal and vertical components of the geomagnetic vector is obtained as the amount of change in the geomagnetic vector for the predetermined time (for example, in 2 seconds). Each horizontal component change amount and vertical component change amount is calculated.

例えば、図2の(C)に示すように、「時刻:t1」での地磁気ベクトルにおける「水平成分」が「H(t1)」であり、「垂直成分」が「P(t1)」であり、さらに所定の時間後の「時刻:t2」での地磁気ベクトルにおける「水平成分」が「H(t2)」であり、「垂直成分」が「P(t2)」であった場合、実施例1における位置検出携帯端末装置は、「時刻:t2」における「水平成分変化量」として「|H(t2)−H(t1)|=h(t2)」を算出し、「時刻:t2」における「垂直成分変化量」として「|P(t2)−P(t1)|=p(t2)」を算出する。   For example, as shown in FIG. 2C, the “horizontal component” in the geomagnetic vector at “time: t1” is “H (t1)”, and the “vertical component” is “P (t1)”. Further, when the “horizontal component” in the geomagnetic vector at “time: t2” after a predetermined time is “H (t2)” and the “vertical component” is “P (t2)”, Example 1 The position detection portable terminal device in FIG. 6 calculates “| H (t2) −H (t1) | = h (t2)” as “horizontal component change amount” at “time: t2”, and “ “| P (t2) −P (t1) | = p (t2)” is calculated as “vertical component change amount”.

そして、実施例1における位置検出携帯端末装置は、判定された歩行の有無と、算出された高度と、地磁気変化量として算出された水平成分変化量および垂直成分変化量それぞれと、水平成分変化量および垂直成分変化量それぞれに対して予め高度ごとに設定された所定の閾値とに基づいて、装着者の方位を決定する。具体的には、「装着者の歩行有」と判定され、かつ、水平成分変化量が、算出された高度に対して設定された所定の閾値内であり、かつ、垂直成分変化量が、算出された高度に対して設定された所定の閾値内である場合には、磁気センサが取得した地磁気ベクトルから装着者の方位を決定する。また、水平成分変化量が、算出された高度に対して設定された所定の閾値外、または、垂直成分変化量が、算出された高度に対して設定された所定の閾値外である場合、および、「装着者の歩行無」と判定された場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位にジャイロセンサから取得された回転量を加算した方位である回転量加算方位を装着者の方位として決定する。   The position detection portable terminal device according to the first embodiment includes the determined presence / absence of walking, the calculated altitude, the horizontal component change amount and the vertical component change amount calculated as the geomagnetic change amount, and the horizontal component change amount. The orientation of the wearer is determined based on a predetermined threshold value set for each altitude in advance for each of the vertical component change amounts. Specifically, it is determined that “the wearer is walking”, the horizontal component change amount is within a predetermined threshold set for the calculated altitude, and the vertical component change amount is calculated. If it is within a predetermined threshold set for the altitude, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor. Further, when the horizontal component change amount is outside a predetermined threshold set for the calculated altitude, or the vertical component change amount is outside the predetermined threshold set for the calculated altitude, and Rotation acquired from the gyro sensor in the latest azimuth, which is the azimuth determined from the latest geomagnetic vector indicating the amount of change in geomagnetism within the predetermined threshold range when it is determined that the wearer does not walk The rotation amount addition azimuth that is the azimuth obtained by adding the amount is determined as the azimuth of the wearer.

例えば、実施例1における位置検出携帯端末装置は、水平成分変化量および垂直成分変化量それぞれに対して予め高度ごとに設定された所定の閾値として、図2の(C)に示すように、「高度:第四範囲」に対応付けた閾値として「水平成分変化量閾値:H4」および「垂直成分変化量閾値:P4」などを記憶している。ここで、図2の(C)に示す「高度:第一範囲」や「高度:第四範囲」は、例えば、「高度:20m」ごとに設定された範囲であり、「高度:第一範囲」は、地表からの高度が「0mから20m」の範囲を示しており、「高度:第四範囲」は、地表からの高度が「60mから80m」の範囲を示しているとする。   For example, as shown in FIG. 2C, the position detection portable terminal device according to the first embodiment uses a predetermined threshold set in advance for each of the horizontal component change amount and the vertical component change amount as shown in FIG. “Horizontal component change threshold value: H4”, “vertical component change threshold value: P4”, and the like are stored as threshold values associated with “altitude: fourth range”. Here, “altitude: first range” and “altitude: fourth range” shown in FIG. 2C are ranges set for each “altitude: 20 m”, for example, “altitude: first range”. "Indicates a range where the altitude from the ground surface is" 0 m to 20 m ", and" altitude: the fourth range "indicates a range where the altitude from the ground surface is" 60 m to 80 m ".

そして、「時刻:t2」における装着者の高度が、例えば、「65m」と算出された場合、実施例1における位置検出携帯端末装置は、図2の(C)に示すように、「時刻:t2」における「水平成分変化量:h(t2)」と「水平成分変化量閾値:H4」とを比較し、「時刻:t2」における「垂直成分変化量:p(t2)」と「垂直成分変化量閾値:P4」とを比較して、以下の3つの場合それぞれにおいて、方位を決定する。すなわち、加速度センサから取得した3軸の加速度情報から「時刻:t2」における「装着者の歩行有」と判定され、かつ、「水平成分変化量:h(t2)」が「水平成分変化量閾値:H4」以下であり、かつ、「垂直成分変化量:p(t2)」が「垂直成分変化量閾値:P4」以下である場合には、磁気センサが「時刻:t2」に取得した地磁気ベクトルから装着者の方位を決定する(図2の(D)の(5)参照)。   When the altitude of the wearer at “time: t2” is calculated to be “65 m”, for example, the position detection portable terminal device according to the first embodiment, as shown in FIG. “Horizontal component change amount: h (t2)” at “t2” and “horizontal component change amount threshold value: H4” are compared, and “vertical component change amount: p (t2)” and “vertical component at“ time: t2 ”are compared. Compared with “change amount threshold value: P4”, the orientation is determined in each of the following three cases. That is, it is determined that “the wearer is walking” at “time: t2” from the triaxial acceleration information acquired from the acceleration sensor, and “horizontal component change amount: h (t2)” is “horizontal component change amount threshold value”. : H4 "or less and" vertical component change amount: p (t2) "is" vertical component change amount threshold value: P4 "or less, the geomagnetic vector acquired by the magnetic sensor at" time: t2 " The orientation of the wearer is determined from (see (5) of FIG. 2D).

また、「水平成分変化量:h(t2)」が「水平成分変化量閾値:H4」より大きい、または、「垂直成分変化量:p(t2)」が「垂直成分変化量閾値:P4」より大きい場合、もしくは、加速度センサから取得した3軸の加速度情報から「時刻:t2」における「装着者の歩行有」と判定された場合は、閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位にジャイロセンサから取得された回転量を加算した方位である回転量加算方位を装着者の方位として決定する(図2の(D)の(6)および(7)参照)。ここで、例えば、「時刻:t1」おける「水平成分変化量」が「水平成分変化量閾値:H4」以下であり、かつ、「時刻:t1」における「垂直成分変化量」が「垂直成分変化量閾値:P4」以下であったので、磁気センサが「時刻:t1」に取得した地磁気ベクトルから装着者の方位として「南」が決定されていた場合(図2の(C)参照)、最新方位としての「南」にジャイロセンサから取得された回転量(例えば、45度)を加算した方位である回転量加算方位(例えば、南西)を装着者の方位として決定する。   Also, “horizontal component change amount: h (t2)” is larger than “horizontal component change amount threshold value: H4”, or “vertical component change amount: p (t2)” is more than “vertical component change amount threshold value: P4”. If it is large, or if it is determined that “the wearer is walking” at “time: t2” from the triaxial acceleration information acquired from the acceleration sensor, the latest geomagnetism that indicates the amount of change in geomagnetism within the threshold range. The rotation amount addition azimuth that is the azimuth obtained by adding the rotation amount acquired from the gyro sensor to the latest azimuth determined from the vector is determined as the wearer's azimuth ((6) and (6) in FIG. 7)). Here, for example, the “horizontal component change amount” at “time: t1” is equal to or less than “horizontal component change amount threshold value: H4”, and the “vertical component change amount” at “time: t1” is “vertical component change”. Since the quantity threshold value is “P4” or less, “South” is determined as the wearer's orientation from the geomagnetic vector acquired at “time: t1” by the magnetic sensor (see FIG. 2C). A rotation amount addition azimuth (for example, southwest), which is a azimuth obtained by adding the rotation amount (for example, 45 degrees) acquired from the gyro sensor to “south” as the azimuth, is determined as the direction of the wearer.

なお、本実施例では、地磁気変化量として、水平成分変化量および垂直成分変化量を分割してそれぞれ算出する場合について説明したが、本発明はこれに限定されるものではなく、より簡潔に、地磁気変化量として、地磁気ベクトルそのものの大きさの変化量のみを算出する場合であってもよい。この場合、地磁気ベクトルの大きさの変化量に対する閾値を1種類のみ保持し、当該閾値に基づいて方位を決定する。例えば、地磁気変化量が所定の閾値の範囲内である場合は、磁気センサが取得した地磁気ベクトルから装着者の方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、最新方位を装着者の方位として採用して決定したり、最新方位に取得された回転量を加算して装着者の方位を決定したりしてもよい。   In the present embodiment, the case where the horizontal component change amount and the vertical component change amount are separately calculated as the geomagnetic change amount has been described, but the present invention is not limited to this, and more simply, As the geomagnetic change amount, only the change amount of the magnitude of the geomagnetic vector itself may be calculated. In this case, only one type of threshold for the amount of change in the magnitude of the geomagnetic vector is held, and the azimuth is determined based on the threshold. For example, when the geomagnetic change amount is within a predetermined threshold range, the wearer's orientation is determined from the geomagnetic vector acquired by the magnetic sensor, and when the geomagnetic change amount is outside the predetermined threshold range, The latest azimuth may be adopted as the wearer's azimuth, or may be determined by adding the rotation amount acquired to the latest azimuth.

また、地磁気ベクトルそのものの大きさの変化量のみを算出する場合においても、歩行の有無をさらに判定し、地磁気変化量が所定の閾値の範囲内であり、かつ、装着者の歩行有と判定された場合は、磁気センサが取得した地磁気ベクトルから装着者の方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合、または、装着者の歩行無と判定された場合は、最新方位を装着者の方位として採用して決定したり、最新方位に取得された回転量を加算して装着者の方位を決定したりしてもよい。   Even when only the magnitude change in the magnitude of the geomagnetic vector itself is calculated, the presence / absence of walking is further determined, the geomagnetic change is within a predetermined threshold range, and it is determined that the wearer is walking. If the wearer's azimuth is determined from the geomagnetic vector acquired by the magnetic sensor and the geomagnetic change amount is outside the predetermined threshold range, or if the wearer is determined not to walk, The latest azimuth may be adopted as the wearer's azimuth, or may be determined by adding the rotation amount acquired to the latest azimuth.

このようなことから、実施例1における位置検出携帯端末装置は、地点ごとの地磁気ベクトルの信頼度を判定するためのテーブルを別途保持せずに、地磁気変化量のみで磁気センサの取得した地磁気ベクトルの信頼度を容易に判定でき、上記した主たる特徴の通り、装着者の体の向きとしての方位を簡易に決定することが可能になる。なお、実施例1における位置検出携帯端末装置は、装着者の方位を決定した後、決定された方位と、加速度センサから取得した3軸の加速度情報から算出した移動方向および移動距離とを、装着者の位置情報を管理する管理センターに送信し、管理センターが当該装着者の位置を検出するが、本発明はこれに限定されるものではなく、位置検出携帯端末装置そのものが、方位、移動方向および移動距離から当該装着者の位置を検出する場合であってもよい。   For this reason, the position detecting portable terminal device according to the first embodiment does not separately maintain a table for determining the reliability of the geomagnetic vector for each point, and the geomagnetic vector acquired by the magnetic sensor based only on the geomagnetic change amount. It is possible to easily determine the reliability of the wearer, and as described above, the orientation of the wearer's body can be easily determined. In addition, after the position detection portable terminal device in Example 1 determines the wearer's azimuth, the determined azimuth and the movement direction and the movement distance calculated from the triaxial acceleration information acquired from the acceleration sensor are mounted. The position information of the wearer is transmitted to the management center, and the management center detects the position of the wearer. However, the present invention is not limited to this. Alternatively, the position of the wearer may be detected from the movement distance.

[実施例1における位置検出携帯端末装置の構成]
次に、図3〜9を用いて、実施例1における位置検出携帯端末装置を説明する。図3は、実施例1における位置検出携帯端末装置の構成を示すブロック図であり、図4は、加速度センサの出力例を説明するための図であり、図5は、磁気センサの出力例を説明するための図であり、図6は、気圧センサの出力例を説明するための図であり、図7は、ジャイロセンサの出力例を説明するための図であり、図8は、閾値記憶部を説明するための図であり、図9は、地磁気変化量記憶部を説明するための図である。
[Configuration of Position Detection Portable Terminal Device in Embodiment 1]
Next, the position detection portable terminal device according to the first embodiment will be described with reference to FIGS. FIG. 3 is a block diagram illustrating a configuration of the position detection portable terminal device according to the first embodiment, FIG. 4 is a diagram for explaining an output example of the acceleration sensor, and FIG. 5 is an output example of the magnetic sensor. FIG. 6 is a diagram for explaining an output example of the atmospheric pressure sensor, FIG. 7 is a diagram for explaining an output example of the gyro sensor, and FIG. 8 is a threshold storage. FIG. 9 is a diagram for explaining the geomagnetism change storage unit.

図3に示すように、実施例1における位置検出携帯端末装置10は、通信制御部11と、表示部12と、加速度センサ13と、磁気センサ14と、気圧センサ15と、ジャイロセンサ16と、入出力制御I/F部17と、記憶部20と、処理部30とから構成され、管理センター100と、例えば、無線通信によって接続される。   As illustrated in FIG. 3, the position detection portable terminal device 10 according to the first embodiment includes a communication control unit 11, a display unit 12, an acceleration sensor 13, a magnetic sensor 14, an atmospheric pressure sensor 15, and a gyro sensor 16. The input / output control I / F unit 17, the storage unit 20, and the processing unit 30 are connected to the management center 100 by, for example, wireless communication.

管理センター100は、位置検出携帯端末装置10の装着者の位置情報を管理する。すなわち、管理センター100は、位置検出携帯端末装置10から受信した方位、移動方向および移動距離の情報を処理することにより、例えば、図1の(B)に示すように、装着者の位置情報を建物内の見取り図に対応付けた画像を作成して装着者の位置を把握するとともに、作成した画像を位置検出携帯端末装置10に送信する。   The management center 100 manages the position information of the wearer of the position detection portable terminal device 10. That is, the management center 100 processes the information on the azimuth, the moving direction, and the moving distance received from the position detection portable terminal device 10, for example, as shown in FIG. An image associated with the floor plan in the building is created to grasp the position of the wearer, and the created image is transmitted to the position detection portable terminal device 10.

通信制御部11は、他の装置との通信を制御し、特に本発明に密接に関連するものとしては、後述する方位決定部30gによって決定された装着者の方位と、後述する位置検出部30hによって検出された装着者の移動方向および移動距離とを管理センター100に転送したり、管理センター100において作成された装着者の位置情報を建物内の見取り図に対応付けた画像などを後述する表示部12に転送したりする。また、管理センター100から受信した各種センサのオフセット値およびゲイン値を後述する設定パラメータ記憶部20aに転送したり、管理センター100から受信した設定閾値を後述する閾値記憶部20eに転送したりする。   The communication control unit 11 controls communication with other devices, and particularly as closely related to the present invention, the wearer's azimuth determined by the azimuth determining unit 30g described later and a position detecting unit 30h described later. A display unit that transfers the direction and distance of movement of the wearer detected by the control unit 100 to the management center 100, an image in which the position information of the wearer created in the management center 100 is associated with a floor plan in the building, which will be described later Or transfer to 12. Further, the offset values and gain values of various sensors received from the management center 100 are transferred to a setting parameter storage unit 20a described later, or the setting threshold values received from the management center 100 are transferred to a threshold storage unit 20e described later.

表示部12は、各種の情報を出力し、特に本発明に密接に関連するものとしては、管理センター100から受信した装着者の位置情報を建物内の見取り図に対応付けた画像などを、液晶ディスプレイに表示したりする。   The display unit 12 outputs various types of information, and particularly as closely related to the present invention, an image in which the position information of the wearer received from the management center 100 is associated with a floor plan in the building is displayed on a liquid crystal display. Or to display.

加速度センサ13は、3軸方向の加速度情報を取得し、さらに、地球の重力(重力加速度)を取得する。例えば、図4に示すように、装着者の体に対する3軸(X軸、Y軸およびZ軸)ごとの加速度(単位:G)を、単位時間あたりの時系列で取得する。   The acceleration sensor 13 acquires acceleration information in three axis directions, and further acquires the earth's gravity (gravity acceleration). For example, as shown in FIG. 4, acceleration (unit: G) for each of three axes (X axis, Y axis, and Z axis) with respect to the wearer's body is acquired in a time series per unit time.

磁気センサ14は、地球の磁界の大きさおよび方向(3軸方向)の情報を含む地磁気ベクトルの情報を取得する。例えば、図5に示すように、地磁気ベクトルそのものの大きさである「磁気の大きさ」や、後述する重力加速度検出部30cが検出した装着者の体の傾きに基づいて算出された地磁気ベクトルの水平成分の大きさである「磁気水平成分」および垂直成分の大きさである「磁気垂直成分」を、単位時間あたりの時系列で取得する。   The magnetic sensor 14 acquires geomagnetic vector information including information on the magnitude and direction (three-axis direction) of the earth's magnetic field. For example, as shown in FIG. 5, the magnitude of the geomagnetism vector itself, which is the magnitude of the magnetism vector, or the geomagnetism vector calculated based on the inclination of the wearer's body detected by the gravitational acceleration detection unit 30c described later. The “magnetic horizontal component” that is the size of the horizontal component and the “magnetic vertical component” that is the size of the vertical component are acquired in time series per unit time.

気圧センサ15は、高さ(高度)に応じて変動する気圧を取得する。例えば、位置検出携帯端末装置10の装着者が建物内の階段を下降している(高度が減少している)場合、図6に示すように、気圧センサ15の単位時間あたりの時系列で取得した出力結果から、時間経過に応じて、気圧(単位:Hpa)が上昇していることがわかる。   The atmospheric pressure sensor 15 acquires an atmospheric pressure that varies depending on the height (altitude). For example, when the wearer of the position detection portable terminal device 10 is descending a staircase in the building (the altitude is decreasing), as shown in FIG. 6, the pressure sensor 15 is acquired in time series per unit time. From the output result, it can be seen that the atmospheric pressure (unit: Hpa) increases with time.

ジャイロセンサ16は、回転量を取得する。例えば、図7に示すように、ジャイロセンサ16が取得した回転量から、装着者の方位(単位:度)を時系列に応じて出力する。なお、図7において、「0度」は「北」を、「90度」は「東」を、「180度」は「南」を、「270度」は「西」を示している。また、図7においては、磁気センサ14の取得した地磁気ベクトルの情報を、装着者の方位(単位:度)として時系列に応じて出力した場合も併せて示している。   The gyro sensor 16 acquires the rotation amount. For example, as shown in FIG. 7, the azimuth (unit: degree) of the wearer is output in a time series from the rotation amount acquired by the gyro sensor 16. In FIG. 7, “0 degree” indicates “north”, “90 degrees” indicates “east”, “180 degrees” indicates “south”, and “270 degrees” indicates “west”. FIG. 7 also shows a case where the information on the geomagnetic vector acquired by the magnetic sensor 14 is output as the wearer's direction (unit: degree) according to the time series.

記憶部20は、各種処理に必要なデータおよびプログラムを格納し、特に本発明に密接に関連するものとしては、図3に示すように、設定パラメータ記憶部20aと、センサ情報記憶部20bと、方位決定用検出情報記憶部20cと、地磁気変化量記憶部20dと、閾値記憶部20eと、決定方位記憶部20fとを備える。   The storage unit 20 stores data and programs necessary for various processes, and particularly those closely related to the present invention include a setting parameter storage unit 20a, a sensor information storage unit 20b, as shown in FIG. A direction determining detection information storage unit 20c, a geomagnetic change amount storage unit 20d, a threshold storage unit 20e, and a determined direction storage unit 20f are provided.

設定パラメータ記憶部20aは、各種センサごとに設定されたパラメータであるオフセット値およびゲイン値を記憶する。すなわち、設定パラメータ記憶部20aは、位置検出携帯端末装置10に備えられる加速度センサ13、磁気センサ14、気圧センサ15およびジャイロセンサ16それぞれのオフセット値およびゲイン値を記憶する。ここで、オフセット値およびゲイン値とは、センサが取得したアナログ情報をデジタル情報に変換する際に用いられる補正用のパラメータである。オフセット値は、ゼロ点補正を行なうためのパラメータである。また、ゲイン値は、個々のセンサごとの取得した値において生じる「ばらつき」を補正するためのパラメータであり、オフセット値によって補正された値にゲイン値を掛け合わせることにより、正確な値を算出する。例えば、加速度センサ13が地表において取得した重力加速度の情報をオフセット値およびゲイン値によって補正することで、正確な値である「1G」を取得することができる。   The setting parameter storage unit 20a stores an offset value and a gain value that are parameters set for each sensor. That is, the setting parameter storage unit 20a stores the offset value and the gain value of each of the acceleration sensor 13, the magnetic sensor 14, the atmospheric pressure sensor 15, and the gyro sensor 16 provided in the position detection portable terminal device 10. Here, the offset value and the gain value are correction parameters used when converting the analog information acquired by the sensor into digital information. The offset value is a parameter for performing zero point correction. The gain value is a parameter for correcting “variation” occurring in the acquired value for each sensor, and an accurate value is calculated by multiplying the value corrected by the offset value by the gain value. . For example, by correcting the gravitational acceleration information acquired by the acceleration sensor 13 on the ground surface with an offset value and a gain value, an accurate value “1G” can be acquired.

閾値記憶部20eは、水平成分変化量および垂直成分変化量それぞれに対して高度ごとに設定された所定の閾値を記憶する。具体的には、図8に示すように、「高度:第四範囲」に対応付けた閾値として「水平成分変化量閾値:H4」および「垂直成分変化量閾値:P4」などを記憶している。例えば、「高度:第四範囲」に対応する「水平成分変化量閾値」を「5(単位:μT、マイクロテスラ)」として記憶し、「高度:第四範囲」に対応する「垂直成分変化量閾値」を「5(単位:μT、マイクロテスラ)」として記憶したりする。ここで、図8に示す「高度:第一範囲」や「高度:第四範囲」は、例えば、「高度:20m」ごとに設定された範囲であり、「高度:第一範囲」は、地表からの高度が「0mから20m」の範囲を示しており、「高度:第四範囲」は、地表からの高度が「60mから80m」の範囲を示しているとする。   The threshold storage unit 20e stores a predetermined threshold set for each altitude for each of the horizontal component change amount and the vertical component change amount. Specifically, as shown in FIG. 8, “horizontal component change amount threshold value: H4”, “vertical component change amount threshold value: P4”, and the like are stored as threshold values associated with “altitude: fourth range”. . For example, “horizontal component change amount threshold” corresponding to “altitude: fourth range” is stored as “5 (unit: μT, micro Tesla)”, and “vertical component change amount corresponding to“ altitude: fourth range ”is stored. “Threshold” is stored as “5 (unit: μT, microtesla)”. Here, “altitude: first range” and “altitude: fourth range” shown in FIG. 8 are ranges set for each “altitude: 20 m”, for example. It is assumed that the altitude from "0m to 20m" indicates the range, and "altitude: fourth range" indicates the range from "60m to 80m" from the ground surface.

センサ情報記憶部20bは、後述するセンサ情報取得部30aが取得した情報を記憶し、方位決定用検出情報記憶部20cは、後述する「高度検出部30b、重力加速度検出部30c、歩行検出部30dおよび回転量検出部30e」が検出した結果それぞれを記憶し、地磁気変化量記憶部20dは、後述する地磁気変化量算出部30fが算出した結果を記憶し、決定方位記憶部20fは、後述する方位決定部30gが決定した装着者の方位を記憶する。なお、これらについては後に詳述する。   The sensor information storage unit 20b stores information acquired by a sensor information acquisition unit 30a, which will be described later, and the direction determination detection information storage unit 20c includes “an altitude detection unit 30b, a gravitational acceleration detection unit 30c, and a walk detection unit 30d, which will be described later. And the rotation amount detection unit 30e "are stored, the geomagnetic change amount storage unit 20d stores a result calculated by a geomagnetism change amount calculation unit 30f, which will be described later, and the determined direction storage unit 20f has an orientation, which will be described later. The orientation of the wearer determined by the determination unit 30g is stored. These will be described in detail later.

処理部30は、OS(Operating System)などの制御プログラム、各種の処理手順などを規定したプログラムおよび所要データを格納するための内部メモリを有し、これらによって種々の処理を実行し、特に本発明に密接に関連するものとしては、図3に示すように、センサ情報取得部30aと、高度検出部30bと、重力加速度検出部30cと、歩行検出部30dと、回転量検出部30eと、地磁気変化量算出部30fと、方位決定部30gと、位置検出部30hとを備える。ここで、高度検出部30bは、特許請求の範囲に記載の「高度算出手段」に対応し、重力加速度検出部30cは、同じく「傾き算出手段」に対応し、歩行検出部30dは、同じく「歩行判定手段」に対応し、回転量検出部30eは、同じく「回転量取得手段」に対応し、地磁気変化量算出部30fは、同じく「地磁気変化量算出手段」に対応し、方位決定部30gは、同じく「方位決定手段」に対応する。   The processing unit 30 includes a control program such as an OS (Operating System), a program that defines various processing procedures, and an internal memory for storing necessary data, and executes various processes using these, and in particular, the present invention. As shown in FIG. 3, the sensor information acquisition unit 30a, the altitude detection unit 30b, the gravitational acceleration detection unit 30c, the walking detection unit 30d, the rotation amount detection unit 30e, the geomagnetism, as shown in FIG. A change amount calculation unit 30f, an orientation determination unit 30g, and a position detection unit 30h are provided. Here, the altitude detection unit 30b corresponds to the “altitude calculation unit” described in the claims, the gravitational acceleration detection unit 30c also corresponds to the “inclination calculation unit”, and the walk detection unit 30d also includes “ Corresponding to the “walking determination means”, the rotation amount detection unit 30e corresponds to the “rotation amount acquisition unit”, and the geomagnetic change amount calculation unit 30f corresponds to the “geomagnetic change amount calculation unit”, and the direction determination unit 30g. Corresponds to the “azimuth determining means”.

センサ情報取得部30aは、各種センサ(加速度センサ13、磁気センサ14、気圧センサ15およびジャイロセンサ16)それぞれに設定された時間ごとに、各種センサからアナログ情報を取得し、設定パラメータ記憶部20aが記憶する各種センサごとに設定されたパラメータであるオフセット値およびゲイン値を用いて、取得したアナログ情報をデジタル情報に変換する。そして、センサ情報取得部30aは、変換したデータをセンサ情報記憶部20bに格納する。例えば、加速度センサ13に設定された時間が経過した場合に、加速度センサ13から取得したアナログ情報を、設定パラメータ記憶部20aが記憶する加速度センサ13のオフセット値およびゲイン値を用いて、デジタル情報に変換する。   The sensor information acquisition unit 30a acquires analog information from various sensors for each time set in each of the various sensors (acceleration sensor 13, magnetic sensor 14, atmospheric pressure sensor 15 and gyro sensor 16), and the setting parameter storage unit 20a The acquired analog information is converted into digital information using an offset value and a gain value which are parameters set for each of the various sensors to be stored. The sensor information acquisition unit 30a stores the converted data in the sensor information storage unit 20b. For example, when the time set in the acceleration sensor 13 has elapsed, the analog information acquired from the acceleration sensor 13 is converted into digital information using the offset value and gain value of the acceleration sensor 13 stored in the setting parameter storage unit 20a. Convert.

高度検出部30bは、センサ情報記憶部20bが記憶する「設定時間ごとに気圧センサ15から取得したアナログ情報から変換されたデジタル情報」を用いて、装着者が存在する高度を算出し、その結果を方位決定用検出情報記憶部20cに格納する。   The altitude detection unit 30b calculates the altitude at which the wearer is present using “digital information converted from analog information acquired from the barometric sensor 15 at every set time” stored in the sensor information storage unit 20b, and the result Is stored in the direction determining detection information storage unit 20c.

重力加速度検出部30cは、センサ情報記憶部20bが記憶する「設定時間ごとに加速度センサ13から取得したアナログ情報(重力加速度情報)から変換されたデジタル情報」を用いて、装着者の傾きを算出し、その結果を方位決定用検出情報記憶部20cに格納する。   The gravitational acceleration detection unit 30c calculates the inclination of the wearer using “digital information converted from analog information (gravity acceleration information) acquired from the acceleration sensor 13 every set time” stored in the sensor information storage unit 20b. Then, the result is stored in the direction determining detection information storage unit 20c.

歩行検出部30dは、センサ情報記憶部20bが記憶する「設定時間ごとに加速度センサ13から取得したアナログ情報から変換されたデジタル情報(3軸の加速度情報)」を用いて、装着者の歩行の有無を判定し、その結果を方位決定用検出情報記憶部20cに格納する。   The walking detection unit 30d uses the “digital information (three-axis acceleration information) converted from the analog information acquired from the acceleration sensor 13 at each set time” stored in the sensor information storage unit 20b to store the walking information of the wearer. The presence / absence is determined, and the result is stored in the direction determining detection information storage unit 20c.

回転量検出部30eは、センサ情報記憶部20bが記憶する「設定時間ごとにジャイロセンサ16から取得したアナログ情報から変換されたデジタル情報(回転量情報)」を用いて、装着者の体の回転量を算出し、その結果を方位決定用検出情報記憶部20cに格納する。   The rotation amount detection unit 30e uses the “digital information (rotation amount information) converted from analog information acquired from the gyro sensor 16 every set time” stored in the sensor information storage unit 20b to rotate the wearer's body. The amount is calculated, and the result is stored in the direction determining detection information storage unit 20c.

地磁気変化量算出部30fは、センサ情報記憶部20bが記憶する「設定時間ごとに磁気センサ14から取得したアナログ情報から変換されたデジタル情報(地磁気ベクトル情報)」を用いて、地磁気ベクトルの大きさの変化量である地磁気変化量を算出し、その結果を地磁気変化量記憶部20dに格納する。その際、地磁気変化量算出部30fは、方位決定用検出情報記憶部20cが記憶する装着者の傾きに基づいて、地磁気ベクトルの水平成分および垂直成分を取得し、所定の時間における(例えば、2秒間における)地磁気変化量として、地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出する。例えば、「時刻:t1」での地磁気ベクトルにおける「水平成分」が「H(t1)」であり、「垂直成分」が「P(t1)」であり、さらに所定の時間後の「時刻:t2」での地磁気ベクトルにおける「水平成分」が「H(t2)」であり、「垂直成分」が「P(t2)」であった場合、地磁気変化量算出部30fは、「時刻:t2」における「水平成分変化量」として「|H(t2)−H(t1)|=h(t2)」を算出し、「時刻:t2」における「垂直成分変化量」として「|P(t2)−P(t1)|=p(t2)」を算出する。   The geomagnetism change amount calculation unit 30f uses the “digital information (geomagnetic vector information) converted from the analog information acquired from the magnetic sensor 14 at every set time” stored in the sensor information storage unit 20b to store the magnitude of the geomagnetic vector. Is calculated, and the result is stored in the geomagnetism change storage unit 20d. At that time, the geomagnetism change amount calculation unit 30f acquires the horizontal component and the vertical component of the geomagnetic vector based on the inclination of the wearer stored in the azimuth determination detection information storage unit 20c, and at a predetermined time (for example, 2 The horizontal component change amount and the vertical component change amount, which are the change amounts of the horizontal component and the vertical component of the geomagnetic vector, are calculated as the geomagnetic change amount (in seconds). For example, the “horizontal component” in the geomagnetic vector at “time: t1” is “H (t1)”, the “vertical component” is “P (t1)”, and “time: t2 after a predetermined time” When the “horizontal component” in the geomagnetic vector at “H” is “H (t2)” and the “vertical component” is “P (t2)”, the geomagnetism change amount calculation unit 30f at “time: t2” “| H (t2) −H (t1) | = h (t2)” is calculated as the “horizontal component change amount”, and “| P (t2) −P as the“ vertical component change amount ”at“ time: t2 ”. (T1) | = p (t2) ”is calculated.

ここで、地磁気変化量記憶部20dは、図9の(A)に示すように、例えば、前回水平成分として、「時刻:t1」における「水平成分:H(t1)」を、また、前回垂直成分として、「時刻:t1」における「垂直成分:P(t1)」を記憶している。そして、地磁気変化量算出部30fは、センサ情報記憶部20bが記憶する「時刻:t2」における地磁気ベクトル情報と装着者の傾きとに基づいて、「水平成分:H(t2)」および「垂直成分:P(t2)」を算出し、さらに、図9の(A)に示す地磁気変化量記憶部20dを参照して、「時刻:t2」における「水平成分変化量:h(t2)」および「時刻:t2」における「垂直成分変化量:p(t2)」を算出し、その結果を、「今回水平成分:H(t2)」および「今回垂直成分:P(t2)」とともに格納する(図9の(B)参照)。また、地磁気変化量算出部30fは、後述する方位決定部30gによって装着者の方位が決定された後は、今回水平成分および今回垂直成分のデータを、前回水平成分および前回垂直成分のデータとして地磁気変化量記憶部20dに再格納する。すなわち、図9の(C)に示すように、前回水平成分として、「時刻:t2」における「水平成分:H(t2)」を、また、前回垂直成分として、「時刻:t2」における「垂直成分:P(t2)」を地磁気変化量記憶部20dに再格納する。   Here, as shown in FIG. 9A, for example, the geomagnetism change amount storage unit 20d uses “horizontal component: H (t1)” at “time: t1” as the previous horizontal component, and the previous vertical component. As a component, “vertical component: P (t1)” at “time: t1” is stored. Then, the geomagnetism change amount calculation unit 30f calculates “horizontal component: H (t2)” and “vertical component” based on the geomagnetic vector information at “time: t2” stored in the sensor information storage unit 20b and the inclination of the wearer. : P (t2) ", and referring to the geomagnetic change amount storage unit 20d shown in FIG. 9A, the" horizontal component change amount: h (t2) "and" “Vertical component change amount: p (t2)” at time: t2 is calculated, and the result is stored together with “current horizontal component: H (t2)” and “current vertical component: P (t2)” (FIG. 9 (B)). In addition, after the wearer's orientation is determined by an orientation determining unit 30g described later, the geomagnetism change amount calculating unit 30f uses the current horizontal component and current vertical component data as the previous horizontal component and previous vertical component data. Re-store in the change amount storage unit 20d. That is, as shown in FIG. 9C, “horizontal component: H (t2)” at “time: t2” is used as the previous horizontal component, and “vertical” at “time: t2” is used as the previous vertical component. The component: P (t2) ”is stored again in the geomagnetic change amount storage unit 20d.

方位決定部30gは、方位決定用検出情報記憶部20cが記憶する「判定された装着者の歩行の有無」と、「算出された高度」と、地磁気変化量記憶部20dが記憶する「水平成分変化量および垂直成分変化量」と、閾値記憶部20eが記憶する「水平成分変化量および垂直成分変化量それぞれに対して予め高度ごとに設定された所定の閾値」とに基づいて、装着者の方位を決定し、その結果を決定方位記憶部20fに格納する。具体的には、方位決定部30gは、方位決定用検出情報記憶部20cおよび閾値記憶部20eが記憶する情報を参照して、「装着者の歩行有」であり、かつ、「水平成分変化量が、算出された高度に対して設定された所定の閾値内」であり、かつ、「垂直成分変化量が、算出された高度に対して設定された所定の閾値内」である場合には、センサ情報記憶部20bが記憶する磁気センサ14が取得した地磁気ベクトルのデジタル情報から装着者の方位を決定する。   The azimuth determining unit 30g stores “the presence / absence of walking of the determined wearer” stored in the azimuth determination detection information storage unit 20c, “calculated altitude”, and “horizontal component” stored in the geomagnetic change amount storage unit 20d. Change amount and vertical component change amount "and a" predetermined threshold value preset for each altitude for each of the horizontal component change amount and the vertical component change amount "stored in the threshold storage unit 20e. The direction is determined, and the result is stored in the determined direction storage unit 20f. Specifically, the azimuth determining unit 30g refers to the information stored in the azimuth determining detection information storage unit 20c and the threshold storage unit 20e, and is “with wearer walking” and “horizontal component change amount” Is within a predetermined threshold set for the calculated altitude and "the vertical component change amount is within a predetermined threshold set for the calculated altitude" The orientation of the wearer is determined from the digital information of the geomagnetic vector acquired by the magnetic sensor 14 stored in the sensor information storage unit 20b.

また、方位決定部30gは、方位決定用検出情報記憶部20cおよび閾値記憶部20eが記憶する情報を参照して、「水平成分変化量が、算出された高度に対して設定された所定の閾値外」、または、「垂直成分変化量が、算出された高度に対して設定された所定の閾値外」である場合、および、「装着者の歩行無」である場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位にジャイロセンサ16から取得された回転量を加算した方位である回転量加算方位を装着者の方位として決定する。なお、地磁気ベクトルから算出されて決定された方位(最新方位)と、最新方位に回転量を加算した方位(回転量加算方位)とは、決定方位記憶部20fにおいて、それぞれ区別されて格納される。   Further, the azimuth determination unit 30g refers to the information stored in the azimuth determination detection information storage unit 20c and the threshold storage unit 20e, and “a predetermined threshold value set for the calculated altitude is set for the horizontal component change amount”. "Outside" or "when the vertical component change amount is outside the predetermined threshold set for the calculated altitude" and when "the wearer does not walk" The rotation amount addition azimuth, which is the azimuth obtained by adding the rotation amount acquired from the gyro sensor 16 to the latest azimuth determined from the latest geomagnetic vector indicating the geomagnetic change amount within the range, is determined as the wearer's azimuth. . Note that the direction calculated by using the geomagnetic vector (latest direction) and the direction obtained by adding the rotation amount to the latest direction (rotation amount addition direction) are stored separately in the determined direction storage unit 20f. .

例えば、方位決定部30gは、「時刻:t2」における装着者の高度が、例えば、「65m」と算出された場合、「時刻:t2」における「水平成分変化量:h(t2)」と、図8に示す「水平成分変化量閾値:H4」とを比較し、「時刻:t2」における「垂直成分変化量:p(t2)」と、図8に示す「垂直成分変化量閾値:P4」とを比較して、以下の3つの場合それぞれにおいて、方位を決定する。すなわち、加速度センサ13から取得した3軸の加速度情報から「時刻:t2」における「装着者の歩行有」と判定され、かつ、「水平成分変化量:h(t2)」が「水平成分変化量閾値:H4」以下であり、かつ、「垂直成分変化量:p(t2)」が「垂直成分変化量閾値:P4」以下である場合には、磁気センサ14が「時刻:t2」に取得した地磁気ベクトルから装着者の方位を決定する。   For example, when the wearer's altitude at “time: t2” is calculated to be “65 m”, for example, the azimuth determination unit 30g reads “horizontal component change amount: h (t2)” at “time: t2”. 8 is compared with “horizontal component change amount threshold value: H4”, “vertical component change amount: p (t2)” at “time: t2” and “vertical component change amount threshold value: P4” shown in FIG. And determine the orientation in each of the following three cases. That is, it is determined from the triaxial acceleration information acquired from the acceleration sensor 13 that “the wearer is walking” at “time: t2”, and “horizontal component change amount: h (t2)” is “horizontal component change amount”. When “threshold: H4” or less and “vertical component change amount: p (t2)” are “vertical component change amount threshold: P4” or less, the magnetic sensor 14 acquired at “time: t2”. The orientation of the wearer is determined from the geomagnetic vector.

また、「水平成分変化量:h(t2)」が「水平成分変化量閾値:H4」より大きい、または、「垂直成分変化量:p(t2)」が「垂直成分変化量閾値:P4」より大きい場合、もしくは、加速度センサ13から取得した3軸の加速度情報から「時刻:t2」における「装着者の歩行有」と判定された場合は、決定方位記憶部20fを参照して、最新方位にジャイロセンサ16から取得された回転量を加算した方位である回転量加算方位を装着者の方位として決定する。例えば、「時刻:t1」において決定された方位(南)が「最新方位」として決定方位記憶部20fに格納されている場合は、「最新方位」としての「南」にジャイロセンサ16から取得された回転量(例えば、45度)を加算した方位である回転量加算方位(例えば、南西)を装着者の方位として決定する。   Also, “horizontal component change amount: h (t2)” is larger than “horizontal component change amount threshold value: H4”, or “vertical component change amount: p (t2)” is more than “vertical component change amount threshold value: P4”. If it is large, or if it is determined that “the wearer is walking” at “time: t2” from the triaxial acceleration information acquired from the acceleration sensor 13, the determined orientation storage unit 20f is referred to and the latest orientation is obtained. The rotation amount addition azimuth that is the azimuth obtained by adding the rotation amounts acquired from the gyro sensor 16 is determined as the wearer's azimuth. For example, when the direction (south) determined at “time: t1” is stored in the determined direction storage unit 20f as “latest direction”, it is acquired from the gyro sensor 16 as “south” as “latest direction”. A rotation amount addition azimuth (for example, southwest), which is an azimuth obtained by adding the rotation amount (for example, 45 degrees), is determined as the azimuth of the wearer.

位置検出部30hは、センサ情報記憶部20bが記憶する加速度センサ13から取得したデジタル情報に基づいて、例えば、「時刻:t1」から「時刻:t2」の間の装着者の移動方向および移動距離を算出し、算出した移動方向および移動距離を、決定方位記憶部20fが記憶する「時刻:t2」における装着者の方位とともに、通信制御部11を介して、管理センター100に送信する。   The position detection unit 30h is based on the digital information acquired from the acceleration sensor 13 stored in the sensor information storage unit 20b, for example, the movement direction and the movement distance of the wearer between “time: t1” and “time: t2”. And the calculated moving direction and moving distance are transmitted to the management center 100 via the communication control unit 11 together with the wearer's direction at “time: t2” stored in the determined direction storage unit 20f.

[実施例1における位置検出携帯端末装置による処理の手順]
次に、図10〜12を用いて、実施例1における位置検出携帯端末装置10による処理を説明する。図10は、実施例1における位置検出携帯端末装置の各種センサから情報を取得する処理を説明するための図であり、図11は、実施例1における位置検出携帯端末装置の方位決定処理を説明するための図であり、図12は、実施例1における位置検出携帯端末装置の位置検出処理を説明するための図である。
[Procedure for Processing by Position Detection Portable Terminal Device in Embodiment 1]
Next, processing by the position detection portable terminal device 10 according to the first embodiment will be described with reference to FIGS. FIG. 10 is a diagram for explaining a process of acquiring information from various sensors of the position detection portable terminal device according to the first embodiment, and FIG. 11 illustrates an azimuth determination process of the position detection portable terminal device according to the first embodiment. FIG. 12 is a diagram for explaining position detection processing of the position detection portable terminal device according to the first embodiment.

[実施例1における位置検出携帯端末装置の各種センサから情報を取得する処理の手順]
図10に示すように、まず、実施例1における位置検出携帯端末装置10は、センサごとに設定された時間が経過すると(ステップS1001肯定)、センサ情報取得部30aは、設定時間が経過したセンサから情報を取得し、情報を受信したセンサにおいて設定されているオフセット値およびゲイン値を参照して、受信したアナログ情報からデジタル情報に変換する(ステップS1002)。例えば、センサ情報取得部30aは、加速度センサ13に設定された時間が経過した場合に、加速度センサ13から取得したアナログ情報を、設定パラメータ記憶部20aが記憶する加速度センサ13のオフセット値およびゲイン値を用いて、デジタル情報に変換する。
[Procedure for Processing to Acquire Information from Various Sensors of Position Detection Portable Terminal Device in Embodiment 1]
As shown in FIG. 10, first, when the time set for each sensor in the position detection portable terminal device 10 in Example 1 elapses (Yes in step S1001), the sensor information acquisition unit 30a Information is acquired from the received information, and the received analog information is converted into digital information with reference to the offset value and gain value set in the sensor that has received the information (step S1002). For example, when the time set in the acceleration sensor 13 has elapsed, the sensor information acquisition unit 30a stores the analog information acquired from the acceleration sensor 13 with the offset value and gain value of the acceleration sensor 13 stored in the setting parameter storage unit 20a. Is used to convert to digital information.

そして、センサ情報取得部30aは、変換したデジタル情報をセンサ情報記憶部20bに格納して(ステップS1003)、処理を終了する。   And the sensor information acquisition part 30a stores the converted digital information in the sensor information storage part 20b (step S1003), and complete | finishes a process.

[実施例1における位置検出携帯端末装置の方位決定処理の手順]
図11に示すように、まず、実施例1における位置検出携帯端末装置10は、位置検出用に設定された時間(例えば、2秒)が経過すると(ステップS1101肯定)、高度検出部30bは、センサ情報記憶部20bが記憶する「設定時間ごとに気圧センサ15から取得したアナログ情報から変換されたデジタル情報」を用いて、装着者が存在する高度を算出する(ステップS1102)。
[Procedure for Direction Determination Processing of Position Detection Portable Terminal Device in Embodiment 1]
As shown in FIG. 11, first, when the time (for example, 2 seconds) set for position detection elapses in the position detection portable terminal device 10 according to the first embodiment (Yes in step S1101), the altitude detection unit 30b The altitude at which the wearer is present is calculated using “digital information converted from analog information acquired from the barometric sensor 15 at each set time” stored in the sensor information storage unit 20b (step S1102).

そして、重力加速度検出部30cは、センサ情報記憶部20bが記憶する「設定時間ごとに加速度センサ13から取得したアナログ情報(重力加速度情報)から変換されたデジタル情報」を用いて、装着者の傾きを算出する(ステップS1103)。   Then, the gravitational acceleration detection unit 30c uses the “digital information converted from the analog information (gravity acceleration information) acquired from the acceleration sensor 13 at each set time” stored in the sensor information storage unit 20b, and the inclination of the wearer. Is calculated (step S1103).

続いて、地磁気変化量算出部30fは、センサ情報記憶部20bが記憶する「設定時間ごとに磁気センサ14から取得したアナログ情報から変換されたデジタル情報(地磁気ベクトル情報)」と、方位決定用検出情報記憶部20cが記憶する装着者の傾きに基づいて、所定の時間ごと(例えば、2秒ごと)に地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における(例えば、2秒間における)地磁気変化量として、地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出する(ステップS1104)。   Subsequently, the geomagnetism change amount calculation unit 30f stores “digital information converted from analog information acquired from the magnetic sensor 14 at each set time (geomagnetic vector information)” stored in the sensor information storage unit 20b, and detection for azimuth determination. Based on the wearer's inclination stored in the information storage unit 20c, the horizontal component and the vertical component of the geomagnetic vector are acquired every predetermined time (for example, every 2 seconds), and the predetermined time (for example, for 2 seconds) is acquired. ) As the geomagnetic change amount, the horizontal component change amount and the vertical component change amount, which are the change amounts of the horizontal component and the vertical component of the geomagnetic vector, are calculated (step S1104).

そののち、歩行検出部30dは、センサ情報記憶部20bが記憶する「設定時間ごとに加速度センサ13から取得したアナログ情報から変換されたデジタル情報(3軸の加速度情報)」を用いて、装着者の歩行の有無を判定する(ステップS1105)。   After that, the walking detection unit 30d uses the “digital information (three-axis acceleration information) converted from the analog information acquired from the acceleration sensor 13 every set time” stored in the sensor information storage unit 20b. The presence or absence of walking is determined (step S1105).

さらに、方位決定部30gは、地磁気変化量算出部30fが算出した地磁気変化量、すなわち水平成分変化量および垂直成分変化量が、閾値記憶部20eが記憶する閾値内であるか否かを判定する(ステップS1106)。   Furthermore, the azimuth determining unit 30g determines whether or not the geomagnetic change amount calculated by the geomagnetic change amount calculating unit 30f, that is, the horizontal component change amount and the vertical component change amount are within the threshold value stored in the threshold value storage unit 20e. (Step S1106).

そして、方位決定部30gは、地磁気変化量算出部30fが算出した水平成分変化量および垂直成分変化量ともに閾値記憶部20eが記憶する閾値内である場合には(ステップS1106肯定)、歩行検出部30dによって装着者が歩行しているとされているか否かを判定する(ステップS1107)。   Then, when both the horizontal component change amount and the vertical component change amount calculated by the geomagnetic change amount calculation unit 30f are within the threshold value stored in the threshold value storage unit 20e (Yes in step S1106), the azimuth determination unit 30g It is determined by 30d whether or not the wearer is walking (step S1107).

さらに、方位決定部30gは、歩行検出部30dによって装着者が歩行していると判定されている場合には(ステップS1107肯定)、磁気センサ14から取得した地磁気ベクトルから装着者の方位を決定して(ステップS1108)、処理を終了する。   Furthermore, when it is determined by the walking detection unit 30d that the wearer is walking (Yes at Step S1107), the direction determining unit 30g determines the direction of the wearer from the geomagnetic vector acquired from the magnetic sensor 14. (Step S1108), the process is terminated.

これに反して、方位決定部30gは、地磁気変化量算出部30fが算出した水平成分変化量または垂直成分変化量が、閾値記憶部20eが記憶する閾値外である場合(ステップS1106否定)、および、装着者が歩行していない場合には(ステップS1107否定)、最新方位に、回転量検出部30eが算出した装着者の体の回転量を加算して(回転量加算方位)、装着者の方位を決定し(ステップS1109)、処理を終了する。   On the other hand, the azimuth determining unit 30g determines that the horizontal component change amount or the vertical component change amount calculated by the geomagnetic change amount calculating unit 30f is outside the threshold value stored in the threshold value storage unit 20e (No in step S1106). When the wearer is not walking (No at Step S1107), the rotation amount of the wearer's body calculated by the rotation amount detection unit 30e is added to the latest direction (rotation amount addition direction), and the wearer's body The direction is determined (step S1109), and the process is terminated.

[実施例1における実施例1における位置検出携帯端末装置の位置検出処理の手順]
図12に示すように、まず、実施例1における位置検出携帯端末装置10は、方位決定部30gによって装着者の体の向きとしての方位が決定されると(ステップS1201肯定)、位置検出部30hは、センサ情報記憶部20bが記憶する加速度センサ13から取得したデジタル情報に基づいて、装着者の移動方向を算出する(ステップS1202)。
[Procedure for Position Detection Processing of Position Detection Portable Terminal Device in Embodiment 1 in Embodiment 1]
As shown in FIG. 12, first, in the position detection portable terminal device 10 according to the first embodiment, when the direction as the orientation of the wearer's body is determined by the direction determination unit 30g (Yes in step S1201), the position detection unit 30h. Calculates the moving direction of the wearer based on the digital information acquired from the acceleration sensor 13 stored in the sensor information storage unit 20b (step S1202).

そして、位置検出部30hは、センサ情報記憶部20bが記憶する加速度センサ13から取得したデジタル情報に基づいて、装着者の移動距離を算出する(ステップS1203)。   Then, the position detection unit 30h calculates the movement distance of the wearer based on the digital information acquired from the acceleration sensor 13 stored in the sensor information storage unit 20b (step S1203).

さらに、位置検出部30hは、決定方位記憶部20fが記憶する装着者の方位と、算出された移動方向および移動距離とを、通信制御部11を介して、管理センター100に送信する(ステップS1204)。   Furthermore, the position detection unit 30h transmits the wearer's orientation stored in the determined orientation storage unit 20f and the calculated movement direction and movement distance to the management center 100 via the communication control unit 11 (step S1204). ).

そののち、位置検出携帯端末装置10は、管理センター100から装着者の位置情報(例えば、装着者の位置情報を建物内の見取り図に対応付けた画像)を受信すると(ステップS1205肯定)、表示部12が備える液晶ディスプレイに、当該位置情報を表示して(ステップS1206)、処理を終了する。   After that, when the position detection portable terminal device 10 receives the position information of the wearer (for example, an image in which the position information of the wearer is associated with the floor plan in the building) from the management center 100 (Yes in step S1205), the display unit The position information is displayed on the liquid crystal display of 12 (step S1206), and the process ends.

[実施例1の効果]
上記したように、実施例1によれば、気圧センサ15から装着者が存在する場所の高度を算出し、加速度センサ13から重力加速度を検知して装着者の体の傾きを算出し、同じく、加速度センサ13が取得した加速度情報から装着者の歩行の有無を判定する。そして、磁気センサ14から所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における地磁気ベクトルの大きさの変化量である地磁気変化量を算出するが、その際、算出された傾きに基づいて、地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における地磁気変化量として、地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出する。そして、判定された歩行の有無と、算出された高度と、地磁気変化量として算出された水平成分変化量および垂直成分変化量それぞれと、水平成分変化量および垂直成分変化量それぞれに対して予め高度ごとに設定された所定の閾値とに基づいて、装着者の方位を決定する。すなわち、「装着者の歩行有」と判定され、かつ、水平成分変化量が、算出された高度に対して設定された所定の閾値内であり、かつ、垂直成分変化量が、算出された高度に対して設定された所定の閾値内である場合には、磁気センサ14が取得した地磁気ベクトルから装着者の方位を決定する。また、水平成分変化量が、算出された高度に対して設定された所定の閾値外、または、垂直成分変化量が、算出された高度に対して設定された所定の閾値外である場合、および、「装着者の歩行無」と判定された場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位にジャイロセンサ16から取得された回転量を加算した方位である回転量加算方位を装着者の方位として決定する。
[Effect of Example 1]
As described above, according to the first embodiment, the altitude of the place where the wearer is present is calculated from the atmospheric pressure sensor 15, the gravitational acceleration is detected from the acceleration sensor 13, and the inclination of the wearer's body is calculated. Whether or not the wearer is walking is determined from the acceleration information acquired by the acceleration sensor 13. Then, a geomagnetic vector is acquired from the magnetic sensor 14 every predetermined time, and the amount of change in geomagnetism, which is the amount of change in the magnitude of the geomagnetic vector at the predetermined time, is calculated. Based on the calculated inclination, Then, the horizontal component and the vertical component of the geomagnetic vector are acquired, and the horizontal component change amount and the vertical component change amount, which are the change amounts of the horizontal component and the vertical component of the geomagnetic vector, are calculated as the geomagnetic change amount at the predetermined time. Then, the altitude is calculated in advance for the determined presence / absence of walking, the calculated altitude, the horizontal component change amount and the vertical component change amount calculated as the geomagnetic change amount, and the horizontal component change amount and the vertical component change amount, respectively. The orientation of the wearer is determined based on a predetermined threshold set for each. That is, it is determined that “the wearer is walking”, the horizontal component change amount is within a predetermined threshold set for the calculated altitude, and the vertical component change amount is the calculated altitude. Is within a predetermined threshold set for the wearer, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor 14. Further, when the horizontal component change amount is outside a predetermined threshold set for the calculated altitude, or the vertical component change amount is outside the predetermined threshold set for the calculated altitude, and When it is determined that “the wearer does not walk”, it is acquired from the gyro sensor 16 in the latest azimuth, which is the azimuth determined from the latest geomagnetic vector indicating the amount of geomagnetic change within the predetermined threshold range. The rotation amount addition azimuth that is the azimuth obtained by adding the rotation amount is determined as the wearer's azimuth.

このようなことから、地点ごとの地磁気ベクトルの信頼度を判定するためのテーブルを別途保持せずに、地磁気変化量のみで磁気センサの取得した地磁気ベクトルの信頼度を容易に判定でき、装着者の体の向きとしての方位を簡易に決定することが可能になる。また、例えば、周囲の環境によって磁気センサの取得した地磁気ベクトルの誤差が大きいにも係らず、歩行無であるために地磁気変化量が「0」である場合においても、取得した地磁気ベクトルを採用することを回避することができ、装着者の体の向きの方位を正確に決定することが可能になる。また、歩行無でありながら、装着者の体が回転している場合であっても、最新方位を修正することができ、装着者の体の向きの方位をより正確に決定することが可能になる。また、磁気センサ14の取得した地磁気ベクトルにおいて、周囲の環境によって生じる誤差による信頼度の低下を、水平成分変化量および垂直成分変化量に分けてそれぞれ詳細に判定することができ、装着者の体の向きの方位をより簡易に決定することが可能になる。さらに、高度変化にともなう地磁気ベクトルそのものの変化にも容易に対応でき、装着者の体の向きの方位をより簡易かつ正確に決定することが可能になる。   For this reason, it is possible to easily determine the reliability of the geomagnetic vector acquired by the magnetic sensor based only on the amount of geomagnetism without separately maintaining a table for determining the reliability of the geomagnetic vector for each point. It is possible to easily determine the orientation as the body direction. Further, for example, even when the error of the geomagnetic vector acquired by the magnetic sensor is large due to the surrounding environment, the acquired geomagnetic vector is adopted even when the amount of change in geomagnetism is “0” because there is no walking. This can be avoided, and the orientation of the direction of the wearer's body can be accurately determined. In addition, the latest orientation can be corrected and the orientation of the wearer's body can be determined more accurately, even when the wearer's body is rotating without walking. Become. Further, in the geomagnetic vector acquired by the magnetic sensor 14, a decrease in reliability due to an error caused by the surrounding environment can be determined in detail for each of the horizontal component change amount and the vertical component change amount. It becomes possible to more easily determine the orientation of the direction. Furthermore, it is possible to easily cope with a change in the geomagnetic vector itself accompanying a change in altitude, and the orientation of the wearer's body can be determined more easily and accurately.

さて、これまで実施例1における位置検出携帯端末装置について説明したが、本発明は上述した実施例以外にも、種々の異なる形態にて実施されてもよいものである。そこで、以下では、実施例2における位置検出携帯端末装置として、種々の異なる実施例を(1)〜(2)に区分けして説明する。   The position detection portable terminal device according to the first embodiment has been described so far, but the present invention may be implemented in various different forms other than the above-described embodiments. Therefore, in the following, various different embodiments will be described as (1) to (2) as the position detection portable terminal device according to the second embodiment.

(1)システム構成等
上記の実施例1において説明した各処理のうち、自動的におこなわれるものとして説明した処理の全部または一部を手動でおこなうこともでき(例えば、位置検出用に設定された時間ごとに方位を決定するのではなく、管理センター100の管理者が方位決定の指示をするなどなど)、あるいは、手動的におこなうものとして説明した処理の全部または一部を公知の方法で自動的におこなうこともできる。この他、上記文章中や図面中で示した処理手順、具体的名称、各種のデータやパラメータを含む情報(例えば、磁気センサ14から地磁気ベクトルの情報を取得する所定の時間や、地磁気変化量の所定の閾値など)については、特記する場合を除いて任意に更新することができる。
(1) System Configuration, etc. Of the processes described in the first embodiment, all or part of the processes described as being automatically performed can be performed manually (for example, set for position detection). In other words, all or part of the processing described as being performed manually by a manager of the management center 100 instead of determining the azimuth every time, or by performing a known method. It can also be done automatically. In addition, information including processing procedures, specific names, various data and parameters shown in the above text and drawings (for example, a predetermined time for acquiring information on the geomagnetic vector from the magnetic sensor 14, and the amount of change in geomagnetism) The predetermined threshold value and the like can be arbitrarily updated unless otherwise specified.

また、図示した各装置の各構成要素は機能概念的なものであり、必ずしも物理的に図示の如く構成されていることを要しない。すなわち、各処理部および各記憶部の分散・統合の具体的形態(例えば、図3の形態など)は図示のものに限られず、例えば、重力加速度検出部30cと歩行検出部30dとを統合するなど、その全部または一部を、各種の負荷や使用状況などに応じて、任意の単位で機能的または物理的に分散・統合して構成することができる。さらに、各装置にて行なわれる各処理機能は、その全部または任意の一部が、CPUおよび当該CPUにて解析実行されるプログラムにて実現され、あるいは、ワイヤードロジックによるハードウェアとして実現され得る。   Further, each component of each illustrated apparatus is functionally conceptual, and does not necessarily need to be physically configured as illustrated. That is, the specific form (for example, the form of FIG. 3) of each processing part and each memory | storage part is not restricted to what is shown in figure, For example, the gravitational acceleration detection part 30c and the walk detection part 30d are integrated. All or a part of them can be configured to be functionally or physically distributed / integrated in an arbitrary unit according to various loads or usage conditions. Further, all or any part of each processing function performed in each device may be realized by a CPU and a program analyzed and executed by the CPU, or may be realized as hardware by wired logic.

(2)方位決定プログラム
ところで上記の実施例1では、ハードウェアロジックによって各種の処理を実現する場合を説明したが、本発明はこれに限定されるものではなく、あらかじめ用意されたプログラムをコンピュータで実行するようにしてもよい。そこで以下では、図13を用いて、上記の実施例1に示した位置検出携帯端末装置10と同様の機能を有する方位決定プログラムを実行するコンピュータの一例を説明する。図13は、実施例1の方位決定プログラムを実行するコンピュータを示す図である。
(2) Orientation Determination Program In the first embodiment, the case where various processes are realized by hardware logic has been described. However, the present invention is not limited to this, and a program prepared in advance is executed by a computer. You may make it perform. Therefore, in the following, an example of a computer that executes an azimuth determination program having the same function as that of the position detection portable terminal device 10 described in the first embodiment will be described with reference to FIG. FIG. 13 is a diagram illustrating a computer that executes the orientation determination program according to the first embodiment.

図13に示すように、情報処理装置としてのコンピュータ130は、キーボード131、ディスプレイ132、CPU133、ROM134、HDD135、RAM136、通信制御部11、加速度センサ13、磁気センサ14、気圧センサ15およびジャイロセンサ16をバス137などで接続して構成される。   As shown in FIG. 13, a computer 130 as an information processing apparatus includes a keyboard 131, a display 132, a CPU 133, a ROM 134, an HDD 135, a RAM 136, a communication control unit 11, an acceleration sensor 13, a magnetic sensor 14, an atmospheric pressure sensor 15, and a gyro sensor 16. Are connected by a bus 137 or the like.

ROM134には、上記の実施例1に示した位置検出携帯端末装置10と同様の機能を発揮する方位決定プログラム、つまり、図13に示すように、センサ情報取得プログラム134a、高度検出プログラム134b、重力加速度検出プログラム134c、歩行検出プログラム134d、回転量検出プログラム134e、地磁気変化量算出プログラム134f、方位決定プログラム134g、位置検出プログラム134hが予め記憶されている。なお、これらのプログラム134a〜134hについては、図3に示した位置検出携帯端末装置10の各構成要素と同様、適宜統合または分散してもよい。   The ROM 134 has an orientation determination program that exhibits the same function as that of the position detection portable terminal device 10 described in the first embodiment, that is, as shown in FIG. 13, a sensor information acquisition program 134a, an altitude detection program 134b, a gravity An acceleration detection program 134c, a walk detection program 134d, a rotation amount detection program 134e, a geomagnetic change amount calculation program 134f, an orientation determination program 134g, and a position detection program 134h are stored in advance. Note that these programs 134a to 134h may be integrated or distributed as appropriate, as with each component of the position detection portable terminal device 10 shown in FIG.

そして、CPU133が、これらのプログラム134a〜134hをROM134から読みだして実行することで、図13に示すように、各プログラム134a〜134hは、センサ情報取得プロセス133a、高度検出プロセス133b、重力加速度検出プロセス133c、歩行検出プロセス133d、回転量検出プロセス133e、地磁気変化量算出プロセス133f、方位決定プロセス133g、位置検出プロセス133hとして機能するようになる。なお、各プロセス133a〜133hは、図3に示した、センサ情報取得部30a、高度検出部30b、重力加速度検出部30c、歩行検出部30d、回転量検出部30e、地磁気変化量算出部30f、方位決定部30g、位置検出部30hにそれぞれ対応する。   Then, the CPU 133 reads out and executes these programs 134a to 134h from the ROM 134, and as shown in FIG. 13, the programs 134a to 134h include a sensor information acquisition process 133a, an altitude detection process 133b, and a gravitational acceleration detection. It functions as a process 133c, a walking detection process 133d, a rotation detection process 133e, a geomagnetic change calculation process 133f, an orientation determination process 133g, and a position detection process 133h. Each of the processes 133a to 133h includes a sensor information acquisition unit 30a, an altitude detection unit 30b, a gravitational acceleration detection unit 30c, a walking detection unit 30d, a rotation amount detection unit 30e, a geomagnetic change amount calculation unit 30f illustrated in FIG. This corresponds to the azimuth determination unit 30g and the position detection unit 30h, respectively.

また、HDD135には、図13に示すように、設定パラメータ記憶データ135aと、センサ情報記憶データ135bと、方位決定用検出情報記憶データ135cと、地磁気変化量記憶データ135dと、閾値記憶データ135eと、決定方位記憶データ135fとが設けられる。この設定パラメータ記憶データ135aは、図3に用いた設定パラメータ記憶部20aに対応し、センサ情報記憶データ135bはセンサ情報記憶部20bに対応し、地磁気変化量記憶データ135dは地磁気変化量記憶部20dに対応し、方位決定用検出情報記憶データ135cは方位決定用検出情報記憶部20cに対応し、閾値記憶データ135eは閾値記憶部20eに対応し、決定方位記憶データ135fは決定方位記憶部20fに対応する。そしてCPU133は、設定パラメータ記憶データ136aを設定パラメータ記憶データ135aに対して登録し、センサ情報記憶データ136bをセンサ情報記憶データ135bに対して登録し、方位決定用検出情報記憶データ136cを方位決定用検出情報記憶データ135cに対して登録し、地磁気変化量記憶データ136dを地磁気変化量記憶データ135dに対して登録し、閾値記憶データ136eを閾値記憶データ135eに対して登録し、決定方位記憶データ136fを決定方位記憶データ135fに対して登録し、この設定パラメータ記憶データ136aと、センサ情報記憶データ136bと、方位決定用検出情報記憶データ136cと、地磁気変化量記憶データ136dと、閾値記憶データ136eと、決定方位記憶データ136fとを読み出してRAM136に格納し、RAM136に格納された設定パラメータ記憶データ136aと、センサ情報記憶データ136bと、方位決定用検出情報記憶データ136cと、地磁気変化量記憶データ136dと、閾値記憶データ136eと、決定方位記憶データ136fとに基づいて方位決定処理を実行し、さらに位置検出処理を実行する。   Further, as shown in FIG. 13, the HDD 135 includes setting parameter storage data 135a, sensor information storage data 135b, direction determination detection information storage data 135c, geomagnetic change amount storage data 135d, and threshold storage data 135e. Determination direction storage data 135f is provided. The setting parameter storage data 135a corresponds to the setting parameter storage unit 20a used in FIG. 3, the sensor information storage data 135b corresponds to the sensor information storage unit 20b, and the geomagnetic change amount storage data 135d corresponds to the geomagnetic change amount storage unit 20d. The azimuth determination detection information storage data 135c corresponds to the azimuth determination detection information storage unit 20c, the threshold storage data 135e corresponds to the threshold storage unit 20e, and the determined azimuth storage data 135f is stored in the determination azimuth storage unit 20f. Correspond. Then, the CPU 133 registers the setting parameter storage data 136a with respect to the setting parameter storage data 135a, registers the sensor information storage data 136b with respect to the sensor information storage data 135b, and uses the direction determination detection information storage data 136c for direction determination. Registered with the detection information storage data 135c, registered the geomagnetic variation storage data 136d with the geomagnetic variation storage data 135d, registered the threshold storage data 136e with the threshold storage data 135e, and determined orientation storage data 136f. Is registered in the determined azimuth storage data 135f, the setting parameter storage data 136a, the sensor information storage data 136b, the azimuth determination detection information storage data 136c, the geomagnetic change amount storage data 136d, and the threshold storage data 136e, , Determined orientation memory data 136f is read out and stored in the RAM 136. The setting parameter storage data 136a, the sensor information storage data 136b, the direction determining detection information storage data 136c, the geomagnetic variation storage data 136d, and the threshold storage data stored in the RAM 136 are read out. Based on 136e and the determined azimuth storage data 136f, an azimuth determination process is executed, and a position detection process is further executed.

なお、上記した各プログラム134a〜134hについては、必ずしも最初からROM134に記憶させておく必要はなく、例えばコンピュータ130に挿入されるフレキシブルディスク(FD)、CD−ROM、MOディスク、DVDディスク、光磁気ディスク、ICカードなどの「可搬用の物理媒体」、または、コンピュータ130の内外に備えられるHDDなどの「固定用物理媒体」、さらには、公衆回線、インターネット、LAN、WANなどを介してコンピュータ130に接続される「他のコンピュータ(またはサーバ)」などに各プログラムを記憶させておき、コンピュータ130がこれらから各プログラムを読み出して実行するようにしてもよい。   Note that the above-described programs 134a to 134h are not necessarily stored in the ROM 134 from the beginning. For example, a flexible disk (FD), a CD-ROM, an MO disk, a DVD disk, a magneto-optical disk inserted into the computer 130, and the like. The computer 130 via a “portable physical medium” such as a disk or IC card, or a “fixed physical medium” such as an HDD provided inside or outside the computer 130, and further via a public line, the Internet, a LAN, a WAN, etc. Each program may be stored in “another computer (or server)” connected to the computer, and the computer 130 may read and execute each program from these programs.

(付記1)磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出手段と、
前記地磁気変化量算出手段によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定手段と、
を備えたことを特徴とする位置検出携帯端末装置。
(Appendix 1) A geomagnetism change amount calculating means for acquiring a geomagnetism vector from a magnetic sensor every predetermined time and calculating a geomagnetism change amount that is a change amount of the geomagnetic vector at the predetermined time;
When the geomagnetism variation calculated by the geomagnetism variation calculation means is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and the geomagnetism variation is calculated. If it is outside the range of the predetermined threshold, the latest azimuth determined from the latest geomagnetic vector indicating the amount of geomagnetic change within the range of the predetermined threshold is adopted as the azimuth of the wearer. Orientation determining means to determine;
A position detection portable terminal device comprising:

(付記2)加速度センサが取得した加速度情報から前記装着者の歩行の有無を判定する歩行判定手段をさらに備え、
前記方位決定手段は、前記地磁気変化量算出手段によって算出された前記地磁気変化量が所定の閾値の範囲内であり、かつ、前記歩行判定手段によって前記装着者の歩行有と判定された場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合、または、前記歩行判定手段によって前記装着者の歩行無と判定された場合は、前記最新方位を前記装着者の前記方位として採用して決定することを特徴とする付記1に記載の位置検出携帯端末装置。
(Additional remark 2) It further has the walk determination means which determines the presence or absence of the said wearer's walk from the acceleration information which the acceleration sensor acquired,
The azimuth determining means is when the geomagnetic change amount calculated by the geomagnetic change amount calculating means is within a predetermined threshold range, and the walking determining means determines that the wearer is walking. The direction of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and when the geomagnetism change amount is outside the predetermined threshold range, or when the wearer does not walk by the walking determination means. When determined, the position detection portable terminal device according to appendix 1, wherein the latest direction is adopted as the direction of the wearer and determined.

(付記3)ジャイロセンサから前記装着者の回転量を取得する回転量取得手段をさらに備え、
前記方位決定手段は、前記地磁気変化量算出手段によって算出された前記地磁気変化量が所定の閾値の範囲外である場合は、前記最新方位に前記回転量取得手段によって取得された前記回転量を加算した方位である回転量加算方位を前記装着者の前記方位として決定することを特徴とする付記1に記載の位置検出携帯端末装置。
(Additional remark 3) The rotation amount acquisition means which acquires the rotation amount of the said wearer from a gyro sensor is further provided,
The azimuth determining unit adds the rotation amount acquired by the rotation amount acquiring unit to the latest azimuth when the geomagnetic change amount calculated by the geomagnetic change amount calculating unit is outside a predetermined threshold range. The position detection portable terminal device according to appendix 1, wherein a rotation amount addition azimuth that is an azimuth is determined as the azimuth of the wearer.

(付記4)前記方位決定手段は、前記地磁気変化量算出手段によって算出された前記地磁気変化量が当該所定の閾値の範囲外である場合、または、前記歩行判定手段によって前記装着者の歩行無と判定された場合は、前記最新方位に前記回転量取得手段によって取得された前記回転量を加算した方位である回転量加算方位を前記装着者の前記方位として決定することを特徴とする付記2に記載の位置検出携帯端末装置。 (Supplementary Note 4) The azimuth determining means may determine that the wearer is not walking when the geomagnetic change amount calculated by the geomagnetic change amount calculating means is outside the predetermined threshold range, or by the walking determining means. If determined, the rotation amount addition azimuth that is the azimuth obtained by adding the rotation amount acquired by the rotation amount acquisition means to the latest azimuth is determined as the azimuth of the wearer. The position detection portable terminal device described.

(付記5)前記加速度センサから重力加速度を検知して前記装着者の体の傾きを算出する傾き算出手段をさらに備え、
前記地磁気変化量算出手段は、前記傾き算出手段によって算出された前記傾きに基づいて、前記磁気センサから前記所定の時間ごとに前記地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における前記地磁気変化量として、前記地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出し、
前記方位決定手段は、前記水平成分変化量および前記垂直成分変化量それぞれに設定された所定の閾値と、前記地磁気変化量算出手段によって算出された前記水平成分変化量および前記垂直成分変化量それぞれとに基づいて前記方位を決定することを特徴とする付記1〜4のいずれか一つに記載の位置検出携帯端末装置。
(Additional remark 5) It further includes inclination calculation means for detecting the gravitational acceleration from the acceleration sensor and calculating the inclination of the wearer's body,
The geomagnetic change amount calculating means acquires a horizontal component and a vertical component of the geomagnetic vector at the predetermined time from the magnetic sensor based on the inclination calculated by the inclination calculating means, and at the predetermined time. As the geomagnetic change amount, a horizontal component change amount and a vertical component change amount that are horizontal component and vertical component change amounts of the geomagnetic vector are calculated,
The azimuth determining means includes a predetermined threshold set for each of the horizontal component change amount and the vertical component change amount, and each of the horizontal component change amount and the vertical component change amount calculated by the geomagnetic change amount calculation means. The position detection portable terminal device according to any one of appendices 1 to 4, wherein the azimuth is determined on the basis of the position.

(付記6)気圧センサから前記装着者が存在する場所の高度を算出する高度算出手段をさらに備え、
前記方位決定手段は、前記高度ごとに設定された所定の閾値と、前記地磁気変化量算出手段によって算出された前記地磁気変化量と、前記高度算出手段によって算出された前記高度とに基づいて前記方位を決定することを特徴とする付記1〜5のいずれか一つに記載の位置検出携帯端末装置。
(Additional remark 6) The altitude calculation means which calculates the altitude of the place where the said wearer exists from an atmospheric pressure sensor is further provided,
The azimuth determining means is based on the predetermined threshold set for each altitude, the geomagnetic change amount calculated by the geomagnetic change amount calculating means, and the altitude calculated by the altitude calculating means. The position detection portable terminal device according to any one of appendices 1 to 5, wherein the position detection portable terminal device is determined.

(付記7)装着者の体の向きとしての方位を決定する方位決定方法であって、
磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出工程と、
前記地磁気変化量算出工程によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定工程と、
を含んだことを特徴とする方位決定方法。
(Supplementary note 7) An orientation determination method for determining an orientation as a direction of a wearer's body,
A geomagnetism change amount calculating step for obtaining a geomagnetism vector from the magnetic sensor every predetermined time and calculating a geomagnetism change amount which is a change amount of the magnitude of the geomagnetism vector at the predetermined time;
When the geomagnetism variation calculated by the geomagnetism variation calculation step is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and the geomagnetism variation is calculated. If it is out of the predetermined threshold range, the latest azimuth determined from the latest geomagnetic vector indicating the amount of change within the predetermined threshold range is adopted as the azimuth of the wearer. An orientation determination step to
An orientation determination method characterized by including

(付記8)装着者の体の向きとしての方位を決定する方位決定方法をコンピュータに実行させる方位決定プログラムであって、
磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出手順と、
前記地磁気変化量算出手順によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定手順と、
をコンピュータに実行させることを特徴とする方位決定プログラム。
(Appendix 8) An orientation determination program for causing a computer to execute an orientation determination method for determining an orientation as a body orientation of a wearer,
Obtaining a geomagnetic vector from the magnetic sensor every predetermined time, and calculating a geomagnetic change amount that calculates a geomagnetic change amount that is a change amount of the geomagnetic vector at the predetermined time; and
When the geomagnetic variation calculated by the geomagnetic variation calculation procedure is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and the geomagnetic variation is When it is out of the predetermined threshold range, the latest direction which is the direction determined from the latest geomagnetic vector indicating the amount of change within the predetermined threshold range is adopted as the direction of the wearer. Azimuth determination procedure,
Is an orientation determination program that causes a computer to execute.

以上のように、本発明に係る位置検出携帯端末装置、方位決定方法および方位決定プログラムは、装着者の体の向きとしての方位と、当該装着者の移動方向および移動距離とに基づいて当該装着者の位置を検出する場合に有用であり、特に、装着者の体の向きとしての方位を簡易に決定することが可能になることに適する。   As described above, the position detection portable terminal device, the azimuth determination method, and the azimuth determination program according to the present invention are based on the azimuth as the direction of the wearer's body and the wearer's movement direction and movement distance. This is useful when detecting the position of the wearer, and is particularly suitable for easily determining the orientation as the orientation of the wearer's body.

実施例1における位置検出携帯端末装置の概要を説明するための図である。It is a figure for demonstrating the outline | summary of the position detection portable terminal device in Example 1. FIG. 実施例1における位置検出携帯端末装置の特徴を説明するための図である。It is a figure for demonstrating the characteristic of the position detection portable terminal device in Example 1. FIG. 実施例1における位置検出携帯端末装置の構成を示すブロック図である。It is a block diagram which shows the structure of the position detection portable terminal device in Example 1. FIG. 加速度センサの出力例を説明するための図である。It is a figure for demonstrating the example of an output of an acceleration sensor. 磁気センサの出力例を説明するための図である。It is a figure for demonstrating the example of an output of a magnetic sensor. 気圧センサの出力例を説明するための図である。It is a figure for demonstrating the output example of an atmospheric pressure sensor. ジャイロセンサの出力例を説明するための図である。It is a figure for demonstrating the example of an output of a gyro sensor. 閾値記憶部を説明するための図である。It is a figure for demonstrating a threshold value memory | storage part. 地磁気変化量記憶部を説明するための図である。It is a figure for demonstrating a geomagnetic change amount memory | storage part. 実施例1における位置検出携帯端末装置の各種センサから情報を取得する処理を説明するための図である。It is a figure for demonstrating the process which acquires information from the various sensors of the position detection portable terminal device in Example 1. FIG. 実施例1における位置検出携帯端末装置の方位決定処理を説明するための図である。It is a figure for demonstrating the azimuth | direction determination process of the position detection portable terminal device in Example 1. FIG. 実施例1における位置検出携帯端末装置の位置検出処理を説明するための図である。It is a figure for demonstrating the position detection process of the position detection portable terminal device in Example 1. FIG. 実施例1の方位決定プログラムを実行するコンピュータを示す図である。It is a figure which shows the computer which performs the azimuth | direction determination program of Example 1. FIG.

符号の説明Explanation of symbols

10 位置検出携帯端末装置
11 通信制御部
12 表示部
13 加速度センサ
14 磁気センサ
15 気圧センサ
16 ジャイロセンサ
17 入出力制御I/F部
20 記憶部
20a 設定パラメータ記憶部
20b センサ情報記憶部
20c 方位決定用検出情報記憶部
20d 地磁気変化量記憶部
20e 閾値記憶部
20f 決定方位記憶部
30 処理部
30a センサ情報取得部
30b 高度検出部
30c 重力加速度検出部
30d 歩行検出部
30e 回転量検出部
30f 地磁気変化量算出部
30g 方位決定部
30h 位置検出部
100 管理センター
DESCRIPTION OF SYMBOLS 10 Position detection portable terminal device 11 Communication control part 12 Display part 13 Acceleration sensor 14 Magnetic sensor 15 Atmospheric pressure sensor 16 Gyro sensor 17 Input / output control I / F part 20 Storage part 20a Setting parameter storage part 20b Sensor information storage part 20c For direction determination Detection information storage unit 20d Geomagnetic change amount storage unit 20e Threshold storage unit 20f Determination direction storage unit 30 Processing unit 30a Sensor information acquisition unit 30b Altitude detection unit 30c Gravitational acceleration detection unit 30d Walking detection unit 30e Rotation amount detection unit 30f Geomagnetic change calculation 30g Direction determining unit 30h Position detecting unit 100 Management center

Claims (7)

磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出手段と、
前記地磁気変化量算出手段によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の地磁気変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定手段と、
を備えたことを特徴とする位置検出携帯端末装置。
A geomagnetism change amount calculating means for acquiring a geomagnetism vector from the magnetic sensor every predetermined time and calculating a geomagnetism change amount that is a change amount of the geomagnetic vector at the predetermined time;
When the geomagnetism variation calculated by the geomagnetism variation calculation means is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and the geomagnetism variation is calculated. If it is outside the range of the predetermined threshold, the latest azimuth determined from the latest geomagnetic vector indicating the amount of geomagnetic change within the range of the predetermined threshold is adopted as the azimuth of the wearer. Orientation determining means to determine;
A position detection portable terminal device comprising:
加速度センサが取得した加速度情報から前記装着者の歩行の有無を判定する歩行判定手段をさらに備え、
前記方位決定手段は、前記地磁気変化量算出手段によって算出された前記地磁気変化量が所定の閾値の範囲内であり、かつ、前記歩行判定手段によって前記装着者の歩行有と判定された場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合、または、前記歩行判定手段によって前記装着者の歩行無と判定された場合は、前記最新方位を前記装着者の前記方位として採用して決定することを特徴とする請求項1に記載の位置検出携帯端末装置。
A walking determination means for determining whether or not the wearer is walking from acceleration information acquired by the acceleration sensor;
The azimuth determining means is when the geomagnetic change amount calculated by the geomagnetic change amount calculating means is within a predetermined threshold range, and the walking determining means determines that the wearer is walking. The direction of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and when the geomagnetism change amount is outside the predetermined threshold range, or when the wearer does not walk by the walking determination means. The position detection portable terminal device according to claim 1, wherein if it is determined, the latest direction is adopted as the direction of the wearer and determined.
ジャイロセンサから前記装着者の回転量を取得する回転量取得手段をさらに備え、
前記方位決定手段は、前記地磁気変化量算出手段によって算出された前記地磁気変化量が所定の閾値の範囲外である場合は、前記最新方位に前記回転量取得手段によって取得された前記回転量を加算した方位である回転量加算方位を前記装着者の前記方位として決定することを特徴とする請求項1に記載の位置検出携帯端末装置。
A rotation amount acquisition means for acquiring the rotation amount of the wearer from a gyro sensor;
The azimuth determining unit adds the rotation amount acquired by the rotation amount acquiring unit to the latest azimuth when the geomagnetic change amount calculated by the geomagnetic change amount calculating unit is outside a predetermined threshold range. The position detection portable terminal device according to claim 1, wherein a rotation amount addition azimuth that is a determined azimuth is determined as the azimuth of the wearer.
前記加速度センサから重力加速度を検知して前記装着者の体の傾きを算出する傾き算出手段をさらに備え、
前記地磁気変化量算出手段は、前記傾き算出手段によって算出された前記傾きに基づいて、前記磁気センサから前記所定の時間ごとに前記地磁気ベクトルの水平成分および垂直成分を取得し、当該所定の時間における前記地磁気変化量として、前記地磁気ベクトルの水平成分および垂直成分の変化量である水平成分変化量および垂直成分変化量それぞれを算出し、
前記方位決定手段は、前記水平成分変化量および前記垂直成分変化量それぞれに設定された所定の閾値と、前記地磁気変化量算出手段によって算出された前記水平成分変化量および前記垂直成分変化量それぞれとに基づいて前記方位を決定することを特徴とする請求項1〜3のいずれか一つに記載の位置検出携帯端末装置。
An inclination calculating means for detecting gravitational acceleration from the acceleration sensor and calculating the inclination of the wearer's body;
The geomagnetic change amount calculating means acquires a horizontal component and a vertical component of the geomagnetic vector at the predetermined time from the magnetic sensor based on the inclination calculated by the inclination calculating means, and at the predetermined time. As the geomagnetic change amount, a horizontal component change amount and a vertical component change amount that are horizontal component and vertical component change amounts of the geomagnetic vector are calculated,
The azimuth determining means includes a predetermined threshold set for each of the horizontal component change amount and the vertical component change amount, and each of the horizontal component change amount and the vertical component change amount calculated by the geomagnetic change amount calculation means. The position detection portable terminal device according to claim 1, wherein the azimuth is determined based on the position.
気圧センサから前記装着者が存在する場所の高度を算出する高度算出手段をさらに備え、
前記方位決定手段は、前記高度ごとに設定された所定の閾値と、前記地磁気変化量算出手段によって算出された前記地磁気変化量と、前記高度算出手段によって算出された前記高度とに基づいて前記方位を決定することを特徴とする請求項1〜4のいずれか一つに記載の位置検出携帯端末装置。
An altitude calculating means for calculating the altitude of the place where the wearer is present from an atmospheric pressure sensor;
The azimuth determining means is based on the predetermined threshold set for each altitude, the geomagnetic change amount calculated by the geomagnetic change amount calculating means, and the altitude calculated by the altitude calculating means. The position detection portable terminal device according to claim 1, wherein the position detection portable terminal device is determined.
装着者の体の向きとしての方位を決定する方位決定方法であって、
磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出工程と、
前記地磁気変化量算出工程によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定工程と、
を含んだことを特徴とする方位決定方法。
An orientation determination method for determining an orientation as a direction of a wearer's body,
A geomagnetism change amount calculating step for obtaining a geomagnetism vector from the magnetic sensor every predetermined time and calculating a geomagnetism change amount which is a change amount of the magnitude of the geomagnetism vector at the predetermined time;
When the geomagnetism variation calculated by the geomagnetism variation calculation step is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and the geomagnetism variation is calculated. When it is out of the predetermined threshold range, the latest direction which is the direction determined from the latest geomagnetic vector indicating the amount of change within the predetermined threshold range is adopted as the direction of the wearer. An orientation determination step to
An orientation determination method characterized by including
装着者の体の向きとしての方位を決定する方位決定方法をコンピュータに実行させる方位決定プログラムであって、
磁気センサから所定の時間ごとに地磁気ベクトルを取得し、当該所定の時間における前記地磁気ベクトルの大きさの変化量である地磁気変化量を算出する地磁気変化量算出手順と、
前記地磁気変化量算出手順によって算出された地磁気変化量が所定の閾値の範囲内である場合は、前記磁気センサが取得した前記地磁気ベクトルから前記装着者の前記方位を決定し、当該地磁気変化量が当該所定の閾値の範囲外である場合は、当該所定の閾値の範囲内の変化量を示した最新の地磁気ベクトルから決定された方位である最新方位を前記装着者の前記方位として採用して決定する方位決定手順と、
をコンピュータに実行させることを特徴とする方位決定プログラム。
An orientation determination program for causing a computer to execute an orientation determination method for determining an orientation as a body orientation of a wearer,
Obtaining a geomagnetic vector from the magnetic sensor every predetermined time, and calculating a geomagnetic change amount that calculates a geomagnetic change amount that is a change amount of the geomagnetic vector at the predetermined time; and
When the geomagnetic variation calculated by the geomagnetic variation calculation procedure is within a predetermined threshold range, the orientation of the wearer is determined from the geomagnetic vector acquired by the magnetic sensor, and the geomagnetic variation is When it is out of the predetermined threshold range, the latest direction which is the direction determined from the latest geomagnetic vector indicating the amount of change within the predetermined threshold range is adopted as the direction of the wearer. Azimuth determination procedure,
Is an orientation determination program that causes a computer to execute.
JP2007127326A 2007-05-11 2007-05-11 POSITION DETECTION PORTABLE TERMINAL DEVICE, azimuth determining method Active JP4900030B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007127326A JP4900030B2 (en) 2007-05-11 2007-05-11 POSITION DETECTION PORTABLE TERMINAL DEVICE, azimuth determining method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007127326A JP4900030B2 (en) 2007-05-11 2007-05-11 POSITION DETECTION PORTABLE TERMINAL DEVICE, azimuth determining method

Publications (2)

Publication Number Publication Date
JP2008281494A true JP2008281494A (en) 2008-11-20
JP4900030B2 JP4900030B2 (en) 2012-03-21

Family

ID=40142424

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007127326A Active JP4900030B2 (en) 2007-05-11 2007-05-11 POSITION DETECTION PORTABLE TERMINAL DEVICE, azimuth determining method

Country Status (1)

Country Link
JP (1) JP4900030B2 (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010004873A1 (en) * 2008-07-08 2010-01-14 アルプス電気株式会社 Azimuth calculation device and azimuth calculation method
WO2011057182A2 (en) * 2009-11-06 2011-05-12 University Of Maryland, College Park Method and system for determining relative displacement and heading for navigation
JP2013505875A (en) * 2009-09-29 2013-02-21 ルノー・トラックス Electronically controlled parking and brake system
KR20140090071A (en) * 2013-01-08 2014-07-16 삼성전자주식회사 Method for determining user exercies information and apparatus for the same
US8860801B2 (en) 2011-09-08 2014-10-14 Sony Corporation Electronic device and image pickup apparatus
WO2015025614A1 (en) * 2013-08-22 2015-02-26 ソニー株式会社 Information processing device, information processing method, and recording medium

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH03148010A (en) * 1989-11-02 1991-06-24 Matsushita Electric Ind Co Ltd Azimuth detecting apparatus mounted in vehicle
JPH08114454A (en) * 1994-08-29 1996-05-07 Yuseisho Tsushin Sogo Kenkyusho Method for measuring azimuth for automoble
JPH08313260A (en) * 1995-05-18 1996-11-29 Toyota Motor Corp Detection device of vehicle azimuth
JP2000111629A (en) * 1998-10-08 2000-04-21 Mitsubishi Electric Corp Magnetometer
JP2004264028A (en) * 2003-01-15 2004-09-24 National Institute Of Advanced Industrial & Technology Attitude angle processing unit and attitude angle processing method
WO2007020702A1 (en) * 2005-08-18 2007-02-22 C & N Inc Sensor device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH03148010A (en) * 1989-11-02 1991-06-24 Matsushita Electric Ind Co Ltd Azimuth detecting apparatus mounted in vehicle
JPH08114454A (en) * 1994-08-29 1996-05-07 Yuseisho Tsushin Sogo Kenkyusho Method for measuring azimuth for automoble
JPH08313260A (en) * 1995-05-18 1996-11-29 Toyota Motor Corp Detection device of vehicle azimuth
JP2000111629A (en) * 1998-10-08 2000-04-21 Mitsubishi Electric Corp Magnetometer
JP2004264028A (en) * 2003-01-15 2004-09-24 National Institute Of Advanced Industrial & Technology Attitude angle processing unit and attitude angle processing method
WO2007020702A1 (en) * 2005-08-18 2007-02-22 C & N Inc Sensor device

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010004873A1 (en) * 2008-07-08 2010-01-14 アルプス電気株式会社 Azimuth calculation device and azimuth calculation method
JP4861515B2 (en) * 2008-07-08 2012-01-25 アルプス電気株式会社 Direction calculation device and direction calculation method
JP2013505875A (en) * 2009-09-29 2013-02-21 ルノー・トラックス Electronically controlled parking and brake system
WO2011057182A2 (en) * 2009-11-06 2011-05-12 University Of Maryland, College Park Method and system for determining relative displacement and heading for navigation
WO2011057182A3 (en) * 2009-11-06 2011-09-22 University Of Maryland, College Park Method and system for determining relative displacement and heading for navigation
US8954271B2 (en) 2009-11-06 2015-02-10 The University Of Maryland, College Park Method and system for determining relative displacement and heading for navigation
US8860801B2 (en) 2011-09-08 2014-10-14 Sony Corporation Electronic device and image pickup apparatus
KR20140090071A (en) * 2013-01-08 2014-07-16 삼성전자주식회사 Method for determining user exercies information and apparatus for the same
KR102197911B1 (en) * 2013-01-08 2021-01-04 삼성전자주식회사 Method for determining user exercies information and apparatus for the same
WO2015025614A1 (en) * 2013-08-22 2015-02-26 ソニー株式会社 Information processing device, information processing method, and recording medium
JP2015040783A (en) * 2013-08-22 2015-03-02 ソニー株式会社 Information processing device, information processing method, and recording medium
US9927237B2 (en) 2013-08-22 2018-03-27 Sony Corporation Information processing apparatus, information processing method, and recording medium

Also Published As

Publication number Publication date
JP4900030B2 (en) 2012-03-21

Similar Documents

Publication Publication Date Title
KR101480597B1 (en) Calibrating sensor measurements on mobile devices
JP4615287B2 (en) Azimuth and orientation detection device
US10641625B2 (en) Method and apparatus for calibrating a magnetic sensor
TWI265301B (en) Azimuth data computing method, compass sensor unit, and portable electronic device
US7844415B1 (en) Dynamic motion compensation for orientation instrumentation
US9846040B2 (en) System and method for determining the orientation of an inertial measurement unit (IMU)
US10209078B2 (en) Local perturbation rejection using time shifting
JP4900030B2 (en) POSITION DETECTION PORTABLE TERMINAL DEVICE, azimuth determining method
EP2901104B1 (en) Improved inertial navigation system and method
US20160097788A1 (en) Pedestrian direction of motion determination system and method
US10022070B2 (en) Integrated circuit including a detection unit for detecting an angular velocity signal of a moving object based on a signal from a sensor
WO2012135960A1 (en) System and method for gyroscope error estimation
CN109916395A (en) A kind of autonomous Fault-tolerant Integrated navigation algorithm of posture
US11408735B2 (en) Positioning system and positioning method
CN103299247A (en) Apparatuses and methods for dynamic tracking and compensation of magnetic near field
JP2016033473A (en) Position calculation method and position calculation device
EP2930467A1 (en) A system and method for sensing the inclination of a moving platform with respect to gravity
JP5678748B2 (en) Terminal device and geomagnetic environment determination program
JP6349698B2 (en) RUNNING STATE DETECTION DEVICE, BEND ANGLE PASSING TIME ACQUISITION METHOD AND PROGRAM
JP5652195B2 (en) Turning detection device, terminal device and program
JP2015094631A (en) Position calculation device, and position calculation method
US10648812B2 (en) Method for filtering the signals arising from a sensor assembly comprising at least one sensor for measuring a vector physical field which is substantially constant over time and in space in a reference frame
KR102598377B1 (en) Navigation instrument with tilt compensation and associated method
US20220250773A1 (en) Device and method for determining the attitude of a satellite equipped with gyroscopic actuators, and satellite carrying such a device
Kannan et al. Adaptive sensor fusion technology for mobile and wearable applications

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20090319

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110104

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110307

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110726

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110920

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20111206

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20111219

R150 Certificate of patent or registration of utility model

Ref document number: 4900030

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150113

Year of fee payment: 3