Pedestrian Autonomous Navigation System

Abstract

To provide a pedestrian autonomous navigation system with which it is possible to acquire the high-accuracy position data of a pedestrian.SOLUTION: The pedestrian autonomous navigation system comprises: a pedestrian autonomous navigation sensor having an acceleration sensor, an angular velocity sensor and a geomagnetic sensor; an external sensor capable of detecting that a pedestrian carrying the pedestrian autonomous navigation sensor has passed by a specific point the position information of which is identified in advance; walking direction restriction means for restricting the passage direction of the pedestrian at the specific point; geomagnetic error calculation means for calculating a difference between the progression direction detected by the geomagnetic sensor when the pedestrian passed by the specific point and a restriction passage direction, passage in which direction is restricted by the walking direction restriction means, as an error of the geomagnetic sensor; and a position calculation means for calculating, upon receiving determination of the pedestrian having passed by the specific point, the position of the pedestrian from the position information of the specific point from the external sensor, the error calculated by the geomagnetic error calculation means, and information pertaining to a relative movement position from the pedestrian autonomous navigation sensor.SELECTED DRAWING: Figure 1

Description

[Technical field]

[0001] The present invention relates to a pedestrian autonomous navigation system, and more particularly to a pedestrian autonomous navigation system capable of correcting errors from a pedestrian autonomous navigation sensor used in the pedestrian autonomous navigation system. [Background technology]

[0002] There is an increasing need to obtain and confirm the location information of people and objects both indoors and outdoors. For example, by obtaining the location information of a sensor device and displaying the location of a pedestrian carrying the sensor device on a map, it is possible to grasp the location, route, activity status, etc. of the person.

[0003] When outdoors, it is possible to receive radio waves from the Global Navigation Satellite System (GNSS) and obtain the subject's location information by positioning using the received radio waves. The subject's location can be confirmed by plotting the obtained location information on a map displayed on a display device.

[0004] Additionally, indoors, it is possible to measure the location of a person using a mobile terminal with a system that uses UWB (Ultra Wide Band), wireless LAN, etc. By plotting the measured location information on a floor plan of the building displayed on a display device, the target person's location within the building can be confirmed.

[0005] On the other hand, when acquiring position information of an object, positioning using a PDR (Pedestrian Dead Reckoning) sensor without using radio waves from a satellite, a transceiver, or the like is known.

[0006] The PDR sensor uses an IMU (Inertial Measurement Unit) that calculates movement in three axes (X, Y, and Z) and obtains position information based on the track from a reference point.

[0007] Pedestrian dead reckoning is an independent positioning method using a sensor worn by the subject, so it can be used even in environments where it is difficult to receive satellite and transmitter / receiver signals, such as indoors, and is therefore not affected by the radio wave environment.

[0008] Patent Document 1 discloses a mobile terminal and a current position correction system that uses the current positions of nearby short-range communication devices to correct the current position of the mobile terminal carried by the user to reduce errors in the terminal's own position when determining the current position using PDR (pedestrian dead reckoning).

[0009] It also discloses that the current location is corrected to reduce an error based on location information of a user carrying a mobile terminal, the location information being received from schedule information of the user. [Prior art documents] [Patent documents]

[0010] [Patent Document 1] Patent No. 6775707 Summary of the Invention [Problem to be solved by the invention]

[0011] In Patent Document 1, positioning is performed according to PDR (pedestrian dead reckoning) based on measurements from various sensors, and the current position is estimated by calculating the moving distance and traveling direction. However, when acquiring the target's position information by PDR (pedestrian dead reckoning) indoors and outdoors, the target carries or wears a positioning sensor and measures the moving distance and direction by itself using an acceleration sensor, a magnetic sensor, etc., so the positioning accuracy depends on the accuracy of the positioning sensor.

[0012] Furthermore, when walking for long periods of time or long distances, there is a risk that positioning errors will accumulate in the positioning sensor, reducing positioning accuracy. Therefore, it is necessary to set up reference points on the walking route and start positioning from the new reference points, and to periodically reset devices such as the display device of the walking trajectory.

[0013] Furthermore, if the subject performs the reset operation himself, it may be troublesome and he may forget to perform the reset operation.

[0014] It is also possible to use a reset device that issues a reset signal to the positioning sensor instead of the subject performing the reset operation. When using a reset device, it is necessary to clearly specify the location of the place where the positioning sensor is reset. If the location information of the place where the positioning sensor is reset cannot be reliably obtained, there is a risk that the walking trajectory cannot be displayed accurately on the map or floor plan, or the walking trajectory may be displayed in an incorrect location on the map or floor plan.

[0015] Furthermore, indoors, the detection of direction and orientation using geomagnetism may be unstable due to the influence of pillars, walls, and installed objects, which may reduce the reliability of direction detection.

[0016] Thus, when obtaining location information using PDR (pedestrian dead reckoning), there are issues such as a decrease in positioning accuracy due to accumulation of positioning errors from the positioning sensor, and low reliability of azimuth detection.

[0017] Therefore, the present invention aims to provide a pedestrian autonomous navigation system that can acquire highly accurate pedestrian position data by providing a point on a route that a subject always passes through in a system that manages the positioning sensors to reset the position information of the positioning sensors, thereby reducing the accumulated error of the positioning sensors and maintaining positioning accuracy, and by correcting the orientation by keeping the orientation of the route that the subject passes through constant. [Means for solving the problem]

[0018] In order to achieve the above object, the pedestrian autonomous navigation system according to the present invention is a pedestrian autonomous navigation system using a pedestrian autonomous navigation sensor that calculates a moving distance in at least an XY direction from the measured values ​​of an acceleration sensor and an angular velocity sensor, and calculates a moving direction from the measured value of a geomagnetic sensor to calculate a relative moving position, the pedestrian autonomous navigation system including the pedestrian autonomous navigation sensor having the acceleration sensor, the angular velocity sensor, and the geomagnetic sensor, an external sensor capable of detecting that a pedestrian carrying the pedestrian autonomous navigation sensor has passed through a specific point whose position information has been specified in advance, and a pedestrian position detection system for detecting the pedestrian's movement at the specific point. The present invention is characterized in that it comprises a walking direction restriction means for restricting a passing direction, a geomagnetic error calculation means for calculating, as an error of the geomagnetic sensor, a difference between the traveling direction detected by the geomagnetic sensor when the pedestrian passes through the specific point and a restricted passing direction which is the passing direction restricted by the walking direction restriction means, and a position calculation means for calculating, upon determination that the pedestrian has passed through the specific point, a position of the pedestrian from the position information of the specific point from the external sensor, the error calculated by the geomagnetic error calculation means, and information relating to the relative moving position from the pedestrian autonomous navigation sensor.

[0019] In addition, the external sensor of the present invention is capable of detecting an actual traveling direction and / or an actual passing position of the pedestrian when the pedestrian passes through the specific point, and the pedestrian autonomous navigation system further includes a passing error calculation means for calculating a difference between information relating to the actual traveling direction and / or the actual passing position of the pedestrian and the regulated passing direction and / or the position information of the specific point as passing error information, and the position calculation means calculates the position of the pedestrian by also utilizing the passing error information.

[0020] The walking direction regulating means of the present invention is characterized in that it is a gate, a door, a sign indicating the walking direction through which the pedestrian can pass, and / or a wheel track for regulating the movement of the shoes of the pedestrian.

[0021] The pedestrian autonomous navigation system of the present invention is further characterized in that the external sensor is a sensor arranged at the specific point, a sensor arranged around the specific point, a sensor for detecting opening and closing of a flapper gate, and / or a sensor for detecting opening and closing of a door, and the sensor detects the passage of the pedestrian and transmits the position information of the specific point to the position calculation means.

[0022] In addition, the external sensor of the present invention is characterized in that it comprises a plurality of sensors arranged at the specific point and around the specific point and divided into a matrix, and the sensors transmit information related to the actual traveling direction and / or the actual passing position of the pedestrian to the passing error calculation means.

[0023] The pedestrian dead-reckoning sensor of the present invention is characterized in that it is attached to the foot of the pedestrian, and corrects a speed error by assuming that a speed detected when the pedestrian is stationary is an error.

[0024] Furthermore, the position calculation means of the present invention is characterized in that, upon receiving a determination from the external sensor that the pedestrian has passed a new specific point, it resets the position information of the specific point that was previously passed, and newly calculates the position of the pedestrian from the position information of the newly passed specific point, the error related to the newly passed specific point, and information related to the relative movement position from the newly passed specific point from the pedestrian autonomous navigation sensor. Effect of the Invention

[0025] According to the present invention, when it is determined that a pedestrian has passed a specific point, the pedestrian's position is calculated from position information of the specific point from an external sensor, the error calculated by a geomagnetic error calculation means, and information related to the relative moving position from the pedestrian autonomous navigation sensor, thereby eliminating accumulated error of the pedestrian autonomous navigation sensor and obtaining highly accurate pedestrian position data.

[0026] In addition, by restricting the direction in which a target person passes through a specific point using a geomagnetic error calculation means and performing correction based on the difference between the restricted direction and the direction of the geomagnetic sensor that measures the position, it is possible to detect the pedestrian's orientation with high accuracy.

[0027] In addition, since the location where the pedestrian dead-reckoning sensor is reset is specified in advance, the location of the location where the pedestrian dead-reckoning sensor is reset is clear, making it easy to plot it on a floor map, etc., and the reset operation of the pedestrian dead-reckoning sensor is performed reliably, allowing accurate positioning.

[0028] Furthermore, according to the present invention, by setting specific points that serve as reference points on the walking route, the position information of the specific points is reset and a new position is calculated using the position information of the new specific points, so there is no need to manually reset a walking trajectory display device, etc., and since the resetting is automatic, it is possible to prevent a decrease in positioning accuracy due to an accumulation of positioning errors in the pedestrian autonomous navigation sensor when walking for long periods of time and long distances.

[0029] Furthermore, according to the present invention, even if the traffic flow area is changed, if an external sensor system consisting of multiple sensors such as floor mats is used, sensors can be easily added or their positions changed. Therefore, it can be used in exhibitions and temporary sales areas where the layout is frequently changed. Furthermore, it is also effective for managing the positions of workers in construction sites such as tunnels, underground, and above ground where many people work in a dispersed manner.

[0030] Furthermore, according to the present invention, by providing an external sensor in a restricted area within a venue or the like, it is effective in implementing security measures such as detecting entry into the restricted area.

[0031] In addition, according to the present invention, the positions of police, fire, and other personnel during training can be calculated and used to collect data for analyzing the effectiveness of training provided by police, fire, and other personnel.

[0032] Furthermore, according to the present invention, the external sensor calculates the difference between information relating to the actual direction of travel and actual passing position of the pedestrian when the pedestrian passes through a specific point, and the regulated passing direction and position information of the specific point, as passing error information, and it becomes possible to obtain highly accurate position data of the pedestrian by using the passing error information, thereby enabling more accurate positioning of the moving position. [Brief description of the drawings]

[0033] [Figure 1] 1 is a block diagram showing a configuration of a pedestrian autonomous navigation system according to the present invention. [Diagram 2] FIG. 1A is an oblique view of a pedestrian autonomous navigation sensor and a diagram showing the coordinate system of the pedestrian autonomous navigation sensor; FIG. 1B is an oblique view showing the pedestrian autonomous navigation sensor attached to shoes worn by a pedestrian; and FIG. 1C is a diagram showing the movement position of the pedestrian autonomous navigation sensor displayed on a mobile device. [Diagram 3] FIG. 13 is a diagram explaining a walking direction control means for controlling the direction in which pedestrians can pass at a specific point. (a) shows a gate through which pedestrians can pass as a walking direction control means, and (b) shows a walking method guide display unit that displays the walking direction with painted marks on the floor as a walking direction control means. [Figure 4] FIG. 11 is a diagram for explaining the correction of geomagnetic error in a pedestrian autonomous navigation sensor, in which (a) is a diagram showing fundamental vectors at a gate, (b) is a diagram showing the relationship between the fundamental vectors and walking vectors measured by the pedestrian autonomous navigation sensor, and (c) is a diagram showing walking vectors after correction in which the walking vectors measured by the pedestrian autonomous navigation sensor are corrected for geomagnetic error. [Diagram 5] FIG. 13 is a diagram illustrating a detection sensor for an external sensor that is composed of a plurality of pressure sensors arranged at specific points and divided into a matrix. [Figure 6] 6(a) is a diagram explaining passing error information, which is the difference between information relating to a pedestrian's actual traveling direction and actual passing position in the detection sensor shown in FIG. 5 and information on the regulated passing direction and position information of a specific point, and FIG. 6(b) is a diagram explaining correction of a pedestrian passing error in an external sensor. [Figure 7] 13 is a flowchart showing the processing of the pedestrian autonomous navigation sensor, the external sensor, and the monitoring PC in the pedestrian autonomous navigation system when a pedestrian passes by using a detection sensor provided in the external sensor. [Figure 8] FIG. 13 is a diagram showing a walking trajectory measured by a pedestrian autonomous navigation sensor when an external sensor is set as a specific point on a walking route displayed on the display unit of a monitoring PC in a pedestrian autonomous navigation system, and a walking trajectory when no external sensor is set on the walking route. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0034] Hereinafter, a description will be given of an embodiment of the pedestrian autonomous navigation system according to the present invention with reference to the drawings. The pedestrian autonomous navigation system according to the present invention calculates the position of the pedestrian with high accuracy by calculating the position of the pedestrian from information on the relative movement position from a pedestrian autonomous navigation sensor having an acceleration sensor and an angular velocity sensor for calculating the movement distance in at least XY directions and a geomagnetic sensor for detecting the direction of travel, and by calculating the position of the pedestrian based on the position information of the specific point from an external sensor and the error calculated by a geomagnetic error calculation means upon receiving a determination that the pedestrian has passed the specific point, thereby eliminating an accumulated error in the pedestrian's walking trajectory.

[0035] [Configuration of pedestrian autonomous navigation system] First, the configuration of the pedestrian autonomous navigation system according to the present invention will be described in detail with reference to Fig. 1. Fig. 1 is a block diagram showing the configuration of the pedestrian autonomous navigation system according to the present invention. As shown in Fig. 1, the pedestrian autonomous navigation system 1 includes a pedestrian autonomous navigation sensor 5, a mobile terminal 20, an external sensor 50, a WiFi router 40, and a monitoring PC 30.

[0036] The pedestrian autonomous navigation sensor 5 in the pedestrian autonomous navigation system 1 is a positioning sensor that calculates the movement position of a pedestrian from information related to the relative movement position, and has a sensor unit 6, a calculation unit 13, a wireless unit 14, and a control unit 12.

[0037] The sensor unit 6 of the pedestrian autonomous navigation sensor 5 includes an acceleration sensor 7 for detecting acceleration, an angular velocity sensor 8 for detecting angular velocity, and a geomagnetic sensor 9 for detecting a geomagnetic direction. The calculation unit 13 calculates a moving distance from the acceleration data and angular velocity data from the sensor unit 6, and calculates a direction from a signal from the geomagnetic sensor 9. The wireless unit 14 communicates with an external mobile terminal 20 via an antenna 15 by Bluetooth or the like. The control unit 12 controls the wireless unit 14 and the calculation unit 13. The pedestrian autonomous navigation sensor 5 is supplied with power by a built-in battery 16. The calculation unit 13 may be provided in the control unit 12.

[0038] The mobile terminal 20 in the pedestrian autonomous navigation system 1 displays the movement trajectory of the pedestrian on the display unit 25 based on data measured by the pedestrian autonomous navigation sensor 5, and also communicates with the external sensor 50 and the monitoring PC 30.

[0039] The mobile terminal 20 includes a wireless unit 26 that performs wireless communication with the wireless unit 14 of the pedestrian autonomous navigation sensor 5 via an antenna 27 using Bluetooth or the like, a wireless unit 28 that performs wireless communication with a WiFi router 40 via an antenna 29, a calculation unit 22 that performs various calculations, a control unit 21 that performs various controls, a memory unit 23 that stores programs and data for the CPU of the control unit 21, a display unit 25 that controls a liquid crystal panel to perform display, and an operation unit 24 that sets, operates, and gives instructions for various data. The mobile terminal 20 also stores in the memory unit 23 pedestrian (monitoring target) ID information and the like that identifies a pedestrian who owns the pedestrian autonomous navigation sensor 5.

[0040] The pedestrian autonomous navigation system 1 is configured to be able to detect, by the external sensor 50, that a pedestrian carrying a pedestrian autonomous navigation sensor 5 has passed through a specific point whose position information has been specified in advance. That is, the external sensor 50 in the pedestrian autonomous navigation system 1 is arranged at or around the specific point, detects the passage of a pedestrian, and notifies the same by sending a signal.

[0041] 1, the external sensor 50 is provided at a specific point whose position information is specified in advance, and as an example, takes the form of a floor mat provided on the floor of a passageway along which pedestrians walk, and the floor mat has a built-in detection sensor 51. When a pedestrian steps on the floor mat, for example, the detection sensor 51 turns ON and outputs an ON state to the control unit 54. This confirms that the pedestrian has passed over the floor mat.

[0042] The external sensor 50 has a wireless unit 57 that wirelessly communicates data with the mobile terminal 20 via an antenna 58. The wireless unit 57 of the external sensor 50 communicates data such as a monitored person (pedestrian) ID, a floor mat ID, a notification of a reset control signal, and a correction value with the mobile terminal 20. The external sensor 50 includes a calculation unit 55 that calculates a correction value according to the operating state of the detection sensor 51, and a memory unit 56 that stores programs and data of the CPU of the control unit 54. The external sensor 50 also includes a wireless unit 59 having an antenna 60 that wirelessly communicates with the monitoring PC 30 via the WiFi router 40, and communicates data such as a monitored person (pedestrian) ID, a floor mat ID, a notification of a reset control signal, and a correction value with the monitoring PC 30. Note that the wireless communication between the external sensor 50 and the monitoring PC 30 can also be performed from the wireless unit 57 via the mobile terminal 20 and the WiFi router 40. This allows the wireless unit 59 of the external sensor 50 to be substituted with the wireless unit 57.

[0043] The WiFi router 40 in the pedestrian autonomous navigation system 1 has a wireless unit 41 that performs WiFi wireless communication with the mobile terminal 20 or the external sensor 50 via an antenna 44, a communication unit 43 that connects to the monitoring PC 30 via Ethernet, and a control unit 42 that controls the wireless unit 41 and the communication unit 43.

[0044] The monitoring PC 30 in the pedestrian autonomous navigation system 1 processes the pedestrian's movement trajectory based on the data such as the movement position of the pedestrian autonomous navigation sensor, the monitored person (pedestrian) ID, the floor mat ID, the notification of the reset control signal, and the correction value transmitted from the mobile terminal 20, and displays the pedestrian's movement position and movement trajectory on a map on the display unit 33. The monitoring PC 30 is a computer having a CPU, and has a control unit 31 for control, a calculation unit 32 for calculation, a memory unit 34 for storing the programs and data of the CPU of the control unit 31, a display unit 33 for displaying a map, a floor layout of a building, etc., and a communication unit 35 for communicating with the WiFi router 40 via Ethernet. The memory unit 34 also stores position information of a specific point, information such as the direction of the external sensor 50, floor layout data, map data, etc.

[0045] [Pedestrian autonomous navigation sensor installed] First, the pedestrian autonomous navigation sensor will be described with reference to Fig. 2. Fig. 2(a) is a perspective view of the pedestrian autonomous navigation sensor and a diagram showing the coordinate system of the pedestrian autonomous navigation sensor, Fig. 2(b) is a perspective view showing the pedestrian autonomous navigation sensor attached to the shoes worn by a pedestrian. Fig. 2(c) is a diagram showing the moving position of the pedestrian autonomous navigation sensor displayed on a mobile terminal.

[0046] As shown in FIG. 2(a), the pedestrian autonomous navigation sensor 5 has a rectangular parallelepiped shape and is large enough to be attached to the upper surface of a shoe. The coordinate axes of the pedestrian autonomous navigation sensor 5 are composed of three axes, XYZ axes, and are formed so that each axis is perpendicular to the other. When the pedestrian autonomous navigation sensor 5 is placed on a horizontal plane, the surface of the pedestrian autonomous navigation sensor 5 facing the horizontal plane is specified so that the XY axes are on the horizontal plane and the axis perpendicular to the horizontal plane is the Z axis, and the pedestrian is attached to the pedestrian so that the axes of the pedestrian autonomous navigation sensor 5 are in the specified positions during positioning.

[0047] As shown in FIG. 2(b), the pedestrian autonomous navigation sensor 5 is fixed by a band or the like to the upper surface of the toe side of the shoe worn on one foot of the pedestrian. Here, the foot means below the ankle. The pedestrian autonomous navigation sensor 5 attached to the toe of the shoe detects the moving position of the pedestrian in coordinate values ​​of three axes, X, Y, and Z. As shown in FIG. 2(b), the pedestrian autonomous navigation sensor 5 attached to the shoe is attached to the toe side of the shoe so that it is on the + side of the Y axis, and the length direction of the shoe forms the Y axis. In addition, the X axis, which is perpendicular to the Y axis, is on the + side on the left side in the pedestrian's moving direction. In addition, the Z axis is set perpendicular to the ground.

[0048] The pedestrian dead reckoning sensor 5 uses ZUPT (Zero Velocity Potential Update), which records the relative position when the foot stops. That is, the pedestrian dead reckoning sensor 5 detects data for one step, which is the difference between the current foot stop position and the previous foot stop position, in the coordinate values ​​(x, y, z) of the XYZ coordinate system, using the acceleration sensor 7 and the angular velocity sensor 8.

[0049] In addition, the pedestrian dead navigation sensor 5 detects the angle θ formed by the Y axis of the current foot stopping position relative to the Y axis of the previous foot stopping position, i.e., the amount of displacement in the angle of the toe of the shoe before and after one step.

[0050] As a result, the walking trajectory of the pedestrian is displayed on the display unit 25 of the mobile terminal 20 from the coordinate values ​​and angles detected by the pedestrian autonomous navigation sensor 5, as shown in Fig. 2(c). The pedestrian autonomous navigation sensor 5 starts detection with the starting point set as the reference point with coordinate values ​​(0,0,0) and an angle of 0 degrees. The detected coordinate values ​​and angles are output to the mobile terminal 20 by the wireless unit 14. The display example of the display unit 25 shown in Fig. 2(c) uses data of XY coordinate values ​​and angle θ from the pedestrian autonomous navigation sensor 5.

[0051] In addition, since the pedestrian dead navigation sensor 5 measures the movement distance from the positioning start position based on the difference between the current foot stop position and the previous foot stop position, it is necessary to determine the positioning start position and positioning start direction.

[0052] In addition, the pedestrian dead-reckoning sensor 5 is attached to the foot of the pedestrian, and the speed data detected when the pedestrian is stationary is usually 0 (zero), but when speed data other than 0 is detected when the pedestrian is stationary, the speed data can be considered as an error. Therefore, it is possible to correct the speed error of the speed data while walking using the error obtained when the pedestrian is stationary.

[0053] Although the embodiment in which the pedestrian autonomous navigation sensor 5 is attached to a foot has been described, the pedestrian autonomous navigation sensor 5 is not limited to a sensor attached to a foot, and may be a smartphone, a mobile terminal device, or the like that is stored in a pocket of the pedestrian's clothing and has an acceleration sensor, an angular velocity sensor, a geomagnetic sensor, or the like built in.

[0054] [Regarding measures to regulate walking directions at specific locations] Next, the walking direction regulation means at a specific point of the pedestrian autonomous navigation system 1 will be described with reference to Fig. 3. Fig. 3 is a diagram for explaining the walking direction regulation means that regulates the passing direction of pedestrians at a specific point, Fig. 3(a) shows a gate through which pedestrians can pass as the walking direction regulation means, and Fig. 3(b) shows a walking method guidance display unit that displays the walking direction with paint marks on the floor as the walking direction regulation means.

[0055] As shown in Fig. 3(a), gate 70, which serves as a walking direction regulation means and is provided at a specific point whose position information has been specified in advance, has a width necessary for pedestrians to pass through, and has side panels 73 on both sides along the direction in which pedestrians pass. Pedestrians enter gate 70 from the entrance side, pass through gate 70, and exit from the exit side.

[0056] 3(a), the direction of travel is indicated by an arrow on the floor of the gate 70. Furthermore, the direction of travel may be indicated by footprints on the floor, with black footprints indicating the positions of the feet wearing the pedestrian dead-reckoning sensors.

[0057] In this way, the passing direction through the gate 70 is specified in advance, and the passing direction together with the position information of the gate 70 is stored in the monitoring PC 30. The gate 70 that regulates the walking direction at a specific point is provided at a position equivalent to a reference point, such as a building where pedestrian positioning starts, near a door located at an indoor entrance, or near the exit of a building elevator.

[0058] A bar 71 that rotates in only one direction is provided on the upper part of the side panel 73 of the gate 70 to prevent pedestrians from mistakenly entering from the exit side. The bar 71 shown by the dotted line indicates the state in which the gate 70 is closed. The gate 70 is also provided with an external sensor 50 that detects when a pedestrian passes through the gate 70.

[0059] The detection sensor 51 of the external sensor 50 has a light-emitting element attached to one side of the side panel 73 of the gate 70, and an optical sensor consisting of a light-receiving element that receives light from the light-emitting element is placed on the other side panel, and detects whether a pedestrian has passed through the gate 70 by detecting the ON / OFF state of the light-receiving element.

[0060] Also, when the bar 71 rotates while a pedestrian is passing through, the switch may be turned on to confirm the passage. In this way, it is detected that the pedestrian has passed through the gate 70 in the walking direction set in advance at the specific point.

[0061] FIG. 3(b) shows a walking direction guidance display unit 75 that displays the walking direction indicated by arrows and footprints on the floor with paint marks as a walking direction regulation means, and pedestrians walk according to the walking direction and footprints. Furthermore, as shown in FIG. 3(b), the moving direction may be displayed with footprints on the floor, and the black footprints indicate the position of the feet wearing the pedestrian dead-reckoning sensor. In order to allow pedestrians to pass through, optical sensors are provided at both ends of the passage, and mats with built-in pressure sensors on the floor or pass gates formed in a frame shape that detect the passage within the frame are provided. Also, instead of paint marks, wheel tracks may be provided. Furthermore, by using the walking direction guidance display unit 75 displayed with paint marks as shown in FIG. 3(b), it is not necessary to provide large-scale equipment such as gates 70, so it can be used in venues where the layout is frequently changed indoors.

[0062] In this way, the position information and passing direction of gates or other devices that regulate walking direction at specific locations are specified in advance, and when a pedestrian passes through a gate or other device that regulates walking direction, it can be detected by an external sensor.

[0063] [Geomagnetic error of geomagnetic sensor] Next, the geomagnetic error in the pedestrian autonomous navigation sensor 5 will be described with reference to Fig. 4. Fig. 4 is a diagram for explaining the correction of the geomagnetic error in the pedestrian autonomous navigation sensor, in which Fig. 4(a) is a diagram showing fundamental vectors at the gate 70, Fig. 4(b) is a diagram showing the relationship between the fundamental vectors and the walking vectors measured by the pedestrian autonomous navigation sensor, and Fig. 4(c) is a diagram showing the relationship between the walking vectors measured by the pedestrian autonomous navigation sensor and the walking vectors after the geomagnetic error has been corrected.

[0064] Indoors, the geomagnetism may become unstable due to walls, pillars, and other installed objects. This may cause errors in the direction data detected by the geomagnetic sensor 9 of the pedestrian dead-reckoning sensor 5, causing the pedestrian's direction of travel to deviate from the actual direction. This makes it necessary to correct the direction data detected by the geomagnetic sensor 9.

[0065] The correction of the orientation data of the geomagnetic sensor 9 is for determining the orientation at the specific point where pedestrian positioning is initially started, and after the orientation (direction) at the initial specific point has been determined, the pedestrian's position is calculated using the data from the acceleration sensor 7 and the angular velocity sensor 8 without using the orientation data from the geomagnetic sensor 9. For this reason, the geomagnetic sensor 9 is usually only used initially to determine the orientation at the positioning start position.

[0066] The geomagnetic error of the geomagnetic sensor 9 is the difference between the traveling direction, which indicates the orientation detected by the geomagnetic sensor 9 when a pedestrian passes through a specific point such as the gate 70, and the regulated passing direction, which is the passing direction regulated by the gate or the like, which is a walking direction regulating means. The error of the geomagnetic sensor is calculated as shown below, and the orientation data is corrected.

[0067] As shown in FIG. 4(a), a regulated passing direction, which is a passing direction regulated by a gate 70 serving as walking direction regulating means, is set as a fundamental vector Vb.

[0068] For example, the north direction on the map or floor plan of a building to be drawn is used as the base, the north direction is the Y-axis, the axis perpendicular to it is the X-axis, the point where the X-axis and Y-axis intersect is the base point, the direction to the right of the base point on the X-axis is defined as east, and the direction below the base point on the Y-axis is defined as south, and the basic vector Vb of the east direction is defined as (1,0) on the XY axes, and the basic vector Vb of the north direction is defined as (0,1) on the XY axes.

[0069] As shown in FIG. 4(b), for example, the fundamental vector Vb shown by the dotted line is (1,0), the direction of travel detected by the geomagnetic sensor 9 when a pedestrian passes a specific point is the walking vector Vg, and when the walking vector Vg is (xa,ya) on the XY axis, the angle θa of the walking vector Vg with the X axis is determined. The difference θ between the angle θa of the walking vector Vg and the angle θs of the fundamental vector Vb with the X axis is calculated. The calculated angle θ is the geomagnetic error. Note that the angle θs of the fundamental vector Vb with the X axis shown in FIG. 4(b) is 0 degrees.

[0070] 4(c), the walking vector Vg is rotated by an angle of -θ around the reference point so that the walking vector Vg coincides with the direction of the base vector Vb based on the geomagnetic error θ. By rotating the coordinate axes, the corrected coordinate data (xb, yb) is calculated from the walking vector Vg(xa, ya), and (xb, yb) becomes the geomagnetically corrected corrected walking vector Vh.

[0071] In this way, the difference between the direction of travel detected by the geomagnetic sensor when a pedestrian passes through a specific point and the regulated passing direction, which is the passing direction regulated by the gate, which is a walking direction regulating means, is calculated as the error of the geomagnetic sensor, thereby making it possible to calculate the pedestrian's position more accurately.

[0072] Furthermore, without using a geomagnetic sensor to measure the direction of pedestrian movement, it is also possible to use the position of gate 70, which is a directional control means at a specific location, as a reference point and take the direction in which gate 70 is installed as the direction of travel of pedestrians at the reference point.

[0073] [Operation of external sensors divided into a matrix] Next, an external sensor 50 in which a plurality of pressure sensors are divided and arranged in a matrix will be described with reference to Fig. 5. Fig. 5 is a diagram for explaining a detection sensor of an external sensor that is arranged at a specific point and is made up of pressure sensors divided into a matrix.

[0074] As shown in Fig. 5, the detection sensor 51 of the external sensor 50 has the shape of a floor mat, a square shape in a plan view, and is composed of pressure sensors 53 arranged in a matrix. For example, it has a mesh-like divided 3 x 3 regions (53a to 53i) formed by dividing one of the outer sides vertically and horizontally into thirds. Each region contains circular pressure sensors 53a to 53i. When pressure is applied to the upper surface of the pressure sensor 53, it becomes conductive.

[0075] Each of the multiple pressure sensors 53 of the detection sensor 51 is connected to the control unit 54, and the control unit 54 can detect which pressure sensor is in a conductive state. The control unit 54 also stores in advance information regarding the arrangement state of each pressure sensor 53 in the detection sensor 51, such as the installation angle of the detection sensor 51 with respect to the N (north) direction indicated by the arrow in Fig. 5 as a reference direction, the mounting pitches Px, Py of the pressure sensors 53 of the detection sensor 51, and the absolute position of the pressure sensor 53e located at the center of the detection sensor 51.

[0076] The control unit 54 can calculate the walking angle with respect to the basic walking direction Wd (shown in FIG. 6) and the relative position of the pressure sensor 53 that became conductive at the second step from the number of the pressure sensor 53 that became conductive when the pedestrian passed over the floor mat and the order of the conductive states of the pressure sensors 53. This allows the control unit 54 of the external sensor 50 to grasp the passing direction on the floor mat and the position of the pedestrian.

[0077] In this way, since a floor mat consisting of multiple pressure sensors 53 is arranged two-dimensionally on the floor at a specific point, it is possible to calculate the actual traveling direction and actual passing position of a pedestrian at the specific point.

[0078] 5 is an example, and is not limited thereto. For example, the external sensor 50 is not limited to a floor mat-like detection sensor 51 installed on the floor, but may be a non-contact type sensor such as an optical sensor or a video camera installed on the ceiling. Furthermore, the external sensor 50 is not limited to a 3×3 configuration, and may be a pressure-type or electrostatic-type sensor forming a dot matrix in which the sensors are arranged in an m×n matrix (for example, m and n are 100 or more), as long as it is capable of calculating the passing position and passing direction of a pedestrian.

[0079] [Calculation of passing error information (directional deviation correction at reset)] Next, the passing error information, which is the difference between the information related to the actual moving direction and actual passing position of a pedestrian in the detection sensor shown in Fig. 5 and the regulated passing direction and the position information of a specific point, will be described with reference to Fig. 6. Fig. 6(a) is a diagram for explaining the passing error information, which is the difference between the information related to the actual moving direction and actual passing position of a pedestrian in the detection sensor shown in Fig. 5 and the regulated passing direction and the position information of a specific point, and Fig. 6(b) is a diagram for explaining the correction of the passing error of a pedestrian in an external sensor.

[0080] 3, it is assumed that the pedestrian passes in the regulated direction, and the mobile terminal 20 passes the specific point in the regulated passing direction. However, when the pedestrian passes the specific point, there is a possibility that the pedestrian does not pass in the regulated direction, which may cause an error in the passing direction and require correction.

[0081] As shown in Fig. 6(a), a basic walking pattern is set as a regulated passing direction of a pedestrian on the floor mat of the detection sensor 51. In the diagram shown in Fig. 6(a), the basic walking pattern is that a pedestrian moves from the pressure sensor 53d located on the left side of the floor mat to the pressure sensor 53f located on the right side.

[0082] The basic walking direction is composed of a basic walking direction and a basic axis line corresponding to the basic vector Vb shown in Fig. 4(a), and for example, as shown in Fig. 6(a), one side of the outer periphery of a rectangular floor mat is parallel to the X-axis, the reference point of the XY coordinate axis is set at the center position of the pressure sensor 53d, the axis passing through the centers of the pressure sensors 53d and 53f is the X-axis, and the axis passing through the centers of the pressure sensors 53a and 53g is the Y-axis. The basic walking direction Wd is a straight line connecting the center positions of the pressure sensors 53d and 53f, and is parallel to the X-axis, with an angle of 0 degrees with respect to the X-axis.

[0083] 6(a), the basic axis line We is a straight line connecting the center position of the pressure sensor 53d and the center position of the pressure sensor 53f. As a result, the angle of the straight line connecting the center position of the pressure sensor 53a and the center position of the pressure sensor 53c and the straight line connecting the center position of the pressure sensor 53g and the center position of the pressure sensor 53i with respect to the X-axis is 0 degrees, but the axes are misaligned with respect to the basic axis line We, resulting in so-called axial misalignment.

[0084] The actual moving direction and actual passing position of the pedestrian are calculated based on the position where the pressure sensor 53 of the floor mat of the external sensor 50 reacts to the foot on which the pedestrian dead-reckoning sensor 5 is attached.

[0085] For example, as shown in FIG. 6(a), when the pressure sensor 53d reacts and conducts at the first step of the foot wearing the pedestrian autonomous navigation sensor 5, and the pressure sensor 53i reacts at the second step of the foot wearing the pedestrian autonomous navigation sensor 5, the actual moving direction of the pedestrian is indicated by Sd, and the passing direction deviation angle θc of the actual moving direction Sd of the pedestrian with respect to the basic walking direction Wd is calculated. The calculated angle θc is calculated as the angle error. At this time, the center position of the pressure sensor 53i is set as the actual passing position Se as a new reference point of the specific point.

[0086] This allows calculation of passing error information, which is the difference between the information relating to the actual moving direction Sd and actual passing position Se of the pedestrian obtained by the external sensor 50 and the regulated passing direction and the position information of the specific point.

[0087] Furthermore, for example, as shown in Fig. 6(a), when the pressure sensor 53a reacts and conducts at the first step of the foot wearing the pedestrian autonomous navigation sensor 5, and the pressure sensor 53c reacts and conducts at the second step of the foot wearing the pedestrian autonomous navigation sensor 5, the actual moving direction of the pedestrian is indicated by Sf, an axis deviation occurs with respect to the basic axis line We, and the amount of axis deviation corresponds to the pitch Py between the center position of the pressure sensor 53a in the Y-axis direction and the center position of the pressure sensor 53d as shown in Fig. 5, and at this time, the center position of the pressure sensor 53c is set as a new reference point of the specific point. Note that the passing direction deviation angle formed by the actual moving direction of the pedestrian with respect to the basic walking direction Wd at this time is 0 (zero).

[0088] As shown in Fig. 6(b), the angle θc, which is the passing error (information) calculated from the basic walking direction Wd, which is the regulated passing direction, and the actual walking direction of the pedestrian, is the actual moving direction Sd with respect to the regulated passing direction. This allows the passing error to be calculated and the pedestrian's position to be calculated by correcting the calculated passing error, making it possible to detect the position with higher accuracy.

[0089] In addition, the actual traveling direction Sf shown in Figure 6(a) has an axial misalignment, and as shown in Figure 6(b), the passing error is shifted by a pitch Py on the negative side of the Y-axis direction relative to the basic axis line We, and is at an angle of 0 (zero) relative to the basic walking direction Wd.

[0090] In this way, the basic walking direction, which is the direction in which the pedestrian passes through the restricted area, is the direction specified by the pedestrian autonomous navigation system, and by calculating the actual direction in which the pedestrian passed through the floor mat, it is possible to detect the position with higher accuracy.

[0091] In addition, the external sensor 50 corrects the passing error at the first and second steps of the pedestrian autonomous navigation sensor 5 within the floor mat, but the monitoring PC 30 resets the position information of the specific point after confirming the passage of the pedestrian at the second step on the floor mat, and calculates new position information of the pedestrian.

[0092] In addition, in the case of a large floor mat or the like, in which the number of steps detected exceeds two, the last step detected on the floor mat is regarded as the final step, and new position information of the pedestrian is calculated from the final step.

[0093] To correct errors in the pedestrian's direction of travel, first the geomagnetic error in the direction of travel detected by the geomagnetic sensor is corrected, then the passing direction deviation angle is calculated and the corrected walking vector Vh (shown in Figure 4(c)) obtained by correcting the geomagnetic error is corrected for passing direction deviation to obtain a walking vector after correction for passing direction deviation.

[0094] Incidentally, the error correction for the pedestrian's traveling direction may be performed by first calculating the passing direction deviation angle, correcting the passing direction deviation, and then correcting the geomagnetic error in the traveling direction detected by the geomagnetic sensor.

[0095] [Processing operation of pedestrian autonomous navigation system] Next, the process when a pedestrian passes through a specific point in the pedestrian autonomous navigation system 1 will be described in detail with reference to Fig. 7. Fig. 7 is a flow chart showing the process of the pedestrian autonomous navigation sensor 5, the mobile terminal 20, the external sensor 50, and the monitoring PC 30 in the pedestrian autonomous navigation system 1 when a pedestrian passes through detected by a detection sensor provided in the external sensor. Note that the detection sensor 51 of the external sensor 50 provided at the specific point is made up of multiple pressure sensors 53 shown in Fig. 5, which are divided into a matrix shape.

[0096] As shown in Fig. 7, when a pedestrian passes an external sensor 50 provided at a specific point, the pedestrian dead-reckoning sensor 5 checks whether the pedestrian has taken a first step on the floor mat of the external sensor 50 (S1). After landing on the floor mat (Yes in S1), the pedestrian dead-reckoning sensor 5 transmits walking data (X, Y, Z, θ) to the mobile terminal 20 via the wireless unit 14 (S2). The walking data (X, Y, Z, θ) is data of the difference between the position where the pedestrian steps on the floor mat of the external sensor 50 and the landing point one step before stepping on the floor mat.

[0097] The external sensor 50 checks whether the pressure sensor 53 is ON (S20), and if the pressure sensor 53 is ON (Yes in S20), the external sensor 50 identifies the position of the pressure sensor 53 where the foot lands and stores the position as a first position (S21). In addition, the mobile terminal 20 carried by the pedestrian transmits walking data (X, Y, Z, θ) of the first step on the floor mat to the monitoring PC 30 via the WiFi router 40 (S3).

[0098] After the foot lands and the pressure sensor 53 turns ON, the external sensor 50 transmits the ID of the external sensor 50 (hereinafter referred to as F-ID), which is identification information of the external sensor 50, and a reset control signal to the mobile terminal 20 as shown by a solid line (S22).

[0099] The mobile terminal 20 receives the F-ID and the reset control signal from the external sensor 50 (S4), and after receiving the signal, sets a flag indicating that the reset control signal has been received in the memory unit 23. In addition, the mobile terminal 20 transmits a pedestrian ID (hereinafter, referred to as P-ID) for identifying the pedestrian and a reset response signal to the external sensor 50 (S5).

[0100] The external sensor 50 checks whether a P-ID and a reset response signal have been output from the portable terminal 20 (S23). When the external sensor 50 confirms that the P-ID and the reset response signal have been input from the portable terminal 20 (Yes in S23), it stores the P-ID from the portable terminal 20 in the memory unit 56 (S24).

[0101] On the other hand, if the foot that stepped on the floor mat in S20 of the external sensor 50 is not wearing the pedestrian autonomous navigation sensor 5, an F-ID and a reset control signal are sent to the mobile terminal 20 in S22 as shown by the dotted line, but the mobile terminal 20 is in a state of checking whether the first step has been taken on the floor mat of the external sensor 50 as shown in S1, and is therefore unable to receive a signal from the external sensor 50.

[0102] As a result, the external sensor 50 cannot confirm receipt of the P-ID signal within the predetermined time in S23 (No in S23), and the time runs out, causing the process to proceed to S20. This enables the external sensor 50 to determine whether the foot that stepped on the floor mat is a foot equipped with the pedestrian dead-reckoning sensor 5 or a foot not equipped with the pedestrian dead-reckoning sensor 5.

[0103] Next, the pedestrian dead-reckoning sensor 5 checks whether the pedestrian has taken a second step while passing over the floor mat of the external sensor 50 (S6). After landing on the floor mat (Yes in S6), the pedestrian dead-reckoning sensor 5 transmits walking data (X, Y, Z, θ) to the mobile terminal 20 via the wireless unit 14. The walking data (X, Y, Z, θ) is data representing the difference between the position where the floor mat was stepped on with the first step and the landing point of the floor mat with the second step. In addition, the mobile terminal 20 carried by the pedestrian transmits the walking data (X, Y, Z, θ) of the second step on the floor mat and a reset control signal acceptance to the monitoring PC 30 (S8).

[0104] The external sensor 50 checks whether the pressure sensor 53 is ON (S25), and if the pressure sensor 53 is ON (Yes in S25), the external sensor 50 identifies the position of the pressure sensor 53 where the foot lands and stores the position as a second position (S26). The external sensor 50 transmits an F-ID, which is identification information of the external sensor 50, to the mobile terminal 20 (S27). The mobile terminal 20 receives the F-ID from the external sensor 50 as shown by the solid line (S9). In addition, the mobile terminal 20 transmits a P-ID, which is identification information of the pedestrian, to the external sensor 50 (S10).

[0105] The external sensor 50 checks whether a P-ID has been output from the portable terminal 20 (S28). If the external sensor 50 confirms that the P-ID data has been input from the portable terminal 20 (Yes in S28), it receives the P-ID from the portable terminal 20 and stores the P-ID in the memory unit 56 (S29).

[0106] On the other hand, if the foot that stepped on the floor mat in S25 of the external sensor 50 is not wearing the pedestrian autonomous navigation sensor 5, F-ID data is transmitted to the mobile terminal 20 in S27 as shown by the dotted line. However, the mobile terminal 20 is in a state of checking whether a second step has been taken on the floor mat as shown in S6, and is therefore unable to receive a signal from the external sensor 50.

[0107] As a result, the external sensor 50 cannot confirm receipt of the P-ID signal within the predetermined time in S28 (No in S28), and the time runs out, causing the process to proceed to S25. This enables the external sensor 50 to determine whether the foot that stepped on the floor mat is a foot equipped with the pedestrian dead-reckoning sensor 5 or a foot not equipped with the pedestrian dead-reckoning sensor 5.

[0108] After receiving the P-ID from the mobile terminal 20, the external sensor 50 determines the moving direction of the pedestrian (P-ID) from the first and second positions of the pressure sensor 53, and performs correction value calculation to calculate the deviation amount (angle error) from the reference direction and the passing position (S30). The external sensor 50 outputs the F-ID, P-ID, and correction value to the mobile terminal 20 and the monitoring PC 30 (S31).

[0109] After receiving the F-ID, P-ID, and correction value from the external sensor 50, the mobile terminal 20 checks whether a flag indicating that a reset control signal has been received is ON in the memory unit 23 (S11).

[0110] After receiving the F-ID, P-ID, and correction value from the floor mat, the mobile terminal 20 resets the walking trajectory displayed on the display unit 25 of the mobile terminal 20 (S12). After that, the mobile terminal 20 performs a correction calculation for display, corrects the trajectory display, and resumes displaying the walking trajectory from a new reference point (S13).

[0111] The monitoring PC 30 receives walking data (X, Y, Z, θ) for the first step on the floor mat from the mobile terminal 20 via S3 shown in FIG. 7 (S40), and displays the pedestrian's trajectory on the display unit 25 based on the received walking data (X, Y, Z, θ) (S41).

[0112] Next, the monitoring PC 30 receives the walking data (X, Y, Z, θ) of the second step on the floor mat and a reset signal from the mobile terminal 20 in S8 shown in Fig. 7 (S42). After receiving the walking data (X, Y, Z, θ), the monitoring PC 30 temporarily stops displaying the pedestrian trajectory on the display unit 33 (S43).

[0113] After receiving the reset signal from the mobile terminal 20, the monitoring PC 30 determines the position of the pressure sensor 53 on the floor mat that has been made conductive by the second step as the position of the specific point. The position of the pressure sensor 53 on the floor mat that has been made conductive by the second step is acquired via the mobile terminal 20.

[0114] Next, the monitoring PC 30 receives the F-ID, P-IF, and correction value from the external sensor 50 in S31 shown in Fig. 7 (S44), and resets the walking trajectory displayed on the display unit 33. After that, a correction process for display is performed (S45). The monitoring PC 30 corrects the walking data from the mobile terminal 20 through the correction process, and displays the trajectory of the walker on the display unit 33 (S46).

[0115] In this way, the pedestrian autonomous navigation system receives a determination from the external sensor that a pedestrian has passed through a new specific point, resets the position information of the specific point that was previously passed through, and calculates a new position of the pedestrian from the position information of the newly passed specific point, an error associated with the newly passed specific point, and information from the pedestrian autonomous navigation sensor relating to the relative movement position from the newly passed specific point.

[0116] [Pedestrian trajectory using pedestrian dead-reckoning sensor] Next, a walking trajectory by the pedestrian autonomous navigation sensor when an external sensor is provided as a specific point on a walking route in the pedestrian autonomous navigation system will be described with reference to Fig. 8. Fig. 8 is a diagram showing a walking trajectory by the pedestrian autonomous navigation sensor 5 when an external sensor 50 is provided as a specific point on a walking route displayed on the display unit 33 of the monitoring PC 30 in the pedestrian autonomous navigation system, and a walking trajectory when no external sensor is provided on the walking route.

[0117] A pedestrian wearing a pedestrian dead-reckoning sensor actually walked along the walking route shown by the solid line, the dashed line shows the walking trajectory of the pedestrian when no external sensor was installed on the walking route, and the dotted line shows the walking trajectory of the pedestrian when an external sensor was installed on the walking route. The actual walking route shown by the solid line is from the starting point S to the end point E.

[0118] As shown in Figure 8, if an external sensor 50 is not installed on the walking route, the display unit 33 of the monitoring PC 30 gradually accumulates error from the starting point S, as shown by the dashed line, and Figure 8 shows that the error becomes larger at the point where the route turns at a right angle.

[0119] On the other hand, if an external sensor 50 is installed on the walking route, error gradually accumulates from the starting point S to the first specific point, which is the external sensor 50a. However, when passing the external sensor 50a, the error is corrected by the deviation amount shown by e1 and the position of the new specific point, which is the external sensor 50a, is reached and the position is positioned on the actual walking route shown by the solid line.

[0120] Furthermore, the error gradually accumulates until the next specific point, external sensor 50b, but when the external sensor 50b is passed, the error is corrected by the deviation e2 and the position of the new specific point, external sensor 50b, is displayed as being on the actual walking route shown by the solid line. Similarly, the error is corrected by deviations e3, e4, e5 each time the external sensors 50c, 50d, 50d, and 50e are passed, and the position is displayed as being on the actual walking route shown by the solid line.

[0121] In order to facilitate understanding of the figure, the walking trajectory is illustrated diagrammatically, but it is of course possible to actually plot each step in detail to display the walking trajectory.

[0122] In this way, by providing the external sensor 50 as a specific point on the walking route, accumulation of errors is eliminated, and the walking trajectory of the pedestrian is displayed on the display unit 33 of the monitoring PC 30 along the actual walking route.

[0123] The present invention may be embodied in many different forms without departing from the essential characteristics thereof, and it is to be understood that the above-described embodiments are merely illustrative and are not intended to limit the present invention.

[0124] The functional block diagram shown in Fig. 1 shows the functional configuration of the pedestrian autonomous navigation system 1 of the present invention, and does not limit the specific implementation form. In other words, it is not necessary to implement hardware corresponding to the functional blocks in the diagram, and it is of course possible to implement a configuration in which one processor executes a program to realize the functions of multiple functional units. In addition, some of the functions realized by software in the embodiment may be realized by hardware, and further, some of the functions realized by hardware may be realized by software. [Explanation of symbols]

[0125] 1 Pedestrian Autonomous Navigation System 5 Pedestrian Dead Reconnaissance Sensor 6 Sensor section 7 Acceleration Sensor 8 Angular Rate Sensor 9 Geomagnetic Sensor 12 Control section 13 Arithmetic section 14 Radio Section 15 Antenna 16 Battery 20 Mobile devices (smartphones) 21 Control section 22 Arithmetic section 23 Memory section 24 Control section 25 Display section 26 Wireless section (Bluetooth) 27 Antenna 28 Wireless section (WiFi) 29 Antenna 30 Monitoring PC 31 Control Unit 32 Arithmetic section 33 Display section 34 Memory section 35 Communication section (Ethernet) 40 WiFi Router 41 Wireless section (WiFi) 42 Control section 43 Communication section (Ethernet) 44 Antenna 50, 50a, 50b, 50c, 50d, 50e External Sensor 51 Detection sensor 53, 53a, 53b, 53c, 53d, 53e, 53f, 53g, 53h, 53i Pressure Sensors 54 Control section 55 Arithmetic section 56 Memory section 57 Wireless section (Bluetooth) 58 Antenna 59 Wireless section (WiFi) 60 Antenna 70 Gate 71 Bar 73 Side Panel 75 Walking direction display unit Vb Basic Vector Vg walking vector Vh Corrected walking vector Wd Basic walking direction We basic axis Sd Actual direction of travel Se Actual passing position

Claims

1. A pedestrian autonomous navigation system using a pedestrian autonomous navigation sensor that calculates a relative moving position by calculating a moving distance in at least an XY direction from measurements of an acceleration sensor and an angular velocity sensor, and calculating a traveling direction from measurements of a geomagnetic sensor, a pedestrian dead navigation sensor having the acceleration sensor, the angular velocity sensor, and the geomagnetic sensor; an external sensor capable of detecting that a pedestrian carrying the pedestrian dead-reckoning sensor has passed through a specific point whose position information has been specified in advance, and detecting an actual traveling direction and / or an actual passing position of the pedestrian when the pedestrian passed through the specific point; a walking direction regulation means for regulating a passing direction of the pedestrian at the specific point; a geomagnetic error calculation means for calculating, as an error of the geomagnetic sensor, a difference between a moving direction detected by the geomagnetic sensor when the pedestrian passes through the specific point and a regulated passing direction, which is a passing direction regulated by the walking direction regulating means; a passing error calculation means for calculating a difference between information relating to an actual moving direction and / or an actual passing position of the pedestrian and the regulated passing direction and / or the position information of the specific point as passing error information; a position calculation means for calculating a position of the pedestrian based on, upon receipt of a determination that the pedestrian has passed through the specific point, the position information of the specific point from the external sensor, the error calculated by the geomagnetic error calculation means, the passage error information calculated by the passage error calculation means, and information relating to the relative moving position from the pedestrian autonomous navigation sensor, The external sensor comprises a plurality of sensors arranged at and around the specific point and divided into a matrix, and the sensors transmit information relating to the actual traveling direction and / or the actual passing position of the pedestrian to the passing error calculation means.

2. 2. The pedestrian autonomous navigation system according to claim 1, wherein the walking direction regulating means is a gate, a door, a sign indicating a walking direction through which the pedestrian can pass, and / or a wheel track for regulating the movement of the pedestrian's shoes.

3. 3. The pedestrian autonomous navigation system according to claim 1, wherein the pedestrian autonomous navigation sensor is attached to a foot of the pedestrian, and corrects a speed error by assuming that a speed detected when the pedestrian is stationary is an error.

4. The position calculation means receives a new passage determination of the pedestrian at the specific point from the external sensor, and resets the position information of the specific point previously determined to have been passed by the pedestrian; 4. The pedestrian autonomous navigation system according to claim 1, wherein a new position of the pedestrian is calculated from the position information of the newly passed specific point, the error related to the newly passed specific point, and information related to the relative movement position from the newly passed specific point obtained from the pedestrian autonomous navigation sensor.

Images