WO2012157652A1 - 進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置 - Google Patents

進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置 Download PDF

Info

Publication number
WO2012157652A1
WO2012157652A1 PCT/JP2012/062441 JP2012062441W WO2012157652A1 WO 2012157652 A1 WO2012157652 A1 WO 2012157652A1 JP 2012062441 W JP2012062441 W JP 2012062441W WO 2012157652 A1 WO2012157652 A1 WO 2012157652A1
Authority
WO
WIPO (PCT)
Prior art keywords
acceleration
deceleration
traveling direction
phase
horizontal
Prior art date
Application number
PCT/JP2012/062441
Other languages
English (en)
French (fr)
Inventor
呂尚 高岡
Original Assignee
ソニー株式会社
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 ソニー株式会社 filed Critical ソニー株式会社
Priority to US14/116,141 priority Critical patent/US20140088867A1/en
Priority to EP12785505.4A priority patent/EP2711669A4/en
Priority to CN201280022320.6A priority patent/CN103502773A/zh
Publication of WO2012157652A1 publication Critical patent/WO2012157652A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • G01C22/006Pedometers

Definitions

  • the present disclosure relates to a traveling direction calculation device, a traveling direction calculation method, a traveling direction calculation program, and a navigation device, and is suitable for application to, for example, a smartphone having a navigation function.
  • smartphones In recent years, mobile phones called smartphones are becoming popular. This smartphone is small and maintains high portability, and in addition to communication functions, it has a high arithmetic processing function, a large display screen, a touch panel, etc., and can execute various application programs. Yes.
  • Some smartphones include various sensors such as an acceleration sensor and a geomagnetic sensor, a GPS (Global Positioning System) antenna, and the like, and function as a portable navigation device by executing a predetermined navigation program.
  • the smartphone receives a radio signal from a GPS satellite by a GPS antenna, calculates the current position, and performs various guidance such as a map screen in the vicinity and a route to a desired destination, like a general navigation device. Can be presented.
  • the current position is estimated by calculating the user's heading and moving distance based on the acceleration detection result by the acceleration sensor and the magnetic north detection result by the geomagnetic sensor.
  • the user may carry the smartphone in various places, such as putting the smartphone in a jacket pocket, a pants pocket, a bag or the like, or holding it in his hand.
  • smartphones depending on the user's mobile location, the way the external force applied with walking varies greatly, so the vertical component waveform and horizontal component waveform of the detection value by the acceleration sensor also differ greatly, for example, the peak that was assumed May not appear.
  • the smartphone cannot use the relationship between the peak of the waveform of the vertical component and the peak of the waveform of the horizontal component depending on the location of the user, and may not be able to calculate the traveling direction correctly.
  • the present disclosure has been made in consideration of the above points, and is a traveling azimuth calculation device, a traveling azimuth calculation method and a traveling azimuth calculation program that can accurately calculate a traveling azimuth, and accurately calculates a traveling azimuth and provides appropriate guidance.
  • the present invention intends to propose a navigation device that can be presented.
  • the traveling azimuth calculation device, the traveling azimuth calculation method, and the traveling azimuth calculation program of the present disclosure among the accelerations generated by the user's walking, the vertical acceleration representing the vertical acceleration and the horizontal plane The horizontal acceleration representing the direction and magnitude of acceleration is detected, and a period corresponding to two steps of the user is set as a walking cycle based on the zero crossing point of the vertical acceleration.
  • the acceleration / deceleration switching phase that switches between acceleration and deceleration in the direction of travel of the user is set based on the phase that minimizes the acceleration, and each section divided for each acceleration / deceleration switching phase is alternately accelerated or decelerated.
  • the direction of travel of the user is determined based on the direction represented by the horizontal acceleration in the deceleration section and the direction opposite to the direction represented by the horizontal acceleration in the acceleration section.
  • a detection unit that detects a vertical acceleration that represents a vertical acceleration and a horizontal acceleration that represents a direction and a magnitude of the acceleration in a horizontal plane among the accelerations generated as the user walks.
  • a walking cycle setting unit that sets a period corresponding to two steps of the user as a walking cycle based on the zero crossing point of the vertical acceleration, and the horizontal acceleration is minimized within the walking cycle.
  • the acceleration / deceleration switching phase setting unit that sets the acceleration / deceleration switching phase that switches between acceleration and deceleration in the traveling direction of the user, and each section divided for each acceleration / deceleration switching phase are alternately accelerated.
  • An acceleration / deceleration section estimation unit that estimates as a section or a deceleration section, and a direction opposite to the direction represented by the horizontal acceleration in the acceleration section based on the direction represented by the horizontal acceleration in the deceleration section
  • a traveling direction determination unit that determines the traveling direction of the user, and a guidance based on the current position detected by the predetermined position detection unit and the traveling direction are presented to the user by the predetermined presentation unit.
  • a presentation control unit was provided.
  • the navigation device of the present disclosure can satisfactorily set the reference of the walking cycle based on the zero crossing point of the vertical acceleration, and can accurately determine the acceleration / deceleration switching phase by using the minimum point of the horizontal acceleration. Since the section and the deceleration section can be appropriately set, it is possible to correctly associate the relationship between the direction of the acceleration obtained sequentially and the traveling direction of the user.
  • the present disclosure can realize a traveling direction calculation device, a traveling direction calculation method, a traveling direction calculation program, and a navigation device that can accurately calculate the traveling direction and present appropriate guidance.
  • FIG. 1 is a schematic perspective view showing an external configuration of a smartphone.
  • FIG. 2 is a schematic block diagram illustrating a circuit configuration of the smartphone.
  • FIG. 3 is a schematic diagram illustrating a functional block configuration of the control unit when the current position calculation process is executed.
  • FIG. 4 is a schematic diagram illustrating a functional block configuration of the traveling direction calculation unit.
  • FIG. 5 is a schematic diagram showing a traveling direction vector of the user.
  • FIG. 6 is a schematic diagram showing a portable part of the smartphone.
  • FIG. 7 is a schematic diagram for explaining accelerations in the (A) detection coordinate system, (B) ground coordinate system, and (C) xy plane.
  • FIG. 8 is a schematic diagram illustrating changes in acceleration before (A) the band detection process and after (B) the band detection process.
  • FIG. 8 is a schematic diagram illustrating changes in acceleration before (A) the band detection process and after (B) the band detection process.
  • FIG. 9 is a schematic diagram showing the relationship between the user's body movement and vertical acceleration during walking.
  • FIG. 10 is a schematic diagram showing a horizontal acceleration distribution (chest pocket).
  • FIG. 11 is a schematic diagram showing the distribution of horizontal acceleration (the outer right pocket).
  • FIG. 12 is a schematic diagram showing a horizontal acceleration distribution (butt pocket).
  • FIG. 13 is a schematic diagram showing (A) vertical acceleration, (B) horizontal acceleration, and (C) azimuth (chest pocket) during walking.
  • FIG. 14 is a schematic diagram showing (A) vertical acceleration, (B) horizontal acceleration, and (C) azimuth (outer right pocket) during walking.
  • FIG. 15 is a schematic diagram showing (A) vertical acceleration, (B) horizontal acceleration, and (C) azimuth (butt pocket) during walking.
  • FIG. 10 is a schematic diagram showing a horizontal acceleration distribution (chest pocket).
  • FIG. 11 is a schematic diagram showing the distribution of horizontal acceleration (the outer right pocket).
  • FIG. 12 is a
  • FIG. 16 is a schematic diagram showing an autocorrelation evaluation value (chest pocket).
  • FIG. 17 is a schematic diagram showing an autocorrelation evaluation value (a jacket right pocket).
  • FIG. 18 is a schematic diagram showing an autocorrelation evaluation value (butt pocket).
  • FIG. 19 is a schematic diagram showing an autocorrelation evaluation value (hand).
  • FIG. 20 is a schematic diagram showing an autocorrelation evaluation value ( ⁇ ).
  • FIG. 21 is a schematic diagram for explaining the determination of the minimum value in the autocorrelation evaluation value.
  • FIG. 22 is a schematic diagram illustrating changes in the walking cycle after (A) the adoption condition is not applied and (B) the adoption condition is applied.
  • FIG. 23 is a schematic diagram illustrating a zero cross point in vertical acceleration.
  • FIG. 23 is a schematic diagram illustrating a zero cross point in vertical acceleration.
  • FIG. 24 is a schematic diagram for explaining selection of a phase reference point.
  • FIG. 25 is a schematic diagram showing (D) minimum point appearance frequency (chest pocket) in (B) horizontal acceleration, and (A) a schematic diagram of (A) vertical acceleration and (C) azimuth.
  • FIG. 26 is a schematic diagram showing (D) minimum point appearance frequency (outer right pocket) in (B) horizontal acceleration, and (A) a schematic diagram of (A) vertical acceleration and (C) azimuth.
  • FIG. 27 is a schematic diagram showing (D) minimum point appearance frequency (butt pocket) in (B) horizontal acceleration, and (A) is a schematic diagram of vertical acceleration and (C) azimuth.
  • FIG. 25 is a schematic diagram showing (D) minimum point appearance frequency (chest pocket) in (B) horizontal acceleration, and (A) a schematic diagram of (A) vertical acceleration and (C) azimuth.
  • FIG. 26 is a schematic diagram showing (D) minimum point appearance frequency (butt pocket) in (B) horizontal acceleration
  • FIG. 28 is a schematic diagram showing (D) minimum point appearance frequency (hand pocket) in (B) horizontal acceleration, and (A) is a schematic diagram of vertical acceleration and (C) azimuth.
  • FIG. 29 is a schematic diagram showing (D) minimum point appearance frequency ( ⁇ pocket) in horizontal acceleration (B), and (A) a schematic diagram of vertical acceleration and (C) azimuth.
  • FIG. 30 is a schematic diagram illustrating changes in the appearance frequency of local minimum points during (A) normal addition and after (B) proximity phase exclusion processing.
  • FIG. 31 is a schematic diagram showing (A) vertical acceleration, (B) horizontal acceleration, (C) azimuth (D) acceleration / deceleration discrimination result (chest pocket).
  • FIG. 32 is a schematic diagram showing (D) acceleration / deceleration discrimination result (chest pocket) of (A) vertical acceleration, (B) horizontal acceleration, (C) azimuth angle.
  • FIG. 33 is a schematic diagram illustrating (A) vertical acceleration, (B) horizontal acceleration, (C) azimuth (D) acceleration / deceleration discrimination result (upper right pocket).
  • FIG. 34 is a schematic diagram showing (A) vertical acceleration, (B) horizontal acceleration, (C) azimuth (D) acceleration / deceleration discrimination result (outer right pocket).
  • FIG. 35 is a schematic diagram illustrating (A) vertical acceleration, (B) horizontal acceleration, (C) azimuth (D) acceleration / deceleration discrimination result (butt pocket).
  • FIG. 36 is a schematic diagram showing (A) vertical acceleration, (B) horizontal acceleration, (C) azimuth (D) acceleration / deceleration discrimination result (butt pocket).
  • FIG. 37 is a flowchart showing the procedure for calculating the traveling direction.
  • FIG. 38 is a flowchart showing a walking cycle calculation subroutine.
  • FIG. 39 is a flowchart showing an acceleration / deceleration switching phase learning subroutine.
  • FIG. 40 is a schematic diagram illustrating a calculation result (chest pocket) of the traveling direction during walking.
  • FIG. 41 is a schematic diagram showing a calculation result of the traveling direction (outer right pocket) during walking.
  • FIG. 42 is a schematic diagram illustrating a calculation result (butt pocket) of the traveling direction during walking.
  • Embodiment 2 receives a user's operation instruction via the operation unit 3 of the main body unit 2 and executes various applications such as a navigation program, and displays a display screen corresponding to the execution result. 4 is displayed.
  • the smartphone 1 receives a user's operation instruction via the operation unit 3 of the main body unit 2 and executes various applications such as a navigation program, and displays a display screen corresponding to the execution result. 4 is displayed.
  • the short direction and the long direction of the display unit 4 and the direction orthogonal to the display screen are defined as the x direction, the y direction, and the z direction, respectively, the main body unit 2 is approximately in each of the x, y, and z directions.
  • the smartphone 1 is configured so that the user can hold it with one hand or store it in a pocket such as a jacket or pants.
  • the smartphone 1 has a configuration in which the respective units are connected around the control unit 10, and the overall control is performed by the control unit 10.
  • a CPU (Central Processing Unit) 11 of the control unit 10 reads a basic program and various application programs from a ROM (Read Only Memory) 12, a nonvolatile memory 14, and the like via a bus 15, and reads a RAM (Random Access Memory) 13. Execute while using as work area.
  • ROM Read Only Memory
  • RAM Random Access Memory
  • the CPU 11 acquires various data and instructions supplied via the bus 15 and executes processing based on the acquired data and instructions.
  • the database (DB) 16 is composed of, for example, a flash memory and stores various data such as telephone directory data, music data, image data, and map data in a predetermined database format.
  • the operation unit 3 includes a touch panel 3A and various operation buttons 3B integrated on the surface of the display panel of the display unit 4 as shown in FIG. Is supplied to the CPU 11.
  • the display unit 4 is, for example, a liquid crystal panel, and generates and displays a display screen based on display data supplied via the bus 15.
  • the voice processing unit 21 converts the voice collected by the microphone 5 into digital voice data and supplies it to the bus 15, and converts the voice data acquired via the bus 15 into a voice signal to the speaker 6.
  • the communication processing unit 22 is wirelessly connected to a base station (not shown) via the antenna 7 and transmits various data supplied via the bus 15 to the base station and has been transmitted from the base station. Various data received are supplied to the bus 15.
  • the external interface (I / F) 23 is, for example, a microUSB (Universal Serial Bus) terminal, and exchanges data with a computer device (not shown) connected via a USB cable (not shown). It is made like that.
  • the GPS circuit 24 receives a GPS signal transmitted from a GPS satellite (not shown) by the GPS antenna 25 and supplies positioning data obtained by performing predetermined demodulation processing, decoding processing, and the like to the bus 15.
  • the acceleration sensor 27 detects acceleration in each of the three axial directions of x, y, and z, and generates an acceleration signal.
  • the A / D (Analog / Digital) conversion circuit 27A converts the acceleration signal into a three-dimensional acceleration A1 in a digital format by sampling at a sampling rate of 50 [Hz], and supplies this to the bus 15.
  • the acceleration A1 is a value that represents an acceleration generated according to the user's behavior.
  • the geomagnetic sensor 28 detects the direction of the magnetic field formed by the geomagnetism, and generates a geomagnetic signal whose components are the three axial directions of the x, y, and z directions.
  • the A / D conversion circuit 28A samples the geomagnetic signal at a sampling rate of 50 [Hz] to convert it into a three-dimensional geomagnetic value M in a digital format, and supplies this to the bus 15.
  • the control unit 10 receives a call function execution instruction from the user via the CPU 11, the control unit 10 executes a predetermined call program, wirelessly connects to the base station by the communication processing unit 22, and is collected by the microphone 5. The sound is converted into data and transmitted to the other party, and the voice data transmitted from the other party is output from the speaker 6.
  • control unit 10 When the control unit 10 receives an instruction to execute the music playback function from the user via the operation unit 3, the control unit 10 executes a predetermined music playback program and reads out the compressed music data from the database 16, and the audio processing unit 21. Then, a predetermined decoding process or the like is performed, and the sound is output from the speaker 5. Further, for each application program, for example, when the user receives an execution instruction from the user via the operation unit 3 or is set to be automatically executed, the control unit 10 reads the application program from the nonvolatile memory 14 and executes it. To do. The control unit 10 performs arithmetic processing according to the execution content, performs communication processing, displays a predetermined display screen on the display unit 4, or outputs predetermined sound from the speaker 6.
  • the smartphone 1 realizes various functions based on a call function, a music playback function, and an application program by executing various programs in accordance with user operation instructions.
  • the control part 10 will read and run a navigation program from the non-volatile memory 14, if the execution instruction of a navigation function is received from the user via the operation part 3, for example.
  • the operation mode can be switched by a user's operation instruction, and a walking mode that assumes the case where the user moves on foot is prepared as one of the operation modes.
  • the control unit 10 assumes that the GPS signal reception status is poor, such as indoors or in the vicinity of a high-rise building, and uses the acceleration and geomagnetic values generated by the user's walking motion to determine the walking speed and traveling direction. A current position calculation process for calculating is performed.
  • the control unit 10 realizes the functional blocks of the step count calculation unit 31, the speed calculation unit 32, the traveling direction calculation unit 33, the direction filter 34, and the position filter 35 as shown in FIG. ing.
  • the control unit 10 supplies the acceleration A1 obtained from the acceleration sensor 27 to the step count calculation unit 31 and the traveling direction calculation unit 33, and supplies the geomagnetic value M obtained from the geomagnetic sensor 28 to the traveling direction calculation unit 33.
  • control unit 10 sends GPS position data GP representing the position of the positioning data obtained from the GPS circuit 24 to the traveling direction calculation unit 33 and the position filter 35, and GPS speed data GV representing the speed to the speed calculation unit 32.
  • GPS azimuth data GC representing each is supplied to the azimuth filter 34.
  • the number-of-steps calculation unit 31 calculates a walking pitch representing the period of each step of the user and the number of steps based on the acceleration A1, and supplies these to the speed calculation unit 32 as step number data S1.
  • the speed calculation unit 32 calculates the walking speed by multiplying the stride obtained by the predetermined learning process by the walking pitch of the step count data S1, and calculates the speed data V1 based on the walking speed and the GPS speed data GV.
  • the traveling direction calculation unit 33 calculates the traveling direction based on the direction of acceleration appearing in the acceleration A1 during walking and the magnetic north direction indicated by the geomagnetic value M, and proceeds by correcting this using the GPS position data GP.
  • the direction data C1 is calculated (details will be described later) and supplied to the direction filter 34.
  • the azimuth filter 34 weights the GPS azimuth data GC2 and the azimuth azimuth data C1 representing the azimuth based on the current speed, the reception status of the GPS signal, etc. It is generated and supplied to the position filter 35 and a subsequent processing block (not shown).
  • the position filter 35 generates position data P1 by weighting and using the current speed and the reception status of the GPS signal based on the speed data V1, the traveling direction data C2, and the GPS position data GP. This is supplied to a subsequent processing block (not shown). Then, in the subsequent processing block (not shown), the control unit 10 stores map data in a range corresponding to the speed data V1, the position data P1, and the traveling direction data C2 (hereinafter collectively referred to as current position data D1) in the database 16 ( 1), and is displayed on the display unit 4 as a navigation screen together with a predetermined current position mark and a route to a designated destination.
  • the smartphone 1 calculates the speed data V1 and the traveling direction data C1 based on the acceleration A1, the geomagnetic value M, and the like by the current position calculation process, and performs weighting according to the reception status of the GPS signal to thereby calculate the current position.
  • Data D1 is generated.
  • [1-3. Calculation of traveling direction] By the way, if the control part 10 of the smart phone 1 receives the instruction
  • the smartphone 1 when the user walks, the smartphone 1 is assumed to be stored in the pocket of the clothes being worn or carried by being held by the user's hand. For this reason, the smartphone 1 can detect the acceleration acting on the body as the user walks with the acceleration sensor 27 as the acceleration A1. It is considered that the direction indicated by the acceleration A1 detected at this time is deeply related to the traveling direction of the walking user. Furthermore, the smartphone 1 can express the direction of acceleration detected by the acceleration sensor 27 as a traveling direction with reference to magnetic north by using the geomagnetic value M obtained by the geomagnetic sensor 28.
  • the traveling direction of the user is calculated based on the acceleration A1 and the geomagnetism value M obtained during the continuous two-step walking period.
  • the smartphone 1 is stored in each pocket of clothing such as a chest pocket W1 of an outer jacket, a right pocket W2 of an outer jacket, and a hip pocket W3 of a trouser. Alternatively, it may be held by the user's hand W4 and further stored in a bag W5 held by the user.
  • the smartphone 1 is stored in a pocket or the like in various orientations, or is held by a user's hand (hereinafter, a portion where the smartphone 1 is carried is referred to as a portable portion hereinafter). That is, the smartphone 1 is carried by the user at an arbitrary angle as shown in FIG.
  • a three-dimensional coordinate system (hereinafter referred to as a detection coordinate system) represented by the x-axis, y-axis, and z-axis defined for the main body 2 of the smartphone 1 has a vertical direction on the ground as one axis. This is different from the coordinate system (hereinafter referred to as the ground coordinate system).
  • the acceleration A1 detected by the acceleration sensor 27 includes a component (hereinafter referred to as walking acceleration) caused by the movement of the user's body with walking and a component of gravity acceleration (hereinafter referred to as gravity acceleration G). Call).
  • walking acceleration in addition to the forward and backward directions that are the direction of travel, with the user moving the left and right feet alternately forward, landing, and kicking back (hereinafter referred to as walking motion) It also appears in the left / right and up / down directions relative to the direction of travel.
  • walking acceleration in addition to the forward and backward directions that are the direction of travel, with the user moving the left and right feet alternately forward, landing, and kicking back (hereinafter referred to as walking motion) It also appears in the left / right and up / down directions relative to the direction of travel.
  • the traveling direction calculation unit 33 calculates the direction of gravity acceleration based on the integrated value of the acceleration A1, as shown in FIG. 7B, this direction can be set as the z-axis direction of the ground coordinate system.
  • the geomagnetic value M detected by the geomagnetic sensor 28 generates a geomagnetic vector VM (FIG. 7A) indicating the direction of magnetic north as a three-dimensional value based on the detection coordinate system.
  • the direction in which the magnetic north direction indicated by the geomagnetic value M is projected on the horizontal plane, that is, the xy plane of the ground coordinate system indicates the north (magnetic north) direction on the horizontal plane.
  • the projected magnetic north direction is defined as the y-axis direction of the terrestrial coordinate system
  • the y-axis direction and the x-axis direction orthogonal thereto are respectively the north direction and the east direction.
  • the traveling direction calculation unit 33 first cancels the walking acceleration component by accumulating the value of the acceleration A1 over a certain period (for example, 2 seconds) by the vertical direction detection unit 41 (FIG. 4).
  • G (Gx, Gy, Gz) is generated and supplied to the transformation matrix generation unit 42.
  • the transformation matrix generation unit 42 performs calculations according to the following equations (1), (2), and (3), so that the x-axis direction, the y-axis direction of the ground coordinate system viewed from the detection coordinate system, Unit vectors ex, ey and ez in the z-axis direction are calculated.
  • the transformation matrix generation unit 42 collects unit vectors (ex, ey, ez) of the ground coordinate system into a three-dimensional unit vector U.
  • the matrix represented by the unit vector U represents a conversion matrix from the detection coordinate system to the ground coordinate system. Therefore, the transformation matrix generation unit 42 supplies this transformation matrix U to the coordinate transformation unit 43.
  • the coordinate conversion unit 43 converts the acceleration A1 of the detected coordinate system into the acceleration A2 (A2x, A2y, A2z) of the ground coordinate system by performing arithmetic processing according to the following equation (5), and this is converted to BPF. (Band Pass Filter: band pass filter) 44.
  • the traveling direction calculation unit 33 in the control unit 10 of the smartphone 1 determines the ground acceleration from the detection coordinate system based on the direction of gravity acceleration obtained from the integrated value of the acceleration A1 and the direction of magnetic north indicated by the geomagnetic value M. After calculating the conversion matrix U to the coordinate system, the acceleration A1 of the detected coordinate system is converted to the acceleration A2 of the ground coordinate system. [1-3-3. Extraction of frequency band] Next, the frequency characteristic of the acceleration A2 will be examined. In general, it is known that the walking speed when a person moves on foot is about two steps per second. For this reason, it is considered that a component caused by walking appears in the band centered at about 2 [Hz] in the acceleration A1 of the detection coordinate system.
  • the acceleration A1 includes components due to various factors other than walking, that is, noise components, such as vibration applied to the smartphone 1 from the outside. Such a noise component is generally considered to be a relatively high frequency. Further, the acceleration A1 includes a component caused by the gravitational acceleration G and an offset component of the acceleration sensor 27. Among these components, the component resulting from the gravitational acceleration G is a direct current component, and the offset component is a low-frequency component that changes very slowly (for example, on the order of several seconds to several minutes) as the temperature changes. Further, since the frequency characteristic of the acceleration A1 in the detected coordinate system is not changed by the coordinate conversion, the same applies to the acceleration A2 converted into the ground coordinate system.
  • a band component including 2 [Hz] is extracted as a component mainly due to walking by the BPF (band pass filter) 44.
  • the BPF 44 of the traveling direction calculation unit 33 generates an acceleration A3 (A3x, A3y, A3z) by performing a band extraction process for extracting about 1 to 10 [Hz] for the acceleration A2, and generates the acceleration A3 (A3x, A3y, A3z).
  • the calculation unit 45 and the acceleration / deceleration section switching phase learning unit 46 are supplied.
  • the acceleration A3 is a component in which various noise components, gravitational acceleration G components, and offset components are greatly reduced, and represents a component mainly resulting from the user's walking motion.
  • the BPF 44 supplies the horizontal component (A3x, A3y) of the acceleration A3 to the traveling direction calculation unit 49.
  • FIGS. The distribution characteristics shown in Fig. 1 were obtained. 8A and 8B show that the high frequency component is reduced.
  • Ah A3x 2 + A3y 2 ... (6)
  • the BPF 44 supplies the vertical component (A3z) of the acceleration A3 to the acceleration / deceleration section estimation unit 47.
  • the vertical component of the acceleration A3 is also referred to as the vertical acceleration Av.
  • the BPF 44 of the traveling azimuth calculation unit 33 extracts the frequency band of 1 to 10 [Hz] from the horizontal component of the acceleration A2, thereby generating the acceleration A3 mainly composed of components caused by walking motion.
  • [1-3-4. Relationship between acceleration and deceleration intervals of horizontal acceleration and travel direction] Here, first, the relationship between the movement of the body when the user of the smartphone 1 performs a walking motion and the acceleration generated at that time will be described. FIG.
  • FIG. 9 schematically shows the posture during a period in which the user walks two steps by walking (hereinafter referred to as a walking cycle PW) at time points t0 to t4 on the time axis from left to right. It is.
  • the user in FIG. 9 is in a state where the right foot is stepped forward at time t0. From this state, the left foot is lifted from behind while moving the upper body forward, and the left foot is moved from the right foot at time t1. Is going to go forward. Subsequently, the user kicks the left foot forward while moving the state further forward from the state at time t1, and touches the left foot to ground at time t2. At this time, the user has moved forward one step from the state at time t0.
  • FIG. 9 shows the waveform of the vertical acceleration Av in the vertical direction (that is, the vertical direction) acting on the user's body and the waveform of the vertical velocity Vv in association with the time points t0 to t4. Further, FIG. 9 shows up and down arrows VU and VD representing the direction in which the body moves up and down during each time point, left and right arrows HA and HR representing acceleration or deceleration in the front-rear direction, and an increase in vertical acceleration Av.
  • decrease are shown collectively.
  • the user has the lowest body (mainly upper body) at the time points t0, t2, and t4 when both the left and right feet are opened forward and backward.
  • the user has the highest body height at time points t1 and t3 in which either the left or right foot is in contact with the ground and extends substantially straight from the grounded foot to the head. That is, as shown by the vertical arrows VU and VD, the user can see that the body moves so as to reciprocate twice in the vertical direction in the walking cycle PW in which two steps are taken.
  • the vertical velocity Vv which is the velocity in the vertical direction of the user's body, increases from 0 and decreases again from time t0 to time t1 and from time t2 to time t3 due to the relationship with the vertical acceleration Av. Returning to 0, between time t1 and t2 and between time t3 and t4, after decreasing from 0, it increases and returns to 0 again.
  • the horizontal speed Vh the change in the speed of the user's body in the horizontal direction
  • the user's body while walking moves while moving the landing foot backwards and pushes the upper body forward, while the foot kicked forward lands before the upper body is positioned near the position of the foot Decelerate while moving forward. That is, there is a section in the walking cycle PW that decelerates in the traveling direction as indicated by the arrow HR (hereinafter referred to as a deceleration section SR), and the other sections accelerate in the traveling direction as indicated by the arrow HA. There is a section (hereinafter referred to as an acceleration section SA).
  • the horizontal acceleration Ah acts on the user's body in the traveling direction.
  • the acceleration section SA since acceleration is performed in the traveling direction, it is considered that the horizontal acceleration Ah acts on the user's body in a direction opposite to the traveling direction.
  • the acceleration value detected by the acceleration sensor 27 has periodicity regardless of where the user carries the smartphone 1 (FIG. 6).
  • the horizontal acceleration Ah obtained when the user actually walked with the smartphone 1 was plotted on the xy coordinate plane, distribution characteristics as shown in FIGS.
  • 10 to 12 were obtained. 10, 11, and 12 are distributions when walking toward the north direction with the carrying portion (FIG. 6) of the smartphone 1 as the chest pocket W1, the right pocket W2 of the jacket, and the buttocks pocket W3 of the trousers, respectively. It is a characteristic. 10 to 12, the horizontal acceleration Ah obtained when the user walks for a certain period of time is cut out for about 4 seconds, and points that are temporally continuous are connected by a line. Incidentally, since the detection cycle is 50 [Hz], the interval between successive plots corresponds to 0.02 [s]. 10 to 12, since it is known that the traveling direction of the pedestrian is almost north, that is, the positive direction of the y-axis, the first quadrant and the second quadrant in which the y value is mainly positive.
  • the plot distributed in is equivalent to the deceleration section SR, and the plot distributed mainly in the third and fourth quadrants where the value of y is negative corresponds to the acceleration section SA.
  • the temporal change that is, the state of the line connecting the plots, in FIGS. 10 to 12
  • the part surrounded by the broken line corresponds to the deceleration section SR
  • the part surrounded by the alternate long and short dash line corresponds to the acceleration section SA. Conceivable.
  • the portion of the deceleration zone SR in the horizontal acceleration Ah in the xy plane coordinates is considered that the plot distributed in is equivalent to the deceleration section SR, and the plot distributed mainly in the third and fourth quadrants where the value of y is negative corresponds to the acceleration section SA.
  • both the deceleration zone SR and the acceleration zone SA are separated relatively easily.
  • the portion corresponding to the acceleration section SA does not appear remarkably
  • the portion corresponding to the deceleration section SR does not appear remarkably.
  • FIG. 12 shows that when a person walks, his / her waist moves so that the influence can appear on the acceleration. That is, the characteristics of the horizontal acceleration Ah vary greatly depending on the location where the user carries the smartphone 1.
  • FIGS. 13A to 15A each show the vertical acceleration Av
  • FIGS. 13B to 15B each show the horizontal acceleration Ah
  • FIGS. 13C to 15C show the azimuth angle Cm (FIG. 7C) when the azimuth indicated by the horizontal acceleration Ah is expressed in polar coordinates where the north direction is “0”.
  • the horizontal axis in FIGS. 13 to 15 represents the number of samples by the A / D conversion circuit 27A connected to the acceleration sensor 27. Since the sampling rate is 50 [Hz], one sample is 0.02 Corresponds to [s].
  • the actual waveform of the vertical acceleration Av is not necessarily a sine waveform like the schematic waveform (FIG. 9). It can also be seen that the actual waveform of the vertical acceleration Av varies greatly depending on the location where the smartphone 1 is carried. For example, when the portable part is the breast pocket W1, the waveform of the right foot and the waveform of the left foot are relatively similar in the waveform of the vertical acceleration Av.
  • the waveform of the right foot and the waveform of the left foot (that is, the waveform of two consecutive steps) among the vertical acceleration Av waveforms are large. Is different.
  • the vertical acceleration Av a relatively similar waveform repeatedly appears at every walking cycle PW corresponding to two steps, regardless of where the mobile phone is carried. This coincides with the fact that the maximum value and the minimum value appear twice in the vertical acceleration Av during the walking cycle PW, that is, while the user advances two steps by walking in the schematic waveform (FIG. 9). .
  • the time until the waveform similar to the waveform of a certain part appears again is not used.
  • an arbitrary portion of the vertical acceleration Av is defined as a function f (t)
  • the degree of autocorrelation of the function f (t) is expressed by the autocorrelation evaluation function g (t) shown in the following equation (7). It was.
  • the autocorrelation evaluation function g (t) has a smaller value as the autocorrelation degree is higher, and the value (evaluation value) becomes “0” when they completely coincide.
  • the constant T represents the window size, that is, the range of the phase difference t for calculating the autocorrelation degree.
  • the phase difference t is the number of samples in FIGS. 13 to 15 and corresponds to the time difference.
  • the value of the autocorrelation evaluation function g (t) when the phase difference t is gradually increased from one sample that is, 0.02 [s]
  • the phase difference t The relationship was graphed. 16, FIG. 17, FIG. 18, FIG. 19 and FIG. 20 show that the portable part (FIG. 6) is the chest pocket W1, the right pocket W2 of the jacket, the butt pocket W3 of the trousers, the user's hand W4 and the inside W5 of the bag.
  • FIGS. 16 to 20 a plurality of calculation results obtained by gradually changing the portion of the vertical acceleration Av used as the function f (t) are displayed in an overlapping manner. 16 to 20, in most of the overlapping waveforms, the phase difference t is about every 20 to 24 samples (about every 0.4 to 0.48 [s]), that is, one step of the user. The local minimum appears every time you do it. In addition, for the first step, the minimum value may be extremely small or not so much depending on the mobile location, but for the second step, the minimum value is extremely small in any mobile location. .
  • the phase difference t at which the second minimum value appears in the autocorrelation evaluation value obtained by the autocorrelation evaluation function g (t) is not particularly defined without specifying the calculation start timing or the like. It is considered that the walking cycle PW may be used.
  • one waveform of the autocorrelation evaluation values shown in FIG. 20 is extracted and shown in FIG. In FIG.
  • the minimum values min1A and min1B appear twice when the phase difference t is about 20 to 24 samples, and the third minimum value min2 appears when the phase difference t is about 46 samples thereafter. ing.
  • the phase difference t where the second minimum value appears if the phase difference t where the second minimum value appears is simply adopted, it corresponds to the first step, not the minimum value min2 to be originally adopted.
  • the phase difference t when the minimum value min1B is taken is erroneously adopted. In this way, when the phase difference t when the second minimum value appears is the walking cycle PW, the value corresponding to the correct second step (about 46 to 50 samples) as shown in FIG.
  • the value corresponding to the first step (about 24 to 32 samples) is erroneously detected with a relatively high frequency.
  • the difference d1 between the maximum value max1 and the minimum value min1A (or min1B) at the first step is relatively small.
  • the drop d2 between the maximum value max2 and the minimum value min2 in the second step is relatively large.
  • the drop d1 at the first step may be a relatively large value that is substantially equivalent to the drop d2 at the second step.
  • the following conditions (8) were satisfied for the first minimum value min1, and the following conditions (9) were satisfied for the second minimum value min2.
  • min2 ⁇ max2 ⁇ 0.5 (9) the maximum values appearing immediately before the respective minimum values min1 and min2 to be adopted are used in consideration of the possibility of appearing a plurality of times during one step. It was.
  • the coefficient “0.9” in the equation (8) is a value having a relatively small minimum value in consideration that the vertical acceleration Av during walking may not be highly correlated with the other foot. Even so, it was determined to be surely detected as the first step.
  • the coefficient “0.5” in the equation (9) is considered as the second step when the local minimum value becomes small to some extent in consideration of the relatively high correlation with the same foot in the vertical acceleration Av during walking.
  • a value smaller than the coefficient “0.9” in equation (8) is set so as not to be erroneously detected as the second step. did.
  • the walking cycle calculation unit 45 (FIG. 4) of the traveling direction calculation unit 33 sets an arbitrary portion of the vertical acceleration A2z supplied from the vertical direction detection unit 41B as a function f (t), and (7) An autocorrelation evaluation value is calculated according to the formula.
  • the walking cycle calculation unit 45 employs the minimum values min1 and min2 that satisfy the equations (8) and (9), and sets the phase difference t when the minimum value min2 is reached as the walking cycle PW.
  • the walking cycle calculation unit 45 takes the phase difference t that increases the autocorrelation degree for the vertical acceleration A2z for the second time as two steps based on the vertical acceleration A2z that represents a periodic waveform according to the user's walking.
  • the minute walking cycle PW is detected.
  • phase reference point PS a phase to be used as a reference when dividing the horizontal acceleration Ah for each walking cycle PW.
  • PS a phase to be used as a reference when dividing the horizontal acceleration Ah for each walking cycle PW.
  • FIG. 23 shows waveforms of arbitrary four steps (that is, two cycles of the walking cycle PW) out of the vertical acceleration Av obtained when the portable portion (FIG. 6) of the smartphone 1 is ⁇ W5. .
  • a maximum point and a minimum point appear four times for four steps, that is, for two cycles of the walking cycle PW, and zero cross points (change from negative to positive or positive to negative respectively)
  • the walking cycle calculation unit 45 calculates a difference between each local maximum value existing in this range and a local minimum value that appears immediately after that, and a local maximum point and a local minimum point when the head difference becomes maximum.
  • the descending zero cross point sandwiched between the two is used as the phase reference point PS.
  • the walking cycle calculation unit 45 sets the uplink zero cross point that appears next to the downlink zero cross point adopted as the phase reference point PS as the reference uplink zero cross point PU. Incidentally, this reference upstream zero-cross point PU is used in later processing.
  • the walking cycle calculation unit 45 supplies the phase reference point PS to the acceleration / deceleration section switching phase learning unit 46 and also supplies the phase reference point PS and the reference up-zero cross point PU to the acceleration / deceleration section estimation unit 47.
  • the walking cycle calculation unit 45 is sandwiched between the local maximum point and the local minimum point when the difference between the local maximum value and the local minimum value that appears immediately after the vertical acceleration Av for the walking cycle PW is maximum.
  • the downstream zero cross point is set as the phase reference point PS.
  • the deceleration section SR appears twice during the walking cycle PW, that is, while the user advances two steps by walking. This means that the acceleration section SA and the deceleration section SR are switched four times during the walking cycle PW.
  • the horizontal acceleration Ah is very likely to take a minimum value in principle. That is, it is considered that a minimum point (hereinafter referred to as an acceleration / deceleration switching point CH) due to switching between the acceleration section SA and the deceleration section SR appears four times in the horizontal acceleration Ah during the walking cycle PW. Therefore, referring to FIGS.
  • the horizontal acceleration Ah includes a local minimum point (hereinafter referred to as another factor point OT). It can be seen that (indicated by a triangular mark in the figure) also appears. For this reason, in order to detect the acceleration section SA and the deceleration section SR based on the minimum points appearing in the horizontal acceleration Ah, it is necessary to appropriately select the acceleration / deceleration switching point CH from these minimum points.
  • acceleration / deceleration switching phase PC a phase corresponding to the acceleration / deceleration switching point CH (hereinafter referred to as acceleration / deceleration switching phase PC) by a statistical method based on the phase where the minimum point appears in the horizontal acceleration Ah.
  • the horizontal acceleration Ah is divided for each phase reference point PS (that is, for each walking cycle PW), the phase is normalized using this phase reference point PS as a starting point, and each walking cycle PW is determined for each phase.
  • the appearance frequency (cumulative value) of the minimum point is calculated. Further, when acceleration and deceleration are switched, the azimuth angle Cm is considered to change greatly.
  • the minimum point when the minimum point appears in the horizontal acceleration Ah, if the change in the azimuth angle Cm is not so large, the minimum point is highly likely to be another factor point OT. In this case, it is desirable to exclude this phase from the statistical processing. Therefore, if a minimum point appears five times or more in one walking cycle PW, the four phases are cumulatively added in order of increasing azimuth change, specifically, in descending order of the differential value of the azimuth angle Cm. It was decided to be the target of. According to such a policy, the frequency of appearance of local minimum points for the case where the carrying portion of the smartphone 1 (FIG. 6) is the breast pocket W1 and the right pocket W2 of the jacket is tabulated, respectively, and FIG. 25 (D) and FIG.
  • FIGS. 25A to 25C and FIGS. 26A to 26C show examples of waveforms of the vertical acceleration Av, the horizontal acceleration Ah, and the azimuth angle Cm, respectively.
  • a known acceleration / deceleration switching point CH (indicated by a circle in the figure)
  • another factor point OT (indicated by a triangle in the figure) are also shown.
  • the appearance frequency of the minimum point is high near the phase corresponding to the acceleration / deceleration switching point CH, and the other phases are formed.
  • Examples of waveforms of the vertical acceleration Av, the horizontal acceleration Ah, and the azimuth angle Cm corresponding to each of them are shown. From FIG. 27, FIG. 28 and FIG. 29, in the trousers bottom pocket W3, the user's hand W4 and the heel W5, the appearance frequency of the minimum point is somewhat high near the phase corresponding to the acceleration / deceleration switching point CH, and a peak is formed. Has been. However, even in other phases, there are places where peaks appear with high frequency of appearance of the minimum points. In particular, in the case of the bottom pocket W3 of the pants (FIG. 27), the peak formed in the other phase is larger than the peak formed in the phase other than the acceleration / deceleration switching point CH (that is, the appearance frequency is higher). .
  • the acceleration / deceleration switching phase PC cannot be selected correctly only by adopting four locations in order of increasing appearance frequency of the minimum points among the phases in which the peaks are formed.
  • the portable part of the smartphone 1 (FIG. 6) is the trousers pocket W3, and the phase where the local minimum appears in the horizontal acceleration Ah in each walking cycle PW based on data different from the data used in FIG.
  • FIG. 30A a graph as shown in FIG. 30A was obtained.
  • FIG. 30 (A) as in the case of FIG. 27 (B), the places where the appearance frequency of the minimum points is high, that is, the peaks appear at 6 places.
  • peaks PK1, PK2, PK3, PK4, PK5, and PK6 are set in order of phase.
  • the peaks PK1, PK3, PK4, and PK6 correspond to the acceleration / deceleration switching point CH, and the remaining peaks PK2 and PK5 correspond to the other factor points OT.
  • the peaks PK1, PK6, PK4, PK2, PK3, and PK5 are in descending order. That is, in this case as well, as in the case of FIG. 27, the acceleration / deceleration switching point CH cannot be correctly selected only by adopting the four locations in order of increasing appearance frequency of the minimum points.
  • the phase interval between them is about 4 samples, that is, about 0.08 [s].
  • the interval of 1/10 of the walking cycle PW is an acceleration section when acceleration / deceleration switching is performed in a relatively short time due to reasons such as the pedestrian's stride being temporarily narrowed due to the road surface condition, etc. It is determined in consideration of the minimum possible length of SA or deceleration zone SR.
  • the magnitude of each peak is the peak PK6, PK1, PK4, PK3, PK2 and PK5. That is, in FIG. 30B, the phases where the four peaks appear in the descending order are all acceleration / deceleration switching points CH.
  • the acceleration / deceleration section switching phase learning unit 46 (FIG. 4) of the traveling direction calculation unit 33 calculates the horizontal acceleration Ah from the acceleration A3 supplied from the vertical direction detection unit 41B by the equation (6), and walks. The frequency of appearance of local minimum points for each period PW is accumulated.
  • the acceleration / deceleration section switching phase learning unit 46 sets the four points in order from the largest differential value of the azimuth angle Cm among the minimum points appearing in each walking cycle PW. Minimal points whose interval from the phase adopted as the target is 1/10 or less of the walking cycle PW are excluded from the targets of cumulative addition in the walking cycle PW. Then, the acceleration / deceleration section switching phase learning unit 46 adopts four phases as the acceleration / deceleration switching phase PC in order from the largest among the plurality of peaks appearing in the total frequency appearance result of the minimum points, and uses these as the acceleration / deceleration section PC It supplies to the estimation part 47.
  • the acceleration / deceleration section switching phase learning unit 46 aggregates the appearance frequency of the minimum value of the horizontal acceleration Ah while performing the proximity phase exclusion process, and detects the four phases as the acceleration / deceleration switching phase PC in descending order of the peak. It is made to do.
  • [1-3-8. Estimation of acceleration / deceleration section] a process for estimating whether each section divided by the four acceleration / deceleration switching phases PC in the walking cycle PW is an acceleration section SA or a deceleration section SR (hereinafter, this is referred to as an acceleration / deceleration section estimation process). Is called). Referring again to the waveforms in FIGS. 13 to 15 and FIGS.
  • the acceleration / deceleration switching phase PC when the acceleration / deceleration switching phase PC is included once in this period, the section immediately after the acceleration / deceleration switching phase PC may be set as the deceleration section SR.
  • the acceleration zero-deceleration switching phase PC first appearing after the reference zero-crossing point PU (FIG. 24) first appears in the vertical acceleration Av within the walking cycle PW starting from the phase reference point PS.
  • the starting point of the deceleration zone SR can be used.
  • the deceleration zone SR and the acceleration zone SA may be switched alternately. Based on these, the acceleration / deceleration section estimation unit 47 (FIG.
  • the traveling direction calculation unit 33 first receives the vertical acceleration Av from the BPF 44, and also receives the phase reference point PS and the reference ascending zero cross point from the walking cycle calculation unit 45.
  • the acceleration / deceleration switching phase learning unit 46 receives the acceleration / deceleration switching phase PC.
  • the acceleration / deceleration section estimation unit 47 then follows the acceleration / deceleration switching phase PC that appears first after the reference upstream zero-cross point PU in the walking cycle PW starting from the phase reference point PS.
  • the section up to is defined as a deceleration section SR.
  • the acceleration / deceleration section estimation unit 47 sequentially estimates each section divided for each subsequent acceleration / deceleration switching phase PC as an acceleration section SA or a deceleration section SR. Further, the acceleration / deceleration section estimation unit 47 generates acceleration / deceleration information IAR indicating whether the current time belongs to the acceleration section SA or the deceleration section SR, and supplies this to the traveling direction calculation section 49.
  • FIGS. 31 to 36 an example of the result of estimating the acceleration / deceleration information IAR by the acceleration / deceleration section estimation unit 47 is shown in FIGS. 31 to 36 together with the waveforms of the vertical acceleration Av, the horizontal acceleration Ah, and the azimuth angle Cm.
  • FIGS. 31 to 36 an example of the result of estimating the acceleration / deceleration information IAR by the acceleration / deceleration section estimation unit 47 is shown in FIGS. 31 to 36 together with the waveforms of the vertical acceleration Av, the horizontal acceleration Ah, and the azimuth
  • FIGS. 31 and 32 show the case where the carrying portion (FIG. 6) of the smartphone 1 is the breast pocket W1
  • FIGS. 33 and 34 show the right pocket W2 of the jacket
  • FIGS. 35 and 36 show the hip pocket W3.
  • the waveforms of the acceleration / deceleration information IAR shown in FIGS. 31D to 36D indicate that the high level is the deceleration zone SR and the low level is the acceleration zone SA. From FIG. 31 to FIG. 36, it can be estimated that the deceleration zone SR and the acceleration zone SA can be estimated well after the time point TS that has progressed a dozen steps from the beginning of walking, regardless of where the smartphone 1 is carried. I understand.
  • the acceleration / deceleration section estimation unit 47 accumulates the frequency of appearance of the minimum points sufficiently, and after the time TS at which the learning process has progressed to some extent, the accuracy of detection of the acceleration / deceleration switching phase PC by the acceleration / deceleration section switching phase learning unit 46 increases.
  • the deceleration zone SR and the acceleration zone SA can be estimated accurately and stably.
  • the acceleration / deceleration section estimation unit 47 uses, as the acceleration / deceleration section estimation process, the acceleration / deceleration switching phase PC that first appears after the reference uplink zero-cross point PU as the start point of the deceleration section SR, and the subsequent acceleration / deceleration switching phase PC.
  • Each section divided every time is sequentially estimated as an acceleration section SA or a deceleration section SR.
  • a process for calculating the final traveling direction of the user based on the horizontal acceleration (A3x, A3y) and the acceleration / deceleration information IAR (that is, the estimation result of the acceleration section SA or the deceleration section SR) will be described.
  • the acceleration acts forward on the smartphone 1 when decelerating, and the acceleration acts backward on acceleration.
  • the acceleration A3 of the ground coordinate system uses the magnetic north direction represented by the geomagnetic value M as the y-axis direction.
  • the magnetic north indicated by the geomagnetism is an error called a declination between the true north indicated by the earth's earth axis. There is. It is known that this declination has a different value depending on the latitude and longitude.
  • the orientation expressed in the ground coordinate system that is, the orientation based on magnetic north
  • the acceleration A3 is considered to include acceleration generated by factors other than walking to some extent.
  • the relative ratio of the acceleration resulting from walking is high when the magnitude of the acceleration A3 is relatively large
  • the direction represented by the acceleration A3 is an accuracy representing the traveling direction of the user or the opposite direction. Is considered high.
  • the direction represented by the acceleration A3 increases the relative proportion of the acceleration generated by factors other than walking when the magnitude of the acceleration A3 is relatively small. It is considered that the accuracy of representing is reduced.
  • the traveling azimuth obtained there as a smoothing process, the specific gravity is increased as the acceleration value is larger, specifically, by multiplying the coefficient according to the magnitude of the acceleration A3 and taking the addition average, It is considered that the influence of acceleration due to the above factors can be reduced and the accuracy can be improved.
  • the traveling direction calculation unit 33 first receives the GPS latitude / longitude data GL representing the latitude and longitude from the GPS circuit 24 by the deflection angle acquisition unit 48, and acquires the deflection angle of the current position based on this.
  • the deflection angle data DA is generated and supplied to the traveling direction calculation unit 49.
  • the traveling direction calculation unit 49 Based on the acceleration / deceleration information IAR supplied from the acceleration / deceleration zone estimation unit 47, the traveling direction calculation unit 49 identifies whether the current time belongs to the acceleration zone SA or the deceleration zone SR.
  • the traveling direction calculation unit 49 supplies the direction indicated by the horizontal acceleration (A3x, A3y) supplied from the BPF 44 as the traveling direction if the current time belongs to the deceleration zone SR, and the current time belongs to the acceleration zone SA. If so, the opposite direction is the traveling direction.
  • the traveling azimuth calculation unit 49 generates traveling azimuth data C0 representing the traveling azimuth by correcting the traveling azimuth based on the declination data DA, and supplies this to the traveling azimuth smoothing unit 50. Further, the traveling direction calculation unit 49 calculates a horizontal acceleration value Ahs indicating the magnitude of the horizontal acceleration (A3x, A3y), and supplies this to the traveling direction smoothing unit 50 as well. As the smoothing process, the traveling azimuth smoothing unit 50 multiplies the traveling azimuth data C0 by a coefficient corresponding to the magnitude of the horizontal acceleration value Ahs, and then performs an addition average over a certain period (for example, 1 second). By calculating, the traveling direction data C1 is generated and supplied to the direction filter 34 (FIG.
  • the traveling direction calculation unit 49 identifies whether the current time belongs to the acceleration section SA or the deceleration section SR based on the acceleration / deceleration information IAR, performs the correction process according to the declination, and then proceeds to the traveling direction. Traveling direction data C0 representing is generated. Further, the traveling azimuth smoothing unit 50 generates traveling azimuth data C1 with improved accuracy by smoothing the azimuth represented by the traveling azimuth data C0 with a specific gravity corresponding to the magnitude of the acceleration A3. . In this way, the traveling direction calculation unit 33 can generate traveling direction data C1 representing the traveling direction of the walking user based on the acceleration A1 and the geomagnetic value M. [1-4.
  • step SP1 the control unit 10 (FIG. 1) of the smartphone 1 starts the traveling direction calculation processing procedure RT1 (FIG. 37) by reading and executing the traveling direction calculation program from the nonvolatile memory 14, and proceeds to step SP1.
  • step SP1 the control unit 10 generates the gravitational acceleration G (Gx, Gy, Gz) by accumulating the value of the acceleration A1 over 2 seconds by the vertical direction detection unit 41 (FIG. 4), and next step SP2 Move on.
  • step SP2 the control unit 10 calculates the unit vector U (ex, ey, ez) of the ground coordinate system viewed from the detection coordinate system according to the equation (4) by the transformation matrix generation unit 42 (FIG. 4), and then performs the next step SP43. Move on.
  • step SP3 the control unit 10 performs coordinate conversion of the detected coordinate system acceleration A1 into the ground coordinate system acceleration A2 (A2x, A2y, A2z) by the coordinate conversion unit 43 (FIG. 4) according to the equation (5).
  • the control unit 10 generates an acceleration A3 (A3x, A3y, A3z) by extracting a band component of about 1 to 10 [Hz] from the acceleration A2 by the BPF 44 (FIG. 4).
  • step SP5 the control unit 10 calculates the walking cycle PW by the processing procedure according to the walking cycle calculation subroutine SRT1 (details will be described later) by the walking cycle calculation unit 45 (FIG. 4), and proceeds to the next step SP6.
  • step SP6 the control unit 10 continues to detect the descending zero cross point between the local maximum point and the local minimum point where the head is maximum in the range of the vertical acceleration Av from the arbitrary time point to the walking cycle PW. Is a phase reference point PS. Further, the control unit 10 sets the next uplink zero-cross point as the reference uplink zero-cross point PU, and proceeds to the next step SP7.
  • step SP7 the control unit 10 causes the acceleration / deceleration section switching phase learning unit 46 to set the acceleration / deceleration switching phase PC while performing the proximity phase exclusion process according to the processing procedure according to the acceleration / deceleration switching phase learning subroutine SRT2 (details will be described later).
  • step SP8 the control unit 10 causes the acceleration / deceleration section estimation unit 47 (FIG. 4) to generate an acceleration / deceleration switching phase that first appears after the reference upstream zero-cross point PU within the walking cycle PW starting from the phase reference point PS.
  • a section from PC to the next acceleration / deceleration switching phase PC is estimated as a deceleration section SR.
  • control unit 10 causes the acceleration / deceleration zone estimation unit 47 to alternately estimate each zone divided for each subsequent acceleration / deceleration switching phase PC as the acceleration zone SA or the deceleration zone SR, and proceeds to the next step SP9.
  • the control unit 10 causes the traveling direction calculation unit 49 (FIG. 4) to use the direction indicated by the horizontal acceleration (A3x, A3y) as the traveling direction as it is if the current time belongs to the deceleration zone SR, and accelerate the current time. If it belongs to the section SA, the opposite direction is set as the traveling direction, and the process proceeds to the next step SP10.
  • step SP10 the control unit 10 causes the traveling direction smoothing unit 50 to multiply the traveling direction data C0 by a coefficient corresponding to the magnitude of the horizontal acceleration value Ahs and calculate an average of 1 second by calculating the traveling direction data C1. calculate. Subsequently, the control unit 10 supplies the traveling azimuth data C1 to the azimuth filter 34 (FIG. 3), and then proceeds to the next step SP11 to end a series of traveling azimuth calculation processing procedures RT1. [1-4-2. Walking cycle calculation processing procedure] When the control unit 10 (FIG. 1) of the smartphone 1 proceeds to step SP5 in the traveling direction calculation processing procedure RT1 (FIG. 37), the walking cycle calculation subroutine SRT1 (FIG.
  • step SP21 the control unit 10 sets an arbitrary part of the vertical acceleration Av as a function f (t), calculates an autocorrelation evaluation value using the autocorrelation evaluation function g (t) according to the equation (7), The process proceeds to step SP22.
  • step SP22 the control unit 10 detects the minimum point while changing the autocorrelation evaluation value in the direction of sequentially increasing the phase difference t from 1, and proceeds to the next step SP23.
  • step SP23 the control unit 10 detects a local maximum point that appears immediately before the local minimum point detected in step SP22, and proceeds to the next step SP24.
  • step SP24 the control unit 10 determines whether or not the first minimum point has already been adopted. If a negative result is obtained here, the controller 10 proceeds to the next step SP25.
  • step SP25 the control unit 10 follows the equation (8), and the value of the local minimum point of interest (that is, the local minimum value) is 0.9 times or less the value of the local maximum point that appears immediately before (ie, the local maximum value). It is determined whether or not. If a negative result is obtained here, this indicates that the difference between the local maximum value and the local minimum value is extremely small, and the local minimum point of interest is not likely to represent the first step. At this time, the control unit 10 returns to step SP22 again to detect the next minimum point.
  • step SP25 if an affirmative result is obtained in step SP25, this indicates that the current minimum point can be regarded as representing the first step.
  • the control unit 10 proceeds to the next step SP26.
  • step SP26 the control unit 10 adopts the local minimum point of interest as the local minimum point for the first time (that is, corresponding to the first step), and then repeats step SP22 to detect the local minimum point corresponding to the second step.
  • step SP24 If a positive result is obtained in step SP24, that is, if the first minimum point is adopted in step SP26 and then the process proceeds to step SP24 again, the control unit 10 proceeds to the next step SP27.
  • step SP27 the control unit 10 follows the expression (9), and the value of the local minimum point of interest (that is, the local minimum value) is not more than 0.5 times the value of the local maximum point that appears immediately before (that is, the local maximum value). It is determined whether or not. If a negative result is obtained here, this indicates that the difference between the local maximum value and the local minimum value is relatively small, and the local minimum point of interest can be regarded as not representing the second step. At this time, the control unit 10 returns to step SP22 again to detect the next minimum point. On the other hand, if an affirmative result is obtained in step SP27, this indicates that the current minimum point can be regarded as representing the second step, and at this time, the control unit 10 proceeds to the next step SP28. .
  • step SP28 the control unit 10 adopts the local minimum point of interest as the local minimum point for the second time (that is, corresponding to the second step), and sets the phase difference t at this time as the walking cycle PW. Thereafter, the control unit 10 proceeds to the next step SP29, ends the walking cycle calculation subroutine SRT1, and returns to step SP5 of the traveling direction calculation processing procedure RT1 (FIG. 37).
  • step SP29 ends the walking cycle calculation subroutine SRT1
  • step SP5 the traveling direction calculation processing procedure RT1 (FIG. 37).
  • Subroutine SRT2 (FIG. 39) is started and the routine goes to Step SP31.
  • step SP31 the control unit 10 pays attention to a certain walking cycle PW, and calculates the horizontal acceleration Ah according to the equation (6) based on the acceleration A3 for each phase in the walking cycle PW. Further, the control unit 10 detects a minimum point appearing in the horizontal acceleration Ah, and proceeds to the next step SP32.
  • step SP32 the control unit 10 calculates a differential value of the azimuth angle Cm for each phase in which the minimum point is detected, and proceeds to the next step SP33.
  • step SP33 the control unit 10 pays attention to the minimum point having the largest differential value of the azimuth angle Cm among the unfocused minimum points, and proceeds to the next step SP34.
  • step SP34 the control unit 10 determines whether there is a local minimum point that has already been adopted. If a negative result is obtained here, this indicates that the minimal point currently focused on is the minimal point focused first. At this time, the control unit 10 proceeds to the next step SP35 in order to adopt the minimal point currently focused on unconditionally without considering the interval with the other minimal points. In step SP35, the control unit 10 adopts the minimum point currently focused on, and proceeds to the next step SP36. In step SP36, the control unit 10 determines whether or not the number of minimum points adopted has reached four. If a negative result is obtained here, this indicates that it is necessary to adopt another minimum point. At this time, the control unit 10 returns to step SP33 again to focus on the next minimum point.
  • step SP34 the control unit 10 calculates the smallest interval (hereinafter referred to as the minimum interval) between the phase of the adopted minimum point and the phase of the minimum point currently focused on, and the next step Move to SP38.
  • step SP38 the control unit 10 determines whether or not the calculated minimum interval is 1/10 or less of the walking cycle PW. If a negative result is obtained here, this means that the local minimum point of interest is sufficiently far from the already used local minimum point, and the section between the two is defined as the acceleration section SA or the deceleration section SR.
  • step SP35 the control unit 10 moves to the above-described step SP35 and adopts the minimum point currently focused on.
  • step SP38 if an affirmative result is obtained in step SP38, this is because the currently focused minimum point is too close to the adopted minimum point, the section sandwiched between them is set as the acceleration section SA or the deceleration section SR. In this case, the movement of the pedestrian is unnatural.
  • the control unit 10 returns to step SP33 again so as to focus on the next minimum point without adopting the minimum value currently focused on as the proximity phase exclusion process.
  • step SP36 the control unit 10 adds the appearance frequencies of the adopted phases of the respective minimum points, and proceeds to the next step SP40.
  • step SP40 the control unit 10 determines whether or not the phase of each local minimum point has been added as the appearance frequency for all walking cycles PW included in the predetermined counting period. If a negative result is obtained here, this indicates that there is still a walking cycle PW in which attention has not been paid, that is, the phase of the minimum point is not added, and at this time, the control unit 10 performs the next step. Move to SP41.
  • step SP41 the controller 10 sets the unfocused walking cycle PW as the newly focused walking cycle PW, and returns to step SP31 again to add the phase of the minimum point to the appearance frequency for this walking cycle PW.
  • step SP40 the control unit 10 proceeds to the next step SP42.
  • step SP42 the controller 10 finally adopts four locations as the acceleration / deceleration switching phase PC in order from the phase in which the appearance frequency of the local minimum point is highest.
  • control unit 10 proceeds to the next step SP43, ends the acceleration / deceleration switching phase learning subroutine SRT2, and returns to step SP7 of the traveling direction calculation processing procedure RT1 (FIG. 37).
  • step SP43 ends the acceleration / deceleration switching phase learning subroutine SRT2
  • step SP7 of the traveling direction calculation processing procedure RT1 (FIG. 37).
  • FIG. 40, FIG. 41, and FIG. 42 show the movement trajectory on the map. 40 to 42
  • the locus of the user's walking is plotted on the map data by an isosceles triangular locus mark, and the traveling direction in each plot is represented by the direction indicated by the apex angle.
  • the user is walking along the actual road in a rectangular shape in a counterclockwise direction.
  • the traveling azimuth at the time of walking of the user can be calculated satisfactorily although it is slightly rightward from the original traveling direction in some sections.
  • the portable position is the buttocks pocket W3 (FIG. 42)
  • the error tends to be slightly larger than in the case of the breast pocket W1 (FIG. 40) and the right pocket W2 of the outer jacket (FIG. 41).
  • the traveling direction can be calculated to a sufficiently reliable level.
  • the control unit 10 of the smartphone 1 when executing the navigation function in the walking mode, implements the functional blocks illustrated in FIGS. 3 and 4 by executing the navigation program and the traveling direction calculation program. .
  • the traveling direction calculation unit 33 first calculates the gravitational acceleration G based on the integrated value of the acceleration A1 to determine the vertical direction, and generates the unit vector U of the ground coordinate system viewed from the detection coordinate system by the equation (4). Then, the coordinate transformation of the acceleration A1 in the detected coordinate system to the acceleration A2 in the ground coordinate system is performed.
  • the traveling direction calculation unit 33 extracts a frequency band mainly resulting from walking from the acceleration A2 to obtain an acceleration A3, and uses the autocorrelation evaluation value of the vertical acceleration Av that is a vertical component thereof to determine the degree of autocorrelation.
  • the walking cycle PW is determined on the basis of the phase difference when is increased for the second time. Further, the traveling direction calculation unit 33 determines the phase reference point PS and the reference ascending zero-cross point PU based on the maximum point and the minimum point at which the drop is maximum in the vertical acceleration Av.
  • the traveling azimuth calculation unit 33 learns a phase where a minimum point appears in the horizontal acceleration Ah and the differential value of the azimuth angle Cm is large for each walking cycle PW starting from the phase reference point PS, and based on the learning result.
  • the acceleration / deceleration switching phase PC is selected.
  • the traveling direction calculation unit 33 alternately estimates the deceleration zone SR or the acceleration zone SA for each acceleration / deceleration switching phase PC based on the reference up-zero cross point PU within the walking cycle PW, and the direction indicated by the horizontal acceleration or
  • the traveling direction data C1 is calculated after smoothing the opposite direction as the traveling direction.
  • the smartphone 1 can appropriately determine the acceleration / deceleration switching phase PC using the minimum point appearing in the horizontal acceleration Ah, the smartphone 1 can separate the deceleration section SR and the acceleration section SA during walking with high accuracy. Thereby, the smartphone 1 can appropriately determine whether the horizontal acceleration acts in the traveling direction or the opposite direction, and can calculate the final traveling direction of the user with high accuracy. In particular, since the smartphone 1 calculates the final traveling direction after dividing the acceleration section SA and the deceleration section SR, compared with a method in which the major axis is defined on the horizontal plane without dividing both, The effect of moving in a rotating manner can be effectively eliminated.
  • the smartphone 1 detects the acceleration / deceleration switching phase PC based on the phase at which the minimum point appears in the horizontal acceleration Ah based on the user's operating principle during walking.
  • the deceleration zone SR and the acceleration zone SA can be clearly distinguished. Further, as shown in FIGS. 25 to 29, the smartphone 1 has a minimum point with high accuracy at least in the phase where the deceleration section SR and the acceleration section SA are switched, although the characteristics of the horizontal acceleration Ah vary depending on the user's carrying location. Therefore, the acceleration / deceleration switching phase PC can be detected satisfactorily.
  • the smartphone 1 learns a phase having a large differential value of the azimuth angle Cm among the minute points of the horizontal acceleration Ah as a phase in which acceleration and deceleration are switched, thereby eliminating the other factor point OT and accelerating / decelerating switching phase PC. Can be selected with high accuracy.
  • the smartphone 1 can also effectively exclude the other factor points OT by performing the proximity phase exclusion process using the fact that acceleration and deceleration are not switched in a very short time during walking.
  • the smartphone 1 uses the autocorrelation evaluation value based on the fact that the vertical acceleration Av periodically varies with the walking motion that the user repeats periodically. PW can be calculated with high accuracy.
  • the smartphone 1 can accurately extract each walking cycle PW by setting the descending zero cross point at which the difference between the maximum value and the minimum value within the walking cycle PW is the maximum as the phase reference point PS.
  • the smartphone 1 determines the first deceleration zone SR based on the reference up-zero cross point PU that appears next to the phase reference point PS, based on the relationship between the waveform of the vertical acceleration Av and the deceleration zone SR and the acceleration zone SA.
  • the subsequent deceleration section SR and acceleration section SA can be determined appropriately.
  • the smartphone 1 adds the specific gravity according to the magnitude of the acceleration in the smoothing process, thereby increasing the specific gravity of the sample with high reliability in the traveling direction and effectively using all the samples, Therefore, the accuracy of the traveling direction data C1 obtained can be increased.
  • the smartphone 1 can suppress the influence relatively low by using all the samples even when the acceleration includes a temporary noise component.
  • the smartphone 1 converts the detection coordinate system into the ground coordinate system at once using the conversion matrix represented by the unit vector U, so that the calculation processing amount is minimized and the conversion is performed in the rotation coordinate system. It is not necessary to generate an error as in the case.
  • the smartphone 1 determines the walking cycle PW using the autocorrelation evaluation value of the vertical acceleration Av, and further determines the phase reference point PS and the reference up-zero cross point PU.
  • the smartphone 1 learns the phase where the minimum point appears in the horizontal acceleration Ah while performing the proximity phase exclusion process, and selects the acceleration / deceleration switching phase PC based on the learning result.
  • the smartphone 1 alternately estimates the section divided for each acceleration / deceleration switching phase PC after the reference up-zero cross point PU as the deceleration section SR or the acceleration section SA, and proceeds in the direction indicated by the horizontal acceleration or the opposite direction.
  • the traveling azimuth data C1 is calculated after smoothing.
  • the smartphone 1 can obtain an appropriate traveling direction in each of the deceleration section SR and the acceleration section SA, and can accurately calculate the final traveling direction of the user.
  • the acceleration / deceleration switching phase PC is selected by the learning process based on the appearance phase of the minimum point of the horizontal acceleration Ah has been described.
  • the present technology is not limited to this, and for example, the four points may be directly used as the acceleration / deceleration switching phase PC in the descending order of the differential value of the azimuth angle Cm among the minimum points of the horizontal acceleration Ah.
  • the learning process By omitting the learning process in this way, the calculation processing amount of the smartphone 1 can be reduced, so that power consumption can be reduced.
  • the phase to which the appearance frequency is to be added by the learning process is selected using the magnitude of the differential value of the azimuth angle Cm as an index among the minimum points of the horizontal acceleration Ah. .
  • the present technology is not limited to this, and may be selected based on various other indicators such as the relationship with the maximum phase and the appearance phase of the minimum point in the vertical acceleration Av.
  • the number of phases to which the appearance frequency should be added for one walking cycle PW is not limited to 4, and may be 5 or more and 3 or less.
  • a frequency corresponding to the magnitude of the differential value of the azimuth angle Cm may be multiplied to make the frequency a non-integer and added.
  • the addition is performed in the proximity phase exclusion process when learning the appearance phase of the minimum point of the horizontal acceleration Ah, when the minimum interval between the phases is 1/10 or less of the walking cycle PW.
  • the present technology is not limited to this, and may be excluded from the addition target on the condition of an arbitrary threshold value such as 1/8 or less or 1/15 or less of the walking cycle PW.
  • the proximity phase exclusion process may be omitted when it is known that the interval between the appearance phases of the minimum points is relatively large.
  • a phase whose interval with the adopted phase is too small is excluded from the adoption candidates in the walking cycle. The case where it was to be described.
  • the present technology is not limited to this.
  • the frequency is added without excluding the phase whose interval from the adopted phase is too small, and the four phases are adopted in the descending order after the addition.
  • the proximity phase exclusion process it may be sequentially adopted while excluding a phase whose interval from the adopted phase is too small.
  • the walking cycle is calculated as a period corresponding to two steps of the user and the acceleration / deceleration switching phase is set at four points in the walking cycle. This technology is not limited to this, for example, when the bag containing the smartphone 1 is suspended from the shoulder, and it has been found that the acceleration / deceleration is switched excessively when the bag periodically hits the walking body.
  • the acceleration / deceleration switching phase may be set to an arbitrary number such as 6 points or 8 points. Even in this case, since the acceleration section SA or the deceleration section SR can be estimated alternately for each acceleration / deceleration switching phase PC, it is possible to finally calculate the traveling direction appropriately. Further, in the above-described embodiment, the acceleration / deceleration switching phase PC that first appears after the reference ascending zero-cross point PU is used as the starting point of the deceleration zone SR, and the zones divided for each subsequent acceleration / deceleration switching phase PC are alternately accelerated. The case where the section SA or the deceleration section SR is estimated has been described. The present technology is not limited to this.
  • the acceleration / deceleration switching phase PC that first appears after the phase reference point PS is used as the start point of the deceleration section SR, for example.
  • the section SR and the acceleration section SA may be estimated.
  • the deceleration zone SR and the acceleration zone SA may be estimated using the feature appearing in the waveform of the vertical acceleration Av as an index.
  • the walking cycle PW is calculated based on the autocorrelation evaluation value obtained using the autocorrelation function representing the vertical acceleration Av has been described.
  • the present technology is not limited to this, and various other autocorrelation functions may be used such as, for example, an autocorrelation evaluation value obtained using an autocorrelation function representing the horizontal acceleration Ah and the azimuth angle Cm.
  • an autocorrelation evaluation value obtained using an autocorrelation function representing the horizontal acceleration Ah and the azimuth angle Cm.
  • the present technology is not limited to this, and the walking cycle PW may be calculated by various methods, for example, the minimum point that appears after the second maximum point is set as the walking cycle PW.
  • the phase in which the degree of correlation increases second time when the phase difference is sequentially expanded according to the nature of the autocorrelation function may be set as the walking period PW.
  • each coefficient may be set to an arbitrary value.
  • the first step is the other foot and the second step is the same foot
  • the following (10) is obtained when the coefficients in the equations (8) and (9) are j and k, respectively. )
  • the relationship of the formula is satisfied.
  • the descending zero cross point when the difference between the maximum value and the minimum value of the vertical acceleration Av is the maximum is set as the phase reference point PS, and this is set as the start point of the walking cycle PW.
  • the phase of the maximum point or the minimum point when the difference between the maximum value and the minimum value of the vertical acceleration Av is the maximum is set as the phase reference point PS.
  • the reference point PS may be determined.
  • the phase reference point PS may be determined using a feature that appears only once in the period of the walking cycle PW in the vertical acceleration Av.
  • the frequency band extracted by the BPF 44 (FIG. 4) is about 1 to 10 [Hz] has been described.
  • the present technology is not limited to this, and various frequency bands such as about 0.5 to 20 [Hz] may be extracted.
  • the present technology is not limited to this, for example, by converting the x-axis and y-axis of the detection coordinate system to a coordinate system in which the axes projected onto the horizontal plane are the x-axis and y-axis, respectively, that is, the coordinate system not considering magnetic north, and acceleration After calculating the traveling azimuth based on the above, it may be converted to the azimuth based on magnetic north.
  • the coordinate system is not limited to an orthogonal coordinate system, and an arbitrary coordinate system such as a polar coordinate system may be used.
  • the smoothing process the calculated traveling direction is multiplied by a coefficient corresponding to the magnitude of the acceleration in the horizontal direction to obtain an addition average.
  • the present technology is not limited to this.
  • the average may be obtained by multiplying various coefficients such as multiplying by a coefficient proportional to the square of the acceleration in the horizontal direction, or all coefficients may have the same value (for example, The smoothing process may be omitted by setting “1”).
  • the traveling direction is corrected according to the declination obtained based on the latitude and longitude of the current location has been described. The present technology is not limited to this.
  • the traveling direction may be corrected based on a standard correction value, or correction processing may be performed. May be omitted.
  • the latitude and longitude of the current location are not limited to GPS signals, and may be obtained based on various signals and information such as wireless LAN (Local Area Network) signals.
  • the azimuth filter 34 weights the GPS azimuth data GC and the traveling azimuth data C1 based on the reception status of the GPS signal, that is, the traveling azimuth data only when the GPS signal reception accuracy is low. The case where the weight of C1 is increased has been described.
  • the traveling direction data C1 may be regularly used in the direction filter 34, for example. Thereby, since the reception frequency of the GPS signal by the GPS circuit 24 can be reduced, the power consumption of the smartphone 1 can be suppressed. Further, in the above-described embodiment, when the navigation function is provided with a plurality of operation modes and the walking mode which is one of them is selected, the traveling direction calculation unit 33 calculates the traveling direction data C1. Said.
  • the present technology is not limited to this. For example, when the navigation program is being executed, the waveform of the acceleration A1 is constantly monitored. C1 may be calculated. Furthermore, in the above-described embodiment, the case where the map screen is displayed on the display unit 4 as the guidance in the navigation processing has been described.
  • the present technology is not limited to this, and the guidance may be presented to the user by various methods, for example, by guiding the direction of the destination by voice. Furthermore, in embodiment mentioned above, the case where this technique was applied to the smart phone 1 was described.
  • the present technology is not limited to this, for example, a portable navigation device, a digital video camera or a digital still camera, a portable music player or a portable video player, a portable game machine, a pedometer, or a notebook or slate computer You may make it apply to various electronic devices which a user can carry at the time of a walk, such as a device, and have a positioning function. In any case, it is only necessary to obtain vertical acceleration and horizontal acceleration and finally generate the traveling direction data C1 based on these.
  • control unit 10 of the smartphone 1 executes the navigation program and the traveling direction calculation program stored in advance in the ROM 12, the nonvolatile memory 14, etc., so that the traveling direction calculation processing procedure RT1 and the like are performed.
  • the present technology is not limited to this, and the control unit 10 of the smartphone 1 performs each process described above according to an application program installed from a storage medium, an application program downloaded from the Internet, and other application programs installed through various acquisition routes. You may do it.
  • the case where the traveling direction calculation unit 33 as the traveling direction calculation device is configured by the unit 46, the acceleration / deceleration section estimation unit 47 as the acceleration / deceleration section setting unit, and the traveling direction calculation unit 49 as the traveling direction determination unit has been described. .
  • a traveling azimuth calculation device includes a detection unit having various other configurations, a walking cycle setting unit, an acceleration / deceleration switching phase setting unit, an acceleration / deceleration section setting unit, and a traveling direction determination unit. You may make it comprise.
  • the present technology can also be configured as follows.
  • a detection unit that detects a vertical acceleration representing a vertical acceleration and a horizontal acceleration representing an azimuth and a magnitude of the acceleration in a horizontal plane among the accelerations generated as a user walks; Based on the zero cross point, the walking cycle setting unit that sets a period corresponding to two steps of the user as a walking cycle, and the phase in which the magnitude of the horizontal acceleration is minimized within the walking cycle, the above An acceleration / deceleration switching phase setting unit that sets an acceleration / deceleration switching phase that switches between acceleration and deceleration in the direction of travel of the user, and each section divided for each acceleration / deceleration switching phase is alternately estimated as an acceleration section or a deceleration section And the acceleration / deceleration section estimation unit that determines the traveling direction of the user based on the direction represented by the horizontal acceleration in the deceleration section and the direction opposite to the direction represented by the horizontal acceleration in the acceleration section.
  • Traveling azimuth calculation device and a traveling direction determination unit constant to.
  • the acceleration / deceleration switching phase setting unit sets, as the acceleration / deceleration switching phase, a phase with a high frequency at which the magnitude of the horizontal acceleration is minimized within the walking cycle. apparatus.
  • the acceleration / deceleration switching phase setting unit calculates an azimuth angle representing the azimuth in which the acceleration acts based on the horizontal acceleration in polar coordinates and a differential value of the azimuth angle, and the magnitude of the horizontal acceleration is minimal.
  • the traveling azimuth calculation apparatus according to (1) or (2), wherein a predetermined number is added to the frequency in descending order of the azimuth angle differential value in the phase.
  • the acceleration / deceleration switching phase setting unit sequentially sets the acceleration / deceleration switching phase from the phase with the highest frequency at which the magnitude of the horizontal acceleration is minimized within the walking cycle, and the acceleration / deceleration switching already set.
  • the traveling direction calculation device according to (2) or (3), wherein a phase that is less than a predetermined interval from the phase is excluded from a setting target of the new acceleration / deceleration switching phase.
  • the traveling direction calculation device according to any one of (1) to (4), wherein the acceleration / deceleration switching phase setting unit sets four points of the acceleration / deceleration switching phase within the walking cycle.
  • the walking cycle setting unit sets the length of the walking cycle based on a period until a waveform similar to a predetermined portion appears again in the vertical acceleration, according to any one of (1) to (5)
  • the advancing direction calculation apparatus as described in.
  • the walking cycle setting unit calculates the autocorrelation degree while sequentially increasing the phase difference with respect to the vertical acceleration, and calculates the phase difference when the extreme value at which the autocorrelation degree becomes high appears for the second time as the walking.
  • the travel direction calculation device according to (5), wherein the period is a length of a cycle.
  • the walking cycle setting unit calculates the autocorrelation value from an autocorrelation value that decreases according to the level of the autocorrelation degree, and the first minimum value of the autocorrelation value is immediately before The maximum value that appears is j times (0 ⁇ j ⁇ 1) or less, and the second minimum value of the autocorrelation value is k times the maximum value that appeared immediately before (where 0 ⁇ k ⁇ j) or less.
  • the traveling direction calculation device according to (6) or (7), wherein the phase difference when the second minimum value appears is the length of the walking cycle.
  • the gait cycle setting unit sets the gait cycle, and sets the zero cross point of the descending point where the difference between the adjacent maximum value and the minimum value of the vertical acceleration is maximum within the gait cycle as a phase reference
  • the traveling direction calculation apparatus according to any one of (1) to (8), wherein the traveling direction calculation apparatus sets the reference phase to (10)
  • the detection unit detects an acceleration applied to the traveling direction calculation device, and uses an acceleration sensor as an acceleration detection value represented by a unique three-dimensional detection coordinate system, and based on the acceleration detection value.
  • the traveling direction calculation device according to any one of (1) to (9), further including a conversion unit configured to convert the horizontal acceleration.
  • the detection unit further includes a geomagnetic sensor that detects a magnetic north direction in the traveling direction calculation device, and the conversion unit converts the direction represented by the horizontal acceleration into an absolute direction based on the magnetic north.
  • the traveling direction calculation device according to (10) above.
  • the conversion unit converts the acceleration detection value from the detection coordinate system to the ground coordinate system in which the direction corresponding to the vertical direction and the magnetic north is each set as one axial direction.
  • the travel direction calculation apparatus according to 11).
  • the present disclosure can also be used in various electronic devices such as a portable navigation device, a mobile phone equipped with a navigation function, or a digital still camera or a computer device.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

進行方位を精度良く算出できるようにする。本開示の進行方位算出装置は、使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出部と、鉛直加速度のゼロクロス点を基に、使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定部と、歩行周期内において、水平加速度の大きさが極小となる位相を基に、使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定部と、加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定部と、減速区間では水平加速度が表す方位に基づき、加速区間では水平加速度が表す方位と反対の方位に基づき、使用者の進行方位を決定する進行方位決定部とを設けるようにした。

Description

進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置
 本開示は進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置に関し、例えばナビゲーション機能を有するスマートフォンに適用して好適なものである。
 近年、スマートフォンと呼ばれる携帯型電話機が普及しつつある。このスマートフォンは、小型に構成され高い携帯性を維持しながら、通信機能に加えて、高い演算処理機能、大型の表示画面及びタッチパネル等を備えており、種々のアプリケーションプログラムを実行できるようになされている。
 またスマートフォンのなかには、加速度センサや地磁気センサ等の各種センサ、GPS(Global Positioning System)アンテナ等を内蔵し、所定のナビゲーションプログラムを実行することにより携帯型のナビゲーション装置として機能するものもある。
 この場合スマートフォンは、一般的なナビゲーション装置と同様、GPS衛星からの無線信号をGPSアンテナにより受信して現在位置を算出し、その近傍の地図画面や所望の目的地への経路等、様々な案内を提示することができる。
 またナビゲーション装置のなかには、GPS信号を受信できない場合に、加速度センサによる加速度の検出結果や地磁気センサによる磁北の検出結果等を基に、使用者の進行方位及び移動距離を算出して現在位置を推定するものも提案されている(例えば、特許文献1参照)。
 このナビゲーション装置では、加速度センサにより検出された加速度のうち垂直成分の波形及び水平成分の波形のピーク等の関係を用いることにより、使用者の進行方位を算出するようになされている。
特許第4126388号公報(第1図)
 ところで使用者は、歩行する際、スマートフォンを上着のポケットやズボンのポケット、鞄等の中に入れ、或いは手に把持する等、様々な箇所に携帯する可能性がある。
 するとスマートフォンでは、使用者の携帯箇所に応じて、歩行に伴う外力の加わり方が大きく異なるため、加速度センサによる検出値の垂直成分の波形や水平成分の波形も大きく異なり、例えば想定していたピークが現れない可能性もある。
 このためスマートフォンでは、使用者の携帯箇所によっては垂直成分の波形及び水平成分の波形のピーク等の関係を利用することができず、進行方位を正しく算出できない場合があるという問題があった。
 本開示は以上の点を考慮してなされたもので、進行方位を精度良く算出し得る進行方位算出装置、進行方位算出方法及び進行方位算出プログラム、並びに進行方位を精度良く算出し適切な案内を提示し得るナビゲーション装置を提案しようとするものである。
 かかる課題を解決するため本開示の進行方位算出装置、進行方位算出方法及び進行方位算出プログラムにおいては、使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出し、鉛直加速度のゼロクロス点を基に、使用者の2歩に相当する期間を歩行周期として設定し、歩行周期内において、水平加速度の大きさが極小となる位相を基に、使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定し、加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定し、減速区間では水平加速度が表す方位に基づき、加速区間では水平加速度が表す方位と反対の方位に基づき、使用者の進行方位を決定するようにした。
 本開示では、鉛直加速度のゼロクロス点を基に歩行周期の基準を良好に設定できると共に、水平加速度の極小点を用いることにより加減速切替位相を精度良く判別でき、これを基に加速区間及び減速区間を適切に設定できるので、順次得られる加速度の方向と使用者の進行方向との関係を正しく対応付けることができる。
 また本開示のナビゲーション装置においては、使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出部と、上記鉛直加速度のゼロクロス点を基に、上記使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定部と、上記歩行周期内において、上記水平加速度の大きさが極小となる位相を基に、上記使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定部と、上記加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定部と、上記減速区間では上記水平加速度が表す方位に基づき、上記加速区間では上記水平加速度が表す方位と反対の方位に基づき、上記使用者の進行方位を決定する進行方位決定部と、所定の位置検出部により検出した現在位置と上記進行方位とに基づいた案内を所定の提示部により上記使用者に提示させる提示制御部とを設けるようにした。
 本開示のナビゲーション装置は、鉛直加速度のゼロクロス点を基に歩行周期の基準を良好に設定できると共に、水平加速度の極小点を用いることにより加減速切替位相を精度良く判別でき、これを基に加速区間及び減速区間を適切に設定できるので、順次得られる加速度の方向と使用者の進行方向との関係を正しく対応付けることができる。
 本開示によれば、鉛直加速度のゼロクロス点を基に歩行周期の基準を良好に設定できると共に、水平加速度の極小点を用いることにより加減速切替位相を精度良く判別でき、これを基に加速区間及び減速区間を適切に設定できるので、順次得られる加速度の方向と使用者の進行方向との関係を正しく対応付けることができる。かくして本開示は、進行方位を精度良く算出し得る進行方位算出装置、進行方位算出方法及び進行方位算出プログラム、並びに進行方位を精度良く算出し適切な案内を提示し得るナビゲーション装置を実現できる。
 図1は、スマートフォンの外観構成を示す略線的斜視図である。
 図2は、スマートフォンの回路構成を示す略線的ブロック図である。
 図3は、現在位置算出処理の実行時における制御部の機能ブロック構成を示す略線図である。
 図4は、進行方位算出部の機能ブロック構成を示す略線図である。
 図5は、使用者の進行方向ベクトルを示す略線図である。
 図6は、スマートフォンの携帯箇所を示す略線図である。
 図7は、(A)検出座標系、(B)地上座標系及び(C)xy平面における加速度の説明に供する略線図である。
 図8は、(A)帯域検出処理前及び(B)帯域検出処理後の加速度の変化を示す略線図である。
 図9は、歩行時における使用者の体の動きと鉛直加速度との関係を示す略線図である。
 図10は、水平加速度の分布(胸ポケット)を示す略線図である。
 図11は、水平加速度の分布(上着右ポケット)を示す略線図である。
 図12は、水平加速度の分布(尻ポケット)を示す略線図である。
 図13は、歩行時における(A)垂直加速度、(B)水平加速度及び(C)方位角(胸ポケット)を示す略線図である。
 図14は、歩行時における(A)垂直加速度、(B)水平加速度及び(C)方位角(上着右ポケット)を示す略線図である。
 図15は、歩行時における(A)垂直加速度、(B)水平加速度及び(C)方位角(尻ポケット)を示す略線図である。
 図16は、自己相関評価値(胸ポケット)を示す略線図である。
 図17は、自己相関評価値(上着右ポケット)を示す略線図である。
 図18は、自己相関評価値(尻ポケット)を示す略線図である。
 図19は、自己相関評価値(手)を示す略線図である。
 図20は、自己相関評価値(鞄)を示す略線図である。
 図21は、自己相関評価値における極小値の判定の説明に供する略線図である。
 図22は、(A)採用条件未適用及び(B)採用条件適用後の歩行周期の変化を示す略線図である。
 図23は、鉛直加速度におけるゼロクロス点を示す略線図である。
 図24は、位相基準点の選定の説明に供する略線図である。
 図25は、(B)水平加速度における(D)極小点出現頻度(胸ポケット)を示す略線図であり、(A)鉛直加速度及び(C)方位角の略線図である。
 図26は、(B)水平加速度における(D)極小点出現頻度(上着右ポケット)を示す略線図であり、(A)鉛直加速度及び(C)方位角の略線図である。
 図27は、(B)水平加速度における(D)極小点出現頻度(尻ポケット)を示す略線図であり、(A)鉛直加速度及び(C)方位角の略線図である。
 図28は、(B)水平加速度における(D)極小点出現頻度(手ポケット)を示す略線図であり、(A)鉛直加速度及び(C)方位角の略線図である。
 図29は、(B)水平加速度における(D)極小点出現頻度(鞄ポケット)を示す略線図であり、(A)鉛直加速度及び(C)方位角の略線図である。
 図30は、(A)通常加算時及び(B)近接位相除外処理後の極小点の出現頻度の変化を示す略線図である。
 図31は、(A)鉛直加速度、(B)水平加速度、(C)方位角の(D)加減速の判別結果(胸ポケット)を示す略線図である。
 図32は、(A)鉛直加速度、(B)水平加速度、(C)方位角の(D)加減速の判別結果(胸ポケット)を示す略線図である。
 図33は、(A)鉛直加速度、(B)水平加速度、(C)方位角の(D)加減速の判別結果(上着右ポケット)を示す略線図である。
 図34は、(A)鉛直加速度、(B)水平加速度、(C)方位角の(D)加減速の判別結果(上着右ポケット)を示す略線図である。
 図35は、(A)鉛直加速度、(B)水平加速度、(C)方位角の(D)加減速の判別結果(尻ポケット)を示す略線図である。
 図36は、(A)鉛直加速度、(B)水平加速度、(C)方位角の(D)加減速の判別結果(尻ポケット)を示す略線図である。
 図37は、進行方位算出処理手順を示すフローチャートである。
 図38は、歩行周期算出サブルーチンを示すフローチャートである。
 図39は、加減速切替位相学習サブルーチンを示すフローチャートである。
 図40は、歩行時における進行方位の算出結果(胸ポケット)を示す略線図である。
 図41は、歩行時における進行方位の算出結果(上着右ポケット)を示す略線図である。
 図42は、歩行時における進行方位の算出結果(尻ポケット)を示す略線図である。
 以下、発明を実施するための形態(以下実施の形態とする)について、図面を用いて説明する。なお、説明は以下の順序で行う。
 1.実施の形態
 2.他の実施の形態
<1.実施の形態>
[1−1.スマートフォンの構成]
 図1に示すように、スマートフォン1は、本体部2の操作部3を介して使用者の操作指示を受け付けてナビゲーションプログラム等の各種アプリケーションを実行し、その実行結果に応じた表示画面を表示部4に表示するようになされている。
 ここで表示部4の短手方向及び長手方向、並びに表示画面と直交する方向をそれぞれx方向及びy方向並びにz方向と定義すると、本体部2は、x、y及びzの各方向にそれぞれ約63[mm]、約125[mm]及び約11[mm]となっており、全体として薄板状に構成されている。すなわちスマートフォン1は、使用者が片手で把持し、或いは上着やズボン等のポケットに収納し得るように構成されている。
 図2に示すように、スマートフォン1は、制御部10を中心として各部が接続された構成となっており、当該制御部10によって全体を統括制御するようになされている。
 制御部10のCPU(Central Processing Unit)11は、バス15を介してROM(Read Only Memory)12や不揮発性メモリ14等から基本プログラムや各種アプリケーションプログラム等を読み出し、RAM(Random Access Memory)13を作業領域として用いながら実行する。またCPU11は、バス15を介して供給される各種データや指示等を取得し、取得したデータや指示に基づいた処理を実行する。
 データベース(DB)16は、例えばフラッシュメモリ等でなり、電話帳データ、楽曲データ、画像データ及び地図データ等の各種データがそれぞれ所定のデータベース形式で格納されている。
 操作部3は、図1に示したように表示部4の表示パネルの表面に一体化されたタッチパネル3Aや各種の操作ボタン3B等により構成されており、使用者の操作指示を受け付けて操作信号をCPU11へ供給する。
 表示部4は、例えば液晶パネルでなり、バス15を介して供給される表示データに基づいて表示画面を生成して表示する。
 音声処理部21は、マイクロホン5により集音した音声をディジタル形式の音声データに変換してバス15へ供給すると共に、当該バス15を介して取得した音声データを音声信号に変換してスピーカ6へ供給することにより、音声として出力する。
 通信処理部22は、アンテナ7を介して基地局(図示せず)との間で無線接続し、バス15を介して供給される各種データを基地局へ送信すると共に、基地局から送信されてきた各種データを受信してバス15へ供給する。
 外部インタフェース(I/F)23は、例えばmicroUSB(Universal Serial Bus)端子でなり、USBケーブル(図示せず)を介して接続されるコンピュータ装置(図示せず)等との間でデータを授受するようになされている。
 GPS回路24は、GPS衛星(図示せず)から送信されるGPS信号をGPSアンテナ25により受信し、所定の復調処理や復号化処理等を施して得られた測位データをバス15へ供給する。
 加速度センサ27は、x、y及びz方向の3軸方向について加速度をそれぞれ検出して加速度信号を生成する。A/D(Analog/Digital)変換回路27Aは、この加速度信号を50[Hz]のサンプリングレートでサンプリングすることによりディジタル形式でなる3次元の加速度A1に変換し、これをバス15へ供給する。この加速度A1は、スマートフォン1が使用者により携帯されている場合には、当該使用者の行動に応じて生じた加速度を表す値となる。
 地磁気センサ28は、地磁気により形成される磁界の方向を検出し、x、y及びz方向の3軸方向を成分とする地磁気信号を生成する。A/D変換回路28Aは、この地磁気信号を50[Hz]のサンプリングレートでサンプリングすることによりディジタル形式でなる3次元の地磁気値Mに変換し、これをバス15へ供給する。
 かかる構成により制御部10は、例えば使用者からCPU11を介して通話機能の実行指示を受け付けると、所定の通話プログラムを実行すると共に、通信処理部22により基地局と無線接続し、マイクロホン5により集音した音声をデータ化して相手方へ送信すると共に、相手方から送信されてきた音声データをスピーカ6から出力させる。
 また制御部10は、使用者から操作部3を介して楽曲再生機能の実行指示を受け付けると、所定の楽曲再生プログラムを実行すると共に、データベース16から圧縮状態の楽曲データを読み出し、音声処理部21により所定の復号化処理等を施して、その音声をスピーカ5から出力させる。
 さらに制御部10は、各アプリケーションプログラムについて、例えば使用者から操作部3を介して実行指示を受け付け、或いは自動的に実行するよう設定されると、不揮発性メモリ14から当該アプリケーションプログラムを読み出して実行する。そして制御部10は、その実行内容に応じて演算処理を行い、通信処理を行い、所定の表示画面を表示部4に表示し、或いは所定の音声をスピーカ6から出力する。
 このようにスマートフォン1は、使用者の操作指示に従って種々のプログラムを実行することにより、通話機能及び楽曲再生機能並びにアプリケーションプログラムによる種々の機能を実現するようになされている。
[1−2.ナビゲーション処理]
 ところで制御部10は、例えば使用者から操作部3を介してナビゲーション機能の実行指示を受け付けると、不揮発性メモリ14からナビゲーションプログラムを読み出して実行する。
 このナビゲーション機能では、使用者の操作指示により動作モードを切り換え得るようになされており、動作モードの一つとして使用者が徒歩で移動する場合を想定した歩行モードが用意されている。
 制御部10は、この歩行モードにおいて、屋内や高層ビルの近傍などGPS信号の受信状況が悪い場合を想定し、使用者の歩行動作により生じる加速度や地磁気の値を用いて、歩行速度や進行方位を算出する現在位置算出処理を実行するようになされている。
 このとき制御部10は、ナビゲーションプログラムに従い、図3に示すように歩数算出部31、速度算出部32、進行方位算出部33、方位フィルタ34及び位置フィルタ35の各機能ブロックを実現するようになされている。
 制御部10は、加速度センサ27から得られる加速度A1を歩数算出部31及び進行方位算出部33へ供給すると共に、地磁気センサ28から得られる地磁気値Mを進行方位算出部33へ供給する。
 また制御部10は、GPS回路24から得られる測位データのうち位置を表すGPS位置データGPを進行方位算出部33及び位置フィルタ35へ、速度を表すGPS速度データGVを速度算出部32へ、方位を表すGPS方位データGCを方位フィルタ34へそれぞれ供給する。
 歩数算出部31は、加速度A1を基に、使用者の1歩毎の周期を表す歩行ピッチ及びその歩数を算出し、これらを歩数データS1として速度算出部32へ供給する。
 速度算出部32は、所定の学習処理で得た歩幅に歩数データS1の歩行ピッチを乗じることにより歩行速度を算出し、この歩行速度とGPS速度データGVとを基に速度データV1を算出して、これを位置フィルタ35及び後段の処理ブロック(図示せず)へ供給する。
 進行方位算出部33は、歩行時の加速度A1に現れる加速度の方向と地磁気値Mが示す磁北の方向とを基に進行方位を算出し、GPS位置データGPを用いてこれを補正することにより進行方位データC1を算出して(詳しくは後述する)、これを方位フィルタ34へ供給する。
 方位フィルタ34は、いずれも方位を表すGPS方位データGC及び進行方位データC1について現在の速度やGPS信号の受信状況等を基に重み付けを行うことにより、現在の進行方位を表す進行方位データC2を生成し、これを位置フィルタ35及び後段の処理ブロック(図示せず)へ供給する。
 位置フィルタ35は、速度データV1、進行方位データC2及びGPS位置データGPを基に、現在の速度及びGPS信号の受信状況等を基に重み付けを行って利用することにより、位置データP1を生成し、これを後段の処理ブロック(図示せず)へ供給する。
 そして制御部10は、図示しない後段の処理ブロックにおいて、速度データV1、位置データP1及び進行方位データC2(以下これらをまとめて現在位置データD1と呼ぶ)に応じた範囲の地図データをデータベース16(図1)から読み出し、所定の現在位置マークや指定された目的地への経路と共にナビゲーション画面として表示部4に表示する。
 このようにスマートフォン1は、現在位置算出処理により加速度A1及び地磁気値M等を基に速度データV1及び進行方位データC1等を算出し、GPS信号の受信状況に応じた重み付けを行うことにより現在位置データD1を生成するようになされている。
[1−3.進行方位の算出]
 ところでスマートフォン1の制御部10は、ナビゲーションプログラムの実行中に、使用者から歩行モードに切り換える指示を受けると、不揮発性メモリ14から進行方位算出プログラムを読み出して実行する。
 このとき制御部10は、図4に示すような複数の機能ブロックを進行方位算出部33内に実現して、進行方位を算出するようになされている。
 以下では、進行方位算出部33により、加速度A1等を基に進行方位を表す進行方位データC1を生成するまでの各機能ブロックによる詳細な演算処理について、その原理と共に詳細に説明する。
[1−3−1.使用者の歩行と進行方位との関係]
 一般に歩行者が所望の進行方向へ移動する場合、この進行方向を向いている歩行者が右足と左足とを交互に前へ踏み出すことにより、1歩ずつ進行方向へ移動していく。
 ここで歩行者の詳細な進行方向について検討してみると、図5に模式的な平面図を示すように、歩行者が右足を踏み出す時の進行方向ベクトルVC1と左足を踏み出す時の進行方向ベクトルVC2とが、全体的な進行方向に対し互いに反対方向へ傾いている。
 この場合、連続する2歩分の進行方向ベクトルを合成すれば、全体的な進行方向とほぼ同じ方向を向く合成ベクトルを得られると考えられる。
 またスマートフォン1は、使用者が歩行する際、着用している被服のポケットに収容され、或いは使用者の手に把持される等して携帯されることが想定される。このためスマートフォン1は、加速度センサ27により、使用者の歩行に伴いその体に作用する加速度を加速度A1として検出することができる。このとき検出された加速度A1が示す方向は、歩行する使用者の進行方向と深い関連性があると考えられる。
 さらにスマートフォン1は、地磁気センサ28による地磁気値Mを利用することにより、加速度センサ27により検出した加速度の方向を、磁北を基準とした進行方位として表すことができる。
 そこでスマートフォン1では、連続する2歩の歩行期間に得られる加速度A1及び地磁気値Mを基に、使用者の進行方位を算出するものとした。
[1−3−2.座標系の変換及び鉛直方向の検出]
 ところでスマートフォン1は、使用者に携帯される場合、図6に示すように、例えば上着の胸ポケットW1、上着の右ポケットW2やズボンの尻ポケットW3のように被服の各ポケットに収納され、或いは使用者の手W4に把持され、さらには使用者が手に持つ鞄W5に収納される場合がある。
 このときスマートフォン1は、様々な向きでポケット等に収納され、或いは使用者の手に把持される(以下、このときスマートフォン1が携帯されている箇所を携帯箇所と呼ぶ)。すなわちスマートフォン1は、図7(A)に示すように、任意の角度で使用者に携帯されることになる。
 このため、スマートフォン1の本体部2について規定したx軸、y軸及びz軸により表される3次元の座標系(以下これを検出座標系と呼ぶ)は、地上における鉛直方向を1つの軸とする座標系(以下これを地上座標系と呼ぶ)とは異なる。
 ところで加速度センサ27により検出される加速度A1には、歩行に伴い使用者の体が動くことに起因した成分(以下これを歩行加速度と呼ぶ)と、重力加速度の成分(以下これを重力加速度Gと呼ぶ)とが含まれる。
 歩行加速度は、使用者が左右の足を交互に前へ出し、着地し、後ろへ蹴り出す動作(以下これを歩行動作と呼ぶ)に伴い、進行方向である前方向及び後方向に加えて、進行方向に対する左右方向や上下方向にも現れる。
 ここで使用者がほぼ一定の速度で一定の進行方向へ歩行している場合、ある程度の期間全体で考えると、この使用者は定速運動していると見なすことができる。このため、歩行加速度の前後方向成分、左右方向成分、及び上下方向成分をそれぞれある程度の期間に渡って積算すると、いずれもほぼ0になる。これに対し重力加速度は、図中に重力ベクトルVGとして示すように、常に鉛直下向きに作用する。
 すなわち進行方位算出部33は、加速度A1の積算値を基に重力加速度の方向を算出すれば、図7(B)に示すように、この方向を地上座標系のz軸方向とすることができる。
 また地磁気センサ28により検出される地磁気値Mは、磁北の方向を示す地磁気ベクトルVM(図7(A))を、検出座標系による3次元の値として生成する。この地磁気値Mが示す磁北の方向を水平面、すなわち地上座標系のxy平面に投影した方向(以下これを投影磁北方向と呼ぶ)は、水平面における北(磁北)方向を指すことになる。
 ここで、例えば図7(C)に示すように、投影磁北方向を地上座標系のy軸方向と定義すると、このy軸方向及びこれと直交するx軸方向は、それぞれ北方向及び東方向を指すことになり、検出座標系と地上座標系との関係が定まることになる。
 そこで進行方位算出部33は、まず鉛直方向検出部41(図4)によってある程度の期間(例えば2秒間)に渡って加速度A1の値を積算することにより、歩行加速度の成分を相殺して重力加速度G(Gx,Gy,Gz)を生成し、これを変換行列生成部42へ供給する。
 変換行列生成部42は、次の(1)式、(2)式及び(3)式に従った演算を行うことにより、検出座標系から見た地上座標系のx軸方向、y軸方向及びz軸方向の単位ベクトルex、ey及びezをそれぞれ算出する。
Figure JPOXMLDOC01-appb-I000001
 ここで変換行列生成部42は、次の(4)式に示すように、地上座標系の単位ベクトル(ex,ey,ez)をまとめて3次元の単位ベクトルUとする。
Figure JPOXMLDOC01-appb-I000002
 この単位ベクトルUが表す行列は、検出座標系から地上座標系への変換行列を表すことになる。そこで変換行列生成部42は、この変換行列Uを座標変換部43へ供給する。
 座標変換部43は、次の(5)式に従った演算処理を行うことにより、検出座標系の加速度A1を地上座標系の加速度A2(A2x,A2y,A2z)へ座標変換し、これをBPF(Band Pass Filter:帯域通過フィルタ)44へ供給する。
 A2=UA1                   …(5)
 このようにしてスマートフォン1の制御部10における進行方位算出部33は、加速度A1の積算値から得られる重力加速度の方向と、地磁気値Mが示す磁北の方向とを基に、検出座標系から地上座標系への変換行列Uを算出した上で、検出座標系の加速度A1を地上座標系の加速度A2に変換するようになされている。
[1−3−3.周波数帯域の抽出]
 次に、加速度A2の周波数特性について検討する。一般に、人が徒歩で移動するときの歩行速度は、1秒間に約2歩であることが知られている。このため、検出座標系の加速度A1には、約2[Hz]を中心とした帯域に歩行に起因した成分が現れると考えられる。
 一方、加速度A1には、スマートフォン1に外部から加えられる振動のように、歩行以外の様々な要因による成分、すなわちノイズ成分が含まれると考えられる。このようなノイズ成分は、一般的に、比較的高い周波数であると考えられる。
 さらに加速度A1には、重力加速度Gに起因した成分や加速度センサ27のオフセット成分も含まれる。このうち重力加速度Gに起因した成分は直流成分となり、オフセット成分は温度変化等に伴い極めてゆっくり(例えば数秒から数分のオーダーで)変化する低域成分となる。
 またこのような検出座標系の加速度A1についての周波数特性は、座標変換により変化するものではないため、地上座標系に変換した加速度A2についてもそのまま当てはまる。
 そこで本実施の形態では、加速度A2について、BPF(帯域通過フィルタ)44により、主に歩行による成分として、2[Hz]を含む帯域成分を抽出するものとした。
 具体的に進行方位算出部33のBPF44は、加速度A2について、約1~10[Hz]を抽出する帯域抽出処理を施すことにより加速度A3(A3x,A3y,A3z)を生成し、これを歩行周期算出部45及び加減速区間切替位相学習部46へ供給する。
 この加速度A3は、各種ノイズ成分、重力加速度Gの成分やオフセット成分が大幅に低減され、主に使用者の歩行動作に起因した成分を表すものとなる。
 またBPF44は、加速度A3のうち水平成分(A3x,A3y)を進行方位算出部49へ供給する。
 ここで、帯域抽出処理前における加速度A2の水平成分と帯域抽出処理後における加速度A3の水平成分とについて、約10秒分をそれぞれxy平面上にプロットしたところ、図8(A)及び(B)に示すような分布特性が得られた。この図8(A)及び(B)から、高周波成分が低減されていることがわかる。
 以下では、次の(6)式により算出される水平方向の加速度(A3x,A3y)の大きさを、水平加速度Ahと呼ぶ。
 Ah=A3x+A3y              …(6)
 さらにBPF44は、加速度A3のうち鉛直成分(A3z)を加減速区間推定部47へ供給する。以下では、加速度A3のうち鉛直成分を特に鉛直加速度Avとも呼ぶ。
 このように進行方位算出部33のBPF44は、加速度A2の水平成分のうち1~10[Hz]の周波数帯域を抽出することにより、主に歩行動作に起因した成分でなる加速度A3を生成するようになされている。
[1−3−4.水平加速度の加速区間及び減速区間と進行方向との関係]
 ここでは、まずスマートフォン1の使用者が歩行動作をする際における体の動きと、そのときに発生する加速度との関係について説明する。
 図9は、使用者が歩行により2歩進む期間(以下これを歩行周期PWと呼ぶ)における体勢の様子を、左から右へ向かう時間軸上の時点t0~t4についてそれぞれ模式的に表したものである。
 図9における使用者は、時点t0において右足を前に踏み出した状態であり、この状態から上体を前へ移動させながら左足を後ろから持ち上げて前方へ持っていき、時点t1において左足を右足よりも前方へ出そうとしている。
 続いて使用者は、時点t1の状態からさらに状態を前へ移動させながら左足を前方へ蹴り出し、時点t2において左足を接地させる。このとき使用者は、時点t0の状態から1歩前へ進んだことになる。
 その後使用者は、時点t2からt4にかけて、時点t0から時点t2の場合と左右反対に、すなわち左足を接地させたまま右足を後ろから前へ持っていくことにより、もう1歩前へ進む。
 また図9には、時点t0~t4と対応付けて、使用者の体に作用する上下方向(すなわち鉛直方向)への鉛直加速度Avの波形と、鉛直速度Vvの波形を示す。さらに図9には、各時点の間における体が上下に動く方向を表す上下方向の矢印VU及びVDと、前後方向に関する加速又は減速を表す左右方向の矢印HA及びHRと、鉛直加速度Avの増加又は減少の傾向を表す上下方向の矢印TU及びTDとを併せて示している。
 使用者は、左右の足を前後に開いて両方とも着地した状態となる時点t0、t2及びt4において、体(主に上体)の高さが最も低くなる。一方使用者は、左右いずれかの足が接地しており、且つその接地している足から頭までほぼ一直線上に延びた状態となる時点t1及びt3において、体の高さが最も高くなる。
 すなわち使用者は、上下方向への矢印VU及びVDにより示したように、2歩進む歩行周期PWにおいて、体が上下方向に2往復するように動いていることが分かる。
 ここで鉛直加速度Avに着目すると、時点t0において極大値となり、その後時点t1、t2、t3及びt4と進むにつれて、極小値、極大値、極小値及び極大値となっており、歩行周期PWの間に2回の極大値及び2回の極小値が出現することが分かる。
 因みに使用者の体の鉛直方向への速度である鉛直速度Vvは、鉛直加速度Avとの関係から、時点t0からt1の間及び時点t2からt3の間において、0から増加した後減少して再び0に戻り、時点t1からt2の間及び時点t3からt4の間において、0から減少した後増加して再び0に戻る。
 次に、使用者の体の水平方向への速度(以下これを水平速度Vhと呼ぶ)の変化、すなわち進行方向への加速及び減速について着目する。
 歩行中の使用者の体は、着地している足を後ろに動かすと共に上体を前へ押し出す間に加速する一方、前に蹴り出した足が着地してから上体をその足の位置付近まで前進させる間に減速している。
 すなわち歩行周期PW内に、矢印HRとして示したように進行方向に関して減速する区間(以下これを減速区間SRと呼ぶ)があり、それ以外の区間は矢印HAとして示したように進行方向に関して加速する区間(以下これを加速区間SAと呼ぶ)がある。
 減速区間SRでは、進行方向に対し減速していることから、使用者の体には、水平加速度Ahが進行方向へ向けて作用すると考えられる。一方、加速区間SAでは、進行方向に対し加速していることから、使用者の体には、水平加速度Ahが進行方向と反対の方向へ向けて作用すると考えられる。
 また、人が歩行するときの連続する2歩を1周期と見なした場合、体の各部は周期的な動作を繰り返すことになる。すなわち、使用者によるスマートフォン1の携帯箇所(図6)がいずれであっても、加速度センサ27により検出される加速度の値は周期性を持つ。
 ここで、使用者がスマートフォン1を携帯して実際に歩行したときに得られた水平加速度Ahをxy座標平面上にプロットしたところ、図10~図12のような分布特性が得られた。
 図10、図11及び図12は、それぞれスマートフォン1の携帯箇所(図6)を胸ポケットW1、上着の右ポケットW2及びズボンの尻ポケットW3として、ほぼ北方向へ向かって歩行したときの分布特性である。また図10~図12は、使用者がある程度の時間に渡って歩行したときに得られた水平加速度Ahのうち約4秒間分を切り出し、時間的に連続する点同士を線により結んでいる。因みに検出周期は50[Hz]であるため、連続するプロット同士の間隔は0.02[s]に相当する。
 図10~図12では、歩行者の進行方位がほぼ北であること、すなわちy軸の正方向であることが判っているため、主にyの値が正となる第1象限及び第2象限に分布しているプロットが減速区間SRに相当し、主にyの値が負となる第3象限及び第4象限に分布しているプロットが加速区間SAに相当すると考えられる。
 さらに時間的な変化、すなわちプロット同士を結ぶ線の様子も考慮すると、図10~12では、破線で囲った部分が減速区間SRに相当し、一点鎖線で囲った部分が加速区間SAに相当すると考えられる。
 ここで図10~図12における水平加速度Ahの分布と使用者の進行方位との関係から、使用者の進行方位が未知であっても、xy平面座標において水平加速度Ahのうち減速区間SRの部分及び加速区間SAの部分それぞれの分布を区別することができれば、使用者の進行方位を類推することができると考えられる。
 ところで図11では、減速区間SR及び加速区間SAのいずれもが比較的わかりやすく分離している。しかしながら、図10では加速区間SAに相当する部分が顕著には表れておらず、図12では減速区間SRに相当する部分が顕著には表れていない。また図12から、人が歩行する際には、腰が回転するように動いており、加速度にその影響が現れ得ることも分かる。
 すなわち水平加速度Ahは、使用者によるスマートフォン1の携帯箇所によって、その特性が大きく異なっている。
 このため、水平加速度Ahの分布から使用者の進行方位を算出するには、得られた各加速度が加速区間SA又は減速区間SRのいずれに属しているのかを判別すること、すなわち水平加速度Ahを減速区間SRと加速区間SAとに正しく区分することが重要といえる。
 そこで以下では、最終的に進行方位を得るために、水平加速度Ahを減速区間SRと加速区間SAとに区分することについて検討する。
[1−3−5.歩行周期の算出]
 ここでは、水平加速度Ahを減速区間SRと加速区間SAとに区分するための事前準備として、加速度A3から使用者の歩行周期PWを算出することを検討する。
 使用者がスマートフォン1の携帯箇所(図6)を胸ポケットW1、上着の右ポケットW2及びズボンの尻ポケットW3として実際に歩行したところ、図13、図14及び図15の各特性曲線が得られた。
 図13(A)~図15(A)はそれぞれ鉛直加速度Avを表し、図13(B)~図15(B)はそれぞれ水平加速度Ahを表す。また図13(C)~図15(C)は、水平加速度Ahが示す方位を、北方向を「0」とする極座標で表した場合の方位角Cm(図7(C))を表す。
 因みに図13~図15における横軸は、加速度センサ27に接続されたA/D変換回路27Aによるサンプル数を表しており、そのサンプリングレートが50[Hz]であるため、1サンプルが0.02[s]に相当する。
 図9と図13~図15とを比較すると、実際の鉛直加速度Avの波形は、必ずしも模式化した波形(図9)のような正弦波形とはならないことが判る。また実際の鉛直加速度Avの波形は、スマートフォン1の携帯箇所により大きく異なることも判る。
 例えば携帯箇所が胸ポケットW1の場合、鉛直加速度Avの波形のうち右足による波形と左足による波形とが比較的類似している。これに対し携帯箇所が上着の右ポケットW2又はズボンの尻ポケットW3の場合、鉛直加速度Avの波形のうち右足による波形と左足による波形とが(すなわち連続する2歩分の波形が)互いに大きく異なっている。
 しかしながら鉛直加速度Avは、携帯箇所がいずれであっても、2歩に相当する歩行周期PWごとであれば比較的類似した波形が繰り返し出現している。このことは、模式化した波形(図9)において、歩行周期PWの間、すなわち使用者が歩行により2歩進む間に、鉛直加速度Avに極大値及び極小値がそれぞれ2回現れることとも符合する。
 そこで、鉛直加速度Avについて、波形が周期性を有するものの携帯箇所により大きく異なることを考慮し、閾値等を用いるのではなく、ある部分の波形と類似する波形が再度出現するまでの時間(位相差)を求めた。
 具体的には、鉛直加速度Avのうち任意の部分を関数f(t)として、次の(7)式に示す自己相関評価関数g(t)により関数f(t)の自己相関度を表すものとした。
Figure JPOXMLDOC01-appb-I000003
 この自己相関評価関数g(t)は、自己相関度が高いほど値が小さくなり、完全に一致する場合にはその値(評価値)が「0」となる。また定数Tはウィンドウサイズ、すなわち自己相関度を算出する位相差tの範囲を表す。また位相差tは、図13~図15におけるサンプル数であり、時間差に相当するものである。
 そして、位相差tを1サンプル(すなわち0.02[s])から徐々に増加させたときの自己相関評価関数g(t)の値を自己相関評価値として順次算出し、位相差tとの関係をグラフ化した。
 図16、図17、図18、図19及び図20は、携帯箇所(図6)を胸ポケットW1、上着の右ポケットW2、ズボンの尻ポケットW3、使用者の手W4及び鞄の中W5とした場合における、位相差tに対する自己相関評価値のグラフを表す。因みに図16~20では、鉛直加速度Avのうち関数f(t)として採用する部分を少しずつ変化させて得られた複数の算出結果を重ねて表示している。
 図16~20のいずれにおいても、重なった波形の殆どにおいて、位相差tが約20~24サンプルごと(約0.4~0.48[s]ごと)に、すなわち使用者の1歩に相当する時間ごとに極小値が現れている。
 また、1歩目については、携帯箇所により極小値が極めて小さくなる場合とそれほど小さくならない場合とがあるものの、2歩目については、いずれの携帯箇所においても極小値が極めて小さい値となっている。
 これは、歩行において左右の足を交互に動かすという原理上、1歩目は他方の足による波形であるため相関性がやや低くなっており、2歩目は同一の足による波形であるため相関性が高くなっていると考えられる。
 これらを踏まえると、歩行周期PWについては、算出開始タイミング等を特に定めることなく、自己相関評価関数g(t)により得られる自己相関評価値において、2回目の極小値が出現する位相差tを歩行周期PWとすれば良いと考えられる。
 ここで、図20に示した自己相関評価値のうち一の波形を取り出して図21に示す。図21では、位相差tが約20~24サンプルとなるときに極小値min1A及びmin1Bが2回出現しており、その後位相差tが約46サンプルとなる時に3回目の極小値min2が出現している。
 このため、図21のような自己相関評価値の場合、単純に2回目の極小値が出現する位相差tを採用してしまうと、本来採用したい極小値min2ではなく、1歩目に相当する極小値min1Bをとるときの位相差tを誤って採用してしまうことになる。
 このように単純に2回目の極小値が出現するときの位相差tを歩行周期PWとする場合、図22(A)に示すように、正しい2歩目に相当する値(約46~50サンプル)付近の他に、1歩目に相当する値(約24~32サンプル)を比較的高い頻度で誤検出してしまう。
 ここで、図21における各極小値と、その直前に出現する極大値との落差に着目すると、1歩目における極大値max1と極小値min1A(又はmin1B)との落差d1は、比較的小さい。一方、2歩目における極大値max2と極小値min2との落差d2は、比較的大きい。また図16及び19に示したように、携帯箇所によっては、1歩目の落差d1が2歩目の落差d2とほぼ同等の比較的大きな値となる場合もある。
 これらを踏まえて、1回目の極小値min1については次の(8)式を満たすこと、2回目の極小値min2については次の(9)式を満たすことを、それぞれの採用条件とした。
 min1≦max1×0.9             …(8)
 min2≦max2×0.5             …(9)
 ただし極大値max1及びmax2については、1歩に相当する間に複数回出現する可能性があることを踏まえて、採用しようとしている各極小値min1及びmin2の直前に出現した極大値をそれぞれ用いるものとした。
 ここで(8)式における係数「0.9」は、歩行時の鉛直加速度Avにおける他方の足との相関性がそれほど高くはない可能性があることを考慮し、極小値が比較的大きい値であっても1歩目として確実に検出するべく定めた。
 また(9)式における係数「0.5」は、歩行時の鉛直加速度Avにおける同一の足との相関性が比較的高くなることを考慮し、極小値がある程度小さくなるときを2歩目として検出するよう、すなわち他方の足である1歩目により複数の極小値が生じた場合にこれを2歩目として誤検出しないよう、(8)式の係数「0.9」よりも小さな値とした。
 これらの採用条件を適用することにより、図22(A)と対応する図22(B)に示すように、最初の約15サンプルを除いた全ての範囲で、2歩に相当する値(約46~50サンプル)を正しく歩行周期PWとすることが確認された。
 以上を踏まえて、進行方位算出部33の歩行周期算出部45(図4)は、鉛直方向検出部41Bから供給された鉛直加速度A2zのうち任意の部分を関数f(t)とし、(7)式に従って自己相関評価値を算出する。
 そして歩行周期算出部45は、(8)式及び(9)式を満たすような極小値min1及びmin2を採用し、極小値min2となるときの位相差tを歩行周期PWとする。
 このように歩行周期算出部45は、使用者の歩行に応じた周期的な波形を表す鉛直加速度A2zを基に、当該鉛直加速度A2zについての自己相関度が2回目に高まる位相差tを2歩分の歩行周期PWとして検出するようになされている。
[1−3−6.位相基準点の選定]
 次に、水平加速度Ahを基に減速区間SR及び加速区間SAを区別するための事前準備として、当該水平加速度Ahを歩行周期PWごとに区切る場合の基準とすべき位相(以下これを位相基準点PSと呼ぶ)について検討する。
 図9を再度参照すると、歩行時における減速区間SRは、鉛直加速度Avが極大値となった後に現れている。このため位相基準点PSについては、鉛直加速度Avの波形を基に定め得ると考えられる。また波形において特定しやすい位相としては、検出の容易さ等を考慮すると、ゼロクロスする位相(以下これをゼロクロス点と呼ぶ)が挙げられる。
 ここで、スマートフォン1の携帯箇所(図6)を鞄W5としたときに得られた鉛直加速度Avのうち、任意の4歩分(すなわち歩行周期PWで2周期分)の波形を図23に示す。
 本来であれば、4歩分、すなわち歩行周期PWで2周期分の間には、極大点と極小点とが4回ずつ出現し、負から正へ、又は正から負へそれぞれ変わるゼロクロス点(以下それぞれ上りゼロクロス点及び下りゼロクロス点と呼ぶ)が4箇所ずつ存在する。
 しかしながら図23には、適切な上りゼロクロス点SU及び下りゼロクロス点SD以外に、余分な上りゼロクロス点EU及び下りゼロクロス点EDが出現している。さらに、本来出現すべき下りゼロクロス点が消滅してしまった箇所(便宜上、これを消滅した下りゼロクロス点LDと呼ぶ)も存在する。
 このため位相基準点PSとしては、各歩行周期PWにおいて消滅することなく確実に出現し、且つ余分なゼロクロス点とは明確に区別し得るようなゼロクロス点を採用することが望ましい。
 ここで再度図23を参照すると、2歩の間に1回の割合で、比較的大きな極大値と比較的小さな極小値とが連続して出現する箇所、すなわち極大値と極小値との落差が比較的大きくなる箇所があることがわかる。また図13~図15を参照しても、これと同様に、少なくとも2歩の間に1回の割合で、極大値と極小値との落差が比較的大きくなる箇所がある。
 そこで鉛直加速度Avについては、歩行周期PW分の範囲に着目し、この範囲内に含まれる極大値とその直後に出現する極小値との落差が最大となるときを、歩行周期PWの基準に用いることが考えられる。
 以上を踏まえて、進行方位算出部33の歩行周期算出部45(図4)は、図24に示すように、BPF44から供給された鉛直加速度Avのうち任意の時点から歩行周期PW分の範囲を抽出する。因みに図24は、6歩分、すなわち歩行周期PWで3周期分の鉛直加速度Avを示す。
 続いて歩行周期算出部45は、この範囲内に存在する各極大値について、その直後に出現する極小値との間の落差をそれぞれ算出し、この落差が最大となるときの極大点及び極小点に挟まれた下りゼロクロス点を位相基準点PSとして採用する。
 また歩行周期算出部45は、位相基準点PSとして採用した下りゼロクロス点の次に出現する上りゼロクロス点を基準上りゼロクロス点PUとする。因みにこの基準上りゼロクロス点PUは、後の処理において利用する。
 そして歩行周期算出部45は、位相基準点PSを加減速区間切替位相学習部46へ供給すると共に、位相基準点PS及び基準上りゼロクロス点PUを加減速区間推定部47へ供給する。
 このように歩行周期算出部45は、歩行周期PW分の鉛直加速度Avにおいて、極大値とその直後に出現する極小値との間の落差が最大となるときの極大点及び極小点に挟まれた下りゼロクロス点を位相基準点PSとするようになされている。
[1−3−7.加減速切替位相の検出]
 次に、位相基準点PSを開始点とする歩行周期PWにおいて、加速区間SAと減速区間SRとが切り替わる箇所を検出することについて検討する。
 図9に示したように、歩行周期PWの間、すなわち使用者が歩行により2歩進む間には、減速区間SRが2回出現する。このことは、歩行周期PWの間に加速区間SAと減速区間SRとが4回切り替わることを意味している。
 一方、加速区間SAと減速区間SRとが切り替わるとき、原理上、水平加速度Ahは極小値をとる可能性が極めて高い。すなわち水平加速度Ahには、歩行周期PWの間に、加速区間SAと減速区間SRとの切り替わりに起因した極小点(以下これを加減速切替点CHと呼ぶ)が4回出現すると考えられる。
 そこで再び図13~図15を参酌すると、水平加速度Ahには、加減速切替点CH(図中丸印で示す)の他に、他の要因による極小点(以下これを他要因点OTと呼び、図中三角印で示す)も出現していることがわかる。
 このため、水平加速度Ahに出現する極小点を基に加速区間SA及び減速区間SRをそれぞれ検出するには、この極小点のなかから加減速切替点CHを適切に選定する必要がある。
 そこで、水平加速度Ahに極小点が出現する位相を基に、統計的手法により、加減速切替点CHに相当する位相(以下これを加減速切替位相PCと呼ぶ)を学習することを検討する。
 具体的な処理としては、水平加速度Ahを位相基準点PSごとに(すなわち歩行周期PWごとに)区切り、この位相基準点PSを開始点として位相を正規化し、この位相ごとに各歩行周期PWにおいて極小点の出現頻度(累積値)を算出するものとする。
 また、加速及び減速が切り替わる時には、方位角Cmも大きく変化すると考えられる。換言すれば、水平加速度Ahに極小点が出現するときに、方位角Cmの変化がそれほど大きくなければ、この極小点は他要因点OTである可能性が高い。この場合、この位相については統計処理から除外することが望ましい。
 そこで、1の歩行周期PW内に極小点が5回以上出現した場合には、そのときの方位変化が大きい順、具体的には方位角Cmの微分値が大きい順に4箇所の位相を累積加算の対象とすることとした。
 このような方針に従い、スマートフォン1の携帯箇所(図6)を胸ポケットW1及び上着の右ポケットW2とした場合のそれぞれについて極小点の出現頻度を集計したところ、それぞれ図25(D)及び図26(D)に示すようなグラフが得られた。
 また図25(A)~(C)及び図26(A)~(C)は、それぞれと対応する鉛直加速度Av、水平加速度Ah及び方位角Cmの波形の例を示す。水平加速度Ahについては、既知の加減速切替点CH(図中丸印で示す)及び他要因点OT(図中三角印で示す)も示している。
 この図25及び図26から、胸ポケットW1及び上着の右ポケットW2については、加減速切替点CHと対応する位相付近において極小点の出現頻度が高くピークが形成されており、それ以外の位相では極小点の出現頻度が低く殆どピークも形成されていないことが分かる。
 このことは、ピークが形成された位相のうち極小点の出現頻度が高い順に4箇所を、加減速切替位相PCとして採用し得ることを表している。
 次に、スマートフォン1の携帯箇所(図6)をズボンの尻ポケットW3、使用者の手W4及び鞄W5とした場合についても同様に極小点の出現頻度を集計したところ、それぞれ図27(D)、図28(D)及び図29(D)のようなグラフが得られた。
 また図27(A)~(C)、図28(A)~(C)及び図29(A)~(C)は、図25(A)~(C)及び図26(A)~(C)と同様、それぞれと対応する鉛直加速度Av、水平加速度Ah及び方位角Cmの波形の例を示す。
 この図27、図28及び図29から、ズボンの尻ポケットW3、使用者の手W4及び鞄W5については、加減速切替点CHと対応する位相付近において極小点の出現頻度がある程度高くピークが形成されている。しかしながら、それ以外の位相においても、極小点の出現頻度が高くピークが形成されている箇所がある。
 特にズボンの尻ポケットW3(図27)の場合、加減速切替点CH以外の位相において形成されたピークよりも他の位相において形成されたピークの方が大きく(すなわち出現頻度が高く)なっている。
 このことは、ピークが形成された位相のうち極小点の出現頻度が高い順に4箇所を採用するだけでは、加減速切替位相PCを正しく選択できないことを意味している。
 ここで、スマートフォン1の携帯箇所(図6)をズボンの尻ポケットW3として、図27で用いたデータとは異なるデータを基に、各歩行周期PWにおいて水平加速度Ahに極小点が出現した位相の累積値を改めて算出したところ、図30(A)のようなグラフが得られた。
 図30(A)では、図27(B)の場合と同様、6箇所に極小点の出現頻度が高い箇所、すなわちピークが現れている。ここでは、位相順にピークPK1、PK2、PK3、PK4、PK5及びPK6とする。
 ピークPK1、PK3、PK4及びPK6は加減速切替点CHと対応しており、残りのピークPK2及びPK5は他要因点OTと対応している。また、各ピークの大きさを比較すると、大きい順にピークPK1、PK6、PK4、PK2、PK3及びPK5となる。すなわちこの場合も、図27の場合と同様、極小点の出現頻度が高い順に4箇所を採用するだけでは、加減速切替点CHを正しく選択できない。
 ここでピークPK1及びPK2に着目すると、両者の位相間隔は約4サンプル、すなわち約0.08[s]となっている。しかしながら、スマートフォン1の使用者が実際に歩行する際に、水平方向に関して加速と減速とを僅か0.08[s]程度の短時間に切り換えることは考えにくい。
 そこで、水平加速度Ahに極小点が出現した位相の累積値を算出する際に、各歩行周期PWにおいて既に累積加算の対象として採用した位相との間隔が小さすぎる位相、例えばこの間隔が歩行周期PWの1/10以下となる位相については、その歩行周期PW内では以降の採用候補から除外することとした。以下、このような処理を近接位相除外処理と呼ぶ。
 ここで歩行周期PWの1/10という間隔は、路面の状況等により歩行者の歩幅が一時的に狭まった等の理由により加減速の切替が比較的短時間に行われた際の、加速区間SA又は減速区間SRが最小限取り得る長さを考慮して定めたものである。
 この近接位相除外処理を行いながら極小点の出現頻度を集計したところ、図30(A)と対応する図30(B)に示すように、各ピークの大きさが、大きい順にピークPK6、PK1、PK4、PK3、PK2及びPK5となった。
 すなわち図30(B)では、大きい順に4箇所のピークが現れる位相が、全て加減速切替点CHとなった。このことは、水平加速度Ahに出現する極小点について近接位相除外処理を行いながら方位変化の大きな順に4箇所の出現頻度を集計すれば、形成されるピークのうち大きい順に4箇所の位相をそのまま加減速切替点CHとして採用し得ることを表している。
 これらを踏まえて、進行方位算出部33の加減速区間切替位相学習部46(図4)は、鉛直方向検出部41Bから供給された加速度A3から(6)式により水平加速度Ahを算出し、歩行周期PW毎の極小点の出現頻度を累積する。
 このとき加減速区間切替位相学習部46は、各歩行周期PW内に出現する極小点のうち方位角Cmの微分値が大きいものから順に4箇所を累積加算の対象とするが、既に累積加算の対象として採用した位相からの間隔が歩行周期PWの1/10以下の極小点については、その歩行周期PWにおける累積加算の対象から除外する。
 そして加減速区間切替位相学習部46は、極小点の出現頻度の集計結果に現れる複数のピークのうち、大きいものから順に4箇所の位相を加減速切替位相PCとして採用し、これを加減速区間推定部47へ供給する。
 このように加減速区間切替位相学習部46は、近接位相除外処理を行いながら水平加速度Ahの極小値の出現頻度を集計し、そのピークが大きい順に4箇所の位相を加減速切替位相PCとして検出するようになされている。
[1−3−8.加減速区間の推定]
 次に、歩行周期PW内で4箇所の加減速切替位相PCにより区切られた各区間が、それぞれ加速区間SA又は減速区間SRのいずれであるかを推定する処理(以下これを加減速区間推定処理と呼ぶ)について検討する。
 図13~図15及び図25~図29の各波形を再度参照すると、鉛直加速度Avの波形が上に凸である期間中に、極大点が2回出現する場合が多いことがわかる。また、その1回目の極大点の出現後に減速区間SRが開始される場合が多いこともわかる。
 しかしながら、鉛直加速度Avの波形が上に凸であるとき、その形状が乱れることも多いため、1回目の極大点を確実に検出することは難しいと考えられる。
 ここで、鉛直加速度Avの波形が上に凸である期間と減速区間SRとの関係に着目する。この期間中に加減速切替位相PCが2回含まれるときは、これらの加減速切替位相PCにより挟まれた区間を減速区間SRとすれば良い。また、この期間中に加減速切替位相PCが1回含まれるときは、この加減速切替位相PCの直後の区間を減速区間SRとすれば良い。
 これらをまとめると、位相基準点PSから始まる歩行周期PW内の鉛直加速度Avにおいて最初に出現する上りゼロクロス点、すなわち基準上りゼロクロス点PU(図24)の後に最初に出現する加減速切替位相PCを、減速区間SRの開始点とすれば良いことになる。
 その後の2歩分については、加減速切替位相PCが出現する度に減速区間SRと加速区間SAとを交互に切り換えれば良い。
 これらを踏まえて、進行方位算出部33の加減速区間推定部47(図4)は、まずBPF44から鉛直加速度Avの供給を受けると共に、歩行周期算出部45から位相基準点PS及び基準上りゼロクロス点PUの供給を受け、さらに加減速区間切替位相学習部46から加減速切替位相PCの供給を受ける。
 そして加減速区間推定部47は、位相基準点PSを開始点とする歩行周期PWにおいて、基準上りゼロクロス点PUの後に最初に出現する加減速切替位相PCからその次に出現する加減速切替位相PCまでの区間を減速区間SRとする。
 続いて加減速区間推定部47は、それ以降の加減速切替位相PCごとに区切られる各区間を、交互に加速区間SA又は減速区間SRとして順次推定していく。
 さらに加減速区間推定部47は、現時点が加速区間SA又は減速区間SRのいずれに属するかを表す加減速情報IARを生成し、これを進行方位算出部49へ供給する。
 ここで、加減速区間推定部47により加減速情報IARを推定した結果の一例を、鉛直加速度Av、水平加速度Ah及び方位角Cmの各波形と共に図31~図36に示す。
 図31及び図32はスマートフォン1の携帯箇所(図6)を胸ポケットW1とした場合、図33及び図34は上着の右ポケットW2とした場合、図35及び図36は尻ポケットW3とした場合の、それぞれ歩き始め及びその続きの波形を表す。
 また図31(D)~図36(D)に示す加減速情報IARの波形は、ハイレベルが減速区間SRであることを表し、ローレベルが加速区間SAであることを表している。
 図31~図36から、スマートフォン1の携帯箇所がいずれであっても、おおむね歩き始めから十数歩進行した時点TS以降において、減速区間SRと加速区間SAとを良好に推定できていることが分かる。
 すなわち加減速区間推定部47は、極小点の出現頻度を十分に蓄積し学習処理がある程度進んだ時点TS以降においては、加減速区間切替位相学習部46による加減速切替位相PCの検出精度が高まることにより、減速区間SRと加速区間SAとを精度良く安定的に推定できている。
 このように加減速区間推定部47は、加減速区間推定処理として、基準上りゼロクロス点PUの後に最初に出現する加減速切替位相PCを減速区間SRの開始点とし、以降の加減速切替位相PCごとに区切られる各区間を交互に加速区間SA又は減速区間SRとして順次推定するようになされている。
[1−3−9.進行方位の算出]
 最後に、水平方向の加速度(A3x,A3y)と加減速情報IAR(すなわち加速区間SA又は減速区間SRの推定結果)とを基に、最終的な使用者の進行方位を算出する処理について説明する。
 上述したように、スマートフォン1を携帯する使用者が前向きに歩行する場合、このスマートフォン1に対し、減速時には加速度が前向きに作用し、加速時には加速度が後ろ向きに作用する。すなわち減速区間SRでは、加速度の作用する方向が使用者の進行方向を表し、加速区間SAでは、加速度の作用する方向と反対の方向が使用者の進行方向を表す。
 また地上座標系の加速度A3は、地磁気値Mにより表される磁北の方向をy軸方向としているが、一般に地磁気が示す磁北は、地球の地軸が示す真北との間に偏角と呼ばれる誤差がある。この偏角は、緯度及び経度により異なる値となることが知られている。
 このため、地上座標系で表される方位、すなわち磁北を基準とした方位については、現在地の緯度及び経度を基に得られる偏角に応じて補正することにより、真北を基準とした方位に変換することが可能となる。
 ところで加速度A3は、BPF44により歩行に起因した帯域成分が抽出されているものの、歩行以外の要因により発生した加速度もある程度は含まれていると考えられる。
 このため加速度A3が表す方位は、当該加速度A3の大きさが比較的大きい場合には、歩行に起因した加速度の相対的な割合が高いため、使用者の進行方位又はその反対の方位を表す精度が高いと考えられる。
 しかしながら加速度A3が表す方位は、当該加速度A3の大きさが比較的小さい場合には、歩行以外の要因により発生する加速度の相対的な割合が高まることから、使用者の進行方位又はその反対の方位を表す精度が低下すると考えられる。
 そこで得られた進行方位については、平滑化処理として、加速度の値が大きいほど比重を高めること、具体的には加速度A3の大きさに応じた係数を乗じて加算平均をとることにより、歩行以外の要因による加速度の影響を低減することができ、その精度を高め得ると考えられる。
 以上を踏まえて進行方位算出部33は、まず偏角取得部48により、GPS回路24から緯度及び経度を表すGPS緯度経度データGLの供給を受け、これを基に現在位置の偏角を取得して偏角データDAを生成し、これを進行方位算出部49へ供給する。
 進行方位算出部49は、加減速区間推定部47から供給される加減速情報IARを基に、現時点が加速区間SA又は減速区間SRのいずれに属するかを識別する。
 そして進行方位算出部49は、BPF44から供給されろ水平方向の加速度(A3x,A3y)が示す方位を、現時点が減速区間SRに属していればそのまま進行方位とし、現時点が加速区間SAに属していればその反対方向を進行方位とする。
 さらに進行方位算出部49は、偏角データDAを基に進行方位を補正することにより、進行方位を表す進行方位データC0を生成し、これを進行方位平滑化部50へ供給する。
 また進行方位算出部49は、水平方向の加速度(A3x,A3y)の大きさを表す水平加速度値Ahsを算出し、これも進行方位平滑化部50へ供給する。
 進行方位平滑化部50は、平滑化処理として、進行方位データC0に対し水平加速度値Ahsの大きさに応じた係数を乗じた上で、ある程度の期間(例えば1秒間)に渡って加算平均を算出することにより進行方位データC1を生成し、これを方位フィルタ34(図3)へ供給する。
 このように進行方位算出部49は、加減速情報IARを基に現時点が加速区間SA又は減速区間SRのいずれに属するかを識別し、偏角に応じた補正処理を行った上で、進行方位を表す進行方位データC0を生成するようになされている。
 また進行方位平滑化部50は、進行方位データC0が表す方位を加速度A3の大きさに応じた比重で平滑化処理することにより、精度を高めた進行方位データC1を生成するようになされている。
 このようにして進行方位算出部33は、加速度A1及び地磁気値Mを基に、歩行する使用者の進行方位を表す進行方位データC1を生成することができる。
[1−4.処理手順]
 次に、進行方位算出部33(図3、図4)により進行方位を算出する際に行う一連の処理手順について、図37、図38及び図39のフローチャートに分けてそれぞれ説明する。
[1−4−1.進行方位算出処理手順]
 スマートフォン1の制御部10(図1)は、不揮発性メモリ14から進行方位算出プログラムを読み出して実行することにより進行方位算出処理手順RT1(図37)を開始し、ステップSP1へ移る。
 ステップSP1において制御部10は、鉛直方向検出部41(図4)により加速度A1の値を2秒間に渡って積算することにより重力加速度G(Gx,Gy,Gz)を生成し、次のステップSP2へ移る。
 ステップSP2において制御部10は、変換行列生成部42(図4)により(4)式に従って検出座標系から見た地上座標系の単位ベクトルU(ex,ey,ez)算出し、次のステップSP43へ移る。
 ステップSP3において制御部10は、座標変換部43(図4)により(5)式に従って検出座標系の加速度A1を地上座標系の加速度A2(A2x,A2y,A2z)に座標変換し、次のステップSP4へ移る。
 ステップSP4において制御部10は、BPF44(図4)により、加速度A2のうち約1~10[Hz]の帯域成分を抽出することにより加速度A3(A3x,A3y,A3z)を生成し、次のステップSP5へ移る。
 ステップSP5において制御部10は、歩行周期算出部45(図4)により歩行周期算出サブルーチンSRT1(詳しくは後述する)に従った処理手順で歩行周期PWを算出し、次のステップSP6へ移る。
 ステップSP6において制御部10は、引き続き歩行周期算出部45により、鉛直加速度Avのうち任意の時点から歩行周期PW分の範囲において、落差が最大となる極大点及び極小点に挟まれた下りゼロクロス点を位相基準点PSとする。さらに制御部10は、その次に出現する上りゼロクロス点を基準上りゼロクロス点PUとして、次のステップSP7へ移る。
 ステップSP7において制御部10は、加減速区間切替位相学習部46により、加減速切替位相学習サブルーチンSRT2(詳しくは後述する)に従った処理手順で近接位相除外処理を行いながら加減速切替位相PCを選定し、次のステップSP8へ移る。
 ステップSP8において制御部10は、加減速区間推定部47(図4)により、位相基準点PSを開始点とする歩行周期PW内で、基準上りゼロクロス点PUの後に最初に出現する加減速切替位相PCからその次に出現する加減速切替位相PCまでの区間を減速区間SRと推定する。
 また制御部10は、加減速区間推定部47により、以降の加減速切替位相PCごとに区切られる各区間を交互に加速区間SA又は減速区間SRと推定して、次のステップSP9へ移る。
 ステップSP9において制御部10は、進行方位算出部49(図4)により、現時点が減速区間SRに属していれば水平方向の加速度(A3x,A3y)が示す方位をそのまま進行方位とし、現時点が加速区間SAに属していればその反対方向を進行方位として、次のステップSP10へ移る。
 ステップSP10において制御部10は、進行方位平滑化部50によって、水平加速度値Ahsの大きさに応じた係数を進行方位データC0に乗じて1秒間の加算平均を算出することにより進行方位データC1を算出する。
 続いて制御部10は、進行方位データC1を方位フィルタ34(図3)へ供給した後、次のステップSP11へ移って一連の進行方位算出処理手順RT1を終了する。
[1−4−2.歩行周期算出処理手順]
 スマートフォン1の制御部10(図1)は、進行方位算出処理手順RT1(図37)においてステップSP5へ移ると、歩行周期算出部45(図4)による演算処理として歩行周期算出サブルーチンSRT1(図38)を開始し、ステップSP21へ移る。
 ステップSP21において制御部10は、鉛直加速度Avのうち任意の部分を関数f(t)とし、(7)式に従い自己相関評価関数g(t)を用いて自己相関評価値を算出して、次のステップSP22へ移る。
 ステップSP22において制御部10は、自己相関評価値について位相差tを1から順次増加させる方向へ変化させながら極小点を検出し、次のステップSP23へ移る。
 ステップSP23において制御部10は、ステップSP22において検出した極小点の直前に出現した極大点を検出し、次のステップSP24へ移る。
 ステップSP24において制御部10は、1回目の極小点を既に採用したか否かを判定する。ここで否定結果が得られると、制御部10は次のステップSP25へ移る。
 ステップSP25において制御部10は、(8)式に従い、現在着目している極小点の値(すなわち極小値)が、その直前に出現した極大点の値(すなわち極大値)の0.9倍以下であるか否かを判定する。ここで否定結果が得られると、このことは極大値と極小値との落差が極めて小さく、現在着目している極小点が1歩目を表すものではない可能性が高いことを表している。このとき制御部10は再度ステップSP22へ戻り、次の極小点を検出する。
 一方ステップSP25において肯定結果が得られると、このことは現在着目している極小点が1歩目を表していると見なし得ることを表しており、このとき制御部10は次のステップSP26へ移る。
 ステップSP26において制御部10は、現在着目している極小点を1回目の(すなわち1歩目に相当する)極小点として採用した後、2歩目に相当する極小点を検出するべく再度ステップSP22へ戻る。
 ところでステップSP24において肯定結果が得られた場合、すなわちステップSP26において1回目の極小点を採用した後に再度ステップSP24へ移ってきた場合、制御部10は次のステップSP27へ移る。
 ステップSP27において制御部10は、(9)式に従い、現在着目している極小点の値(すなわち極小値)が、その直前に出現した極大点の値(すなわち極大値)の0.5倍以下であるか否かを判定する。ここで否定結果が得られると、このことは極大値と極小値との落差が比較的小さく、現在着目している極小点が2歩目を表すものではないと見なし得ることを表している。このとき制御部10は再度ステップSP22へ戻り、次の極小点を検出する。
 一方ステップSP27において肯定結果が得られると、このことは現在着目している極小点が2歩目を表していると見なし得ることを表しており、このとき制御部10は次のステップSP28へ移る。
 ステップSP28において制御部10は、現在着目している極小点を2回目の(すなわち2歩目に相当する)極小点として採用し、このときの位相差tを歩行周期PWとする。その後制御部10は、次のステップSP29へ移って歩行周期算出サブルーチンSRT1を終了し、進行方位算出処理手順RT1(図37)のステップSP5へ戻る。
[1−4−3.加減速切替位相学習処理手順]
 スマートフォン1の制御部10(図1)は、進行方位算出処理手順RT1(図37)においてステップSP7へ移ると、加減速区間切替位相学習部46(図4)による演算処理として加減速切替位相学習サブルーチンSRT2(図39)を開始し、ステップSP31へ移る。
 ステップSP31において制御部10は、ある歩行周期PWに着目し、この歩行周期PWにおける各位相について加速度A3を基に(6)式に従って水平加速度Ahを算出する。さらに制御部10は、この水平加速度Ahに現れる極小点を検出し、次のステップSP32へ移る。
 ステップSP32において制御部10は、極小点を検出した各位相について、方位角Cmの微分値をそれぞれ算出し、次のステップSP33へ移る。
 ステップSP33において制御部10は、未着目の極小点のうち方位角Cmの微分値が最も大きい極小点に着目し、次のステップSP34へ移る。
 ステップSP34において制御部10は、既に採用済みの極小点があるか否かを判定する。ここで否定結果が得られると、このことは現在着目している極小点が最初に着目した極小点であることを表している。このとき制御部10は、現在着目している極小点については他の極小点との間隔を考慮せず無条件に採用するべく、次のステップSP35へ移る。
 ステップSP35において制御部10は、現在着目している極小点を採用し、次のステップSP36へ移る。
 ステップSP36において制御部10は、極小点の採用数が4に達したか否かを判定する。ここで否定結果が得られると、このことは他にも極小点を採用する必要があることを表しており、このとき制御部10は次の極小点に着目するべく再度ステップSP33へ戻る。
 一方、ステップSP34において肯定結果が得られると、このことは既に採用済みの極小点と現在着目している極小点との間隔を考慮する必要があることを表しており、このとき制御部10は次のステップSP37へ移る。
 ステップSP37において制御部10は、採用済みの極小点の位相と、現在着目している極小点の位相との間隔のうち最も小さいもの(以下これを最小間隔と呼ぶ)を算出し、次のステップSP38へ移る。
 ステップSP38において制御部10は、算出した最小間隔が歩行周期PWの1/10以下であるか否かを判定する。ここで否定結果が得られると、このことは現在着目している極小点が採用済みの極小点から十分に離れており、両者に挟まれた区間を加速区間SA又は減速区間SRとした場合にも歩行者の動作として不自然ではないことを表している。このとき制御部10は、上述したステップSP35へ移って現在着目している極小点を採用する。
 一方、ステップSP38において肯定結果が得られると、このことは現在着目している極小点が採用済みの極小点と近すぎることから、両者に挟まれた区間を加速区間SA又は減速区間SRとした場合、歩行者の動作として不自然となってしまうことを表している。このとき制御部10は、近接位相除外処理として、現在着目している極小値を採用することなく、次の極小点に着目するべく再度ステップSP33へ戻る。
 その後、ステップSP36において肯定結果が得られると、このことは現在着目している歩行周期PWについて有効な4箇所の極小点を採用し終えたことを表しており、このとき制御部10は次のステップSP39へ移る。
 ステップSP39において制御部10は、採用した各極小点の位相について、その出現頻度をそれぞれ加算し、次のステップSP40へ移る。
 ステップSP40において制御部10は、所定の集計期間に含まれる全ての歩行周期PWについて、各極小点の位相を出現頻度として加算し終えたか否かを判定する。ここで否定結果が得られると、このことは未だ着目していない、すなわち極小点の位相を加算していない歩行周期PWが残っていることを表しており、このとき制御部10は次のステップSP41へ移る。
 ステップSP41において制御部10は、未着目の歩行周期PWを新たに着目する歩行周期PWとして、この歩行周期PWについても極小点の位相を出現頻度に加算するべく、再度ステップSP31へ戻る。
 一方、ステップSP40において肯定結果が得られると、このことは極小点の出現頻度について十分な集計結果が得られたことを表しており、このとき制御部10は次のステップSP42へ移る。
 ステップSP42において制御部10は、最終的に極小点の出現頻度が最も高い位相から順に4箇所を加減速切替位相PCとして採用する。その後制御部10は、次のステップSP43へ移って加減速切替位相学習サブルーチンSRT2を終了し、進行方位算出処理手順RT1(図37)のステップSP7へ戻る。
[1−5.進行方位の算出結果]
 次に、使用者が実際に歩行した際に得られた加速度等のデータを基に、一連の方位算出処理により生成された進行方位データC1と、GPS回路24により得られたGPS位置データGPとを組み合わせ、地図上における移動の軌跡としたものを図40、図41及び図42として示す。
 図40~図42では、使用者の歩行の軌跡を二等辺三角形の軌跡マークにより地図データ上にプロットしており、その頂角が指す方向により各プロットにおける進行方位を表している。また使用者は、実際の道路を区画に沿って矩形状に反時計回りに歩行している。
 図40~図42を参照すると、一部の区間において本来の進行方向よりもやや右向きとなっているものの、使用者の歩行時における進行方位を良好に算出できていることがわかる。
 また、携帯位置が尻ポケットW3の場合(図42)には、胸ポケットW1の場合(図40)及び上着の右ポケットW2の場合(図41)よりも誤差がやや大きくなる傾向にあるものの、十分に信頼できる程度に進行方位を算出できていることもわかる。
[1−6.動作及び効果]
 以上の構成において、スマートフォン1の制御部10は、歩行モードでナビゲーション機能を実行する際、ナビゲーションプログラム及び進行方位算出プログラムを実行することにより、図3及び図4に示した各機能ブロックを実現する。
 このとき進行方位算出部33は、まず加速度A1の積算値を基に重力加速度Gを算出して鉛直方向を定め、(4)式により検出座標系から見た地上座標系の単位ベクトルUを生成して、検出座標系の加速度A1を地上座標系の加速度A2に座標変換する。
 続いて進行方位算出部33は、加速度A2から主に歩行に起因した周波数帯を抽出して加速度A3とし、その鉛直方向成分である鉛直加速度Avの自己相関評価値を用いて、自己相関の度合いが2回目に高まるときの位相差を基に歩行周期PWを定める。また進行方位算出部33は、鉛直加速度Avにおいて落差が最大となる極大点及び極小点を基に位相基準点PS及び基準上りゼロクロス点PUを定める。
 さらに進行方位算出部33は、位相基準点PSを開始点とする歩行周期PWごとに、水平加速度Ahに極小点が出現し方位角Cmの微分値が大きい位相を学習し、その学習結果を基に加減速切替位相PCを選定する。
 そして進行方位算出部33は、歩行周期PW内で、基準上りゼロクロス点PUを基に加減速切替位相PCごとに交互に減速区間SR又は加速区間SAと推定し、水平方向の加速度が示す方位又はその反対の方位を進行方位として、平滑化した上で進行方位データC1を算出する。
 従ってスマートフォン1は、水平加速度Ahに出現する極小点を用いて加減速切替位相PCを適切に定めることができるので、歩行時における減速区間SRと加速区間SAとを高精度に切り分けることができる。これによりスマートフォン1は、水平方向の加速度が進行方向またはその反対方向のいずれに作用しているかを適切に判別することができ、最終的な使用者の進行方位を精度良く算出することができる。
 特にスマートフォン1は、加速区間SAと減速区間SRとに分けた上で最終的な進行方位を算出するため、両者を分けることなく水平面に長軸を定義するような手法と比較して、腰が回転するように動くことの影響を有効に排除することができる。
 このときスマートフォン1は、歩行時における使用者の動作原理を踏まえ、水平加速度Ahに極小点が出現する位相を基に加減速切替位相PCを検出することにより、この加減速切替位相PCごとに、減速区間SRと加速区間SAとを明確に区別することができる。
 またスマートフォン1は、図25~図29に示したように、水平加速度Ahの特性が使用者の携帯箇所により異なるものの、少なくとも減速区間SRと加速区間SAとが切り替わる位相においては高い確度で極小点が出現することから、加減速切替位相PCを良好に検出することができる。
 さらにスマートフォン1は、水平加速度Ahの微小点のうち方位角Cmの微分値が大きい位相を、加速と減速とが切り替わる位相として学習することにより、他要因点OTを排除して加減速切替位相PCを精度良く選出することができる。
 この学習処理を行う際、スマートフォン1は、歩行時に加速と減速とが極めて短い時間では切り替わらないことを利用した近接位相除外処理を行うことによっても、他要因点OTを有効に除外することができる。
 またスマートフォン1は、歩行周期PWを算出する際、使用者が周期的に繰り返す歩行動作に伴って鉛直加速度Avが周期的に変動することを踏まえ、自己相関評価値を用いることにより、当該歩行周期PWを精度良く算出することができる。
 特にこの場合、(8)式及び(9)式のように極大値と極小値との落差による採用条件を1歩目と2歩目とで相違させることにより、他方の足による1歩目と同一の足による2歩目とをそれぞれ適切に検出することができ、結果的に歩行周期PWの算出精度を格段に高めることができる。
 またスマートフォン1は、歩行周期PW内で極大値と極小値との落差が最大となる下りのゼロクロス点を位相基準点PSとすることにより、各歩行周期PWを精度良く切り出すことができる。
 さらにスマートフォン1は、鉛直加速度Avの波形と減速区間SR及び加速区間SAとの関係を踏まえ、位相基準点PSの次に出現する基準上りゼロクロス点PUを基に最初の減速区間SRを定めることにより、以降の減速区間SR及び加速区間SAを適切に定めることができる。
 さらにスマートフォン1は、平滑化処理において、加速度の大きさに応じた比重で加算することにより、進行方位の信頼性が高いサンプルの比重を高めつつ、全てのサンプルを有効に利用することにより、最終的に得られる進行方位データC1の精度を高めることができる。
 特にスマートフォン1は、加速度に一時的なノイズ成分が含まれる場合にも、全てのサンプルを用いることにより、その影響を相対的に低く抑えることができる。
 またスマートフォン1は、座標系の変換処理において、単位ベクトルUが表す変換行列により検出座標系を一度に地上座標系へ変換するため、演算処理量を最小限に止めると共に、回転座標系に変換する場合のような誤差を発生させずに済む。
 以上の構成によれば、スマートフォン1は、鉛直加速度Avの自己相関評価値を用いて歩行周期PWを定め、さらに位相基準点PS及び基準上りゼロクロス点PUを定める。またスマートフォン1は、近接位相除外処理を行いながら水平加速度Ahに極小点が出現する位相を学習し、その学習結果を基に加減速切替位相PCを選定する。そしてスマートフォン1は、基準上りゼロクロス点PUの後に加減速切替位相PCごとに区切られる区間を交互に減速区間SR又は加速区間SAと推定し、水平方向の加速度が示す方位又はその反対の方位を進行方位として、平滑化した上で進行方位データC1を算出する。これによりスマートフォン1は、減速区間SR及び加速区間SAそれぞれにおいて適切な進行方向を得ることができ、最終的な使用者の進行方位を精度良く算出することができる。
<2.他の実施の形態>
 なお上述した実施の形態においては、水平加速度Ahの極小点の出現位相を基に、学習処理により加減速切替位相PCを選定するようにした場合について述べた。
 本技術はこれに限らず、例えば水平加速度Ahの極小点のうち方位角Cmの微分値が大きい順に4箇所をそのまま加減速切替位相PCとするようにしても良い。このように学習処理を省略することにより、スマートフォン1の演算処理量を削減できるので、消費電力を低減することができる。
 また上述した実施の形態においては、水平加速度Ahの極小点のうち学習処理により出現頻度を加算すべき位相を、方位角Cmの微分値の大きさを指標として選定するようにした場合について述べた。
 本技術はこれに限らず、例えば鉛直加速度Avにおける極大点や極小点の出現位相との関係など、他の種々の指標を基に選定するようにしても良い。また学習処理において1回の歩行周期PWについて出現頻度を加算すべき位相の数としては、4に限らず、5以上や3以下としても良い。特に5以上の位相を加算する場合、例えば方位角Cmの微分値の大きさに応じた係数を乗じて頻度を非整数化して加算するようにしても良い。
 さらに上述した実施の形態においては、水平加速度Ahの極小点の出現位相を学習する際の近接位相除外処理において、位相同士の最小間隔が歩行周期PWの1/10以下となる場合に加算対象から除外するようにした場合について述べた。
 本技術はこれに限らず、歩行周期PWの1/8以下や1/15以下等、任意のしきい値を条件として加算対象から除外するようにしても良い。或いは、極小点の出現位相同士の間隔が比較的大きいことが判明している場合等に、近接位相除外処理を省略するようにしても良い。
 さらに上述した実施の形態においては、近接位相除外処理として、水平加速度Ahの極小点の出現位相を学習する際に、採用済みの位相との間隔が小さすぎる位相をその歩行周期における採用候補から除外するようにした場合について述べた。
 本技術はこれに限らず、例えば出現位相を学習する際には採用済みの位相との間隔が小さすぎる位相についても除外することなく頻度を加算し、加算後に頻度の高い順に4位相を採用する際に、近接位相除外処理として、採用済みの位相にとの間隔が小さすぎる位相を除外しながら順次採用するようにしても良い。
 さらに上述した実施の形態においては、歩行周期を使用者の2歩分に相当する期間として算出すると共に、当該歩行周期内において加減速切替位相を4点設定するようにした場合について述べた。
 本技術はこれに限らず、例えばスマートフォン1を収納した鞄を肩からつり下げており、この鞄が歩行中の体に周期的に当たることにより加減速が余分に切り替わることが判明している場合に、歩行周期内において加減速切替位相を6点や8点など、任意数に設定するようにしても良い。この場合であっても、加減速切替位相PCごとに交互に加速区間SA又は減速区間SRを推定することができるので、最終的に進行方位を適切に算出することが可能となる。
 さらに上述した実施の形態においては、基準上りゼロクロス点PUの後に最初に出現する加減速切替位相PCを減速区間SRの開始点とし、以降の加減速切替位相PCごとに区切られる区間を交互に加速区間SA又は減速区間SRと推定するようにした場合について述べた。
 本技術はこれに限らず、例えば歩行周期PWの開始点、すなわち位相基準点PSの後に最初に出現する加減速切替位相PCを減速区間SRの開始点とするなど、他の指標を基に減速区間SR及び加速区間SAを推定するようにしても良い。この場合、要は図13~図15及び図25~図29について説明したように、鉛直加速度Avの波形に現れる特徴を指標として減速区間SR及び加速区間SAを推定するようにすれば良い。
 さらに上述した実施の形態においては、鉛直加速度Avを表す自己相関関数を用いて得られる自己相関評価値を基に、歩行周期PWを算出するようにした場合について述べた。
 本技術はこれに限らず、例えば水平加速度Ahや方位角Cmを表す自己相関関数を用いて得られる自己相関評価値を用いるなど、他の種々の自己相関関数を用いるようにしても良い。
 さらに上述した実施の形態においては、自己相関評価値において2回目に極小点が現れた位相を歩行周期PWとするようにした場合について述べた。
 本技術はこれに限らず、例えば2回目の極大点の次に現れる極小点を歩行周期PWとするなど、種々の手法により歩行周期PWを算出するようにしても良い。この場合、要は自己相関関数の性質に応じて、位相差を順次拡大していった時に相関度が2回目に高まる位相を歩行周期PWとすれば良い。
 さらに上述した実施の形態においては、(8)式及び(9)式の係数をそれぞれ0.9及び0.5とする場合について述べた。
 本技術はこれに限らず、それぞれの係数を任意の値に定めるようにしても良い。この場合、1歩目が他方の足であり2歩目が同じ足であることを考慮し、(8)式及び(9)式の各係数をそれぞれj及びkとしたときに次の(10)式の関係を満たしていれば良い。
 0<k<j                     …(10)
 さらに上述した実施の形態においては、鉛直加速度Avの極大値と極小値との落差が最大となる時の下りのゼロクロス点を位相基準点PSとし、これを歩行周期PWの開始点とするようにした場合について述べた。
 本技術はこれに限らず、例えば鉛直加速度Avの極大値と極小値との落差が最大となる時の極大点又は極小点の位相を位相基準点PSとするなど、種々の選択基準に基づき位相基準点PSを定めるようにしても良い。この場合、要は鉛直加速度Avにおいて歩行周期PWの期間内に1回のみ出現する特徴を用いて位相基準点PSを定めれば良い。
 さらに上述した実施の形態においては、BPF44(図4)により抽出する周波数帯を約1~10[Hz]とした場合について述べた。
 本技術はこれに限らず、例えば約0.5~20[Hz]など、種々の周波数帯を抽出するようにしても良い。この場合、歩行者の2歩に相当する周波数を含み、且つ直流成分及び高周波成分を除去することができれば良い。また高周波数帯に不要な成分が少ない場合に、低周波数帯のみを除去するようにしても良い。
 さらに上述した実施の形態においては、座標変換の際に、水平方向に関し磁北をy軸とする地上座標系に変換するようにした場合について述べた。
 本技術はこれに限らず、例えば検出座標系のx軸及びy軸を水平面に投影した軸をそれぞれx軸及びy軸とするような座標系、すなわち磁北を考慮しない座標系に変換し、加速度を基に進行方位を算出した後に、磁北を基準とした方位に変換するようにしても良い。また座標系については、直交座標系に限らず、極座標系など任意の座標系を用いても良い。
 さらに上述した実施の形態においては、平滑化処理として、算出した進行方位を水平方向の加速度の大きさに応じた係数を乗じて加算平均をとるようにした場合について述べた。
 本技術はこれに限らず、例えば水平方向の加速度の2乗に比例した係数を乗じるなど、種々の係数を乗じて加算平均をとるようにしても良く、或いは全ての係数を同一の値(例えば「1」)とすることにより平滑化処理を省略するようにしても良い。
 さらに上述した実施の形態においては、現在地の緯度及び経度を基に得られる偏角に応じて進行方位を補正するようにした場合について述べた。
 本技術はこれに限らず、例えばGPS信号を受信できず現在地の緯度及び経度を得られない場合に、標準的な補正値を基に進行方位を補正するようにしても良く、或いは補正処理を省略しても良い。また現在地の緯度及び経度についても、GPS信号に限らず、例えば無線LAN(Local Area Network)の信号等、種々の信号や情報を基に得るようにしても良い。
 さらに上述した実施の形態においては、方位フィルタ34においてGPS方位データGC及び進行方位データC1についてGPS信号の受信状況等を基に重み付けを行う場合、すなわちGPS信号の受信精度が低い場合のみ進行方位データC1の重みを増加する場合について述べた。
 本技術はこれに限らず、例えば方位フィルタ34において進行方位データC1を常用するようにしても良い。これにより、GPS回路24によるGPS信号の受信頻度を低減させることができるので、スマートフォン1の消費電力を抑えることができる。
 さらに上述した実施の形態においては、ナビゲーション機能に複数の動作モードを設け、その一つである徒歩モードが選択された場合に、進行方位算出部33により進行方位データC1を算出するようにした場合について述べた。
 本技術はこれに限らず、例えばナビゲーションプログラムの実行中に、加速度A1の波形を常時監視するようにし、その特徴から歩行中であることを判断した場合に、進行方位算出部33により進行方位データC1を算出するようにしても良い。
 さらに上述した実施の形態においては、ナビゲーション処理における案内として、表示部4に地図画面を表示するようにした場合について述べた。
 本技術はこれに限らず、例えば音声により目的地の方向を案内する等、種々の手法により使用者に案内を提示するようにしても良い。
 さらに上述した実施の形態においては、本技術をスマートフォン1に適用する場合について述べた。
 本技術はこれに限らず、例えば携帯型のナビゲーション装置、ディジタルビデオカメラやディジタルスチルカメラ、携帯型音楽プレーヤや携帯型ビデオプレーヤ、携帯型ゲーム機、歩数計、或いはノート型やスレート型等のコンピュータ装置など、使用者が歩行時に携帯可能であり測位機能を有する種々の電子機器に適用するようにしても良い。いずれにしても、鉛直加速度及び水平加速度を得て、これらを基に最終的に進行方位データC1を生成できれば良い。
 さらに上述した実施の形態においては、スマートフォン1の制御部10が、予めROM12や不揮発性メモリ14等に格納されているナビゲーションプログラム及び進行方位算出プログラムを実行することにより、進行方位算出処理手順RT1等に従った種々の処理を行うようにした場合について述べた。
 本技術はこれに限らず、スマートフォン1の制御部10が、記憶媒体からインストールしたアプリケーションプログラムや、インターネットからダウンロードしたアプリケーションプログラム、その他種々の入手経路を経てインストールしたアプリケーションプログラムに従って上述した各処理を行うようにしても良い。
 さらに上述した実施の形態においては、検出部としての加速度センサ27及び座標変換部43と、歩行周期設定部としての歩行周期算出部45と、加減速切替位相設定部としての加減速区間切替位相学習部46と、加減速区間設定部としての加減速区間推定部47と、進行方位決定部としての進行方位算出部49とによって進行方位算出装置としての進行方位算出部33を構成する場合について述べた。
 しかしながら本技術はこれに限らず、その他種々の構成でなる検出部と、歩行周期設定部と、加減速切替位相設定部と、加減速区間設定部と、進行方位決定部とによって進行方位算出装置を構成するようにしても良い。
 さらに、本技術は次のような構成も取ることができる。
 (1)使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出部と、上記鉛直加速度のゼロクロス点を基に、上記使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定部と、上記歩行周期内において、上記水平加速度の大きさが極小となる位相を基に、上記使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定部と、上記加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定部と、上記減速区間では上記水平加速度が表す方位に基づき、上記加速区間では上記水平加速度が表す方位と反対の方位に基づき、上記使用者の進行方位を決定する進行方位決定部とを有する進行方位算出装置。
 (2)上記加減速切替位相設定部は、上記歩行周期内において上記水平加速度の大きさが極小となる頻度が高い位相を上記加減速切替位相に設定する上記(1)に記載の進行方位算出装置。
 (3)上記加減速切替位相設定部は、上記水平加速度を基に上記加速度が作用する方位を極座標により表す方位角及び当該方位角の微分値を算出し、上記水平加速度の大きさが極小となる位相のうち上記方位角の微分値が大きい順に所定数を上記頻度の加算対象とする上記(1)または(2)に記載の進行方位算出装置。
 (4)上記加減速切替位相設定部は、上記歩行周期内において上記水平加速度の大きさが極小となる頻度が最も高い位相から順次上記加減速切替位相に設定し、既に設定した上記加減速切替位相から所定間隔未満の位相を新たな上記加減速切替位相の設定対象から除外する上記(2)または(3)に記載の進行方位算出装置。
 (5)上記加減速切替位相設定部は、上記歩行周期内において上記加減速切替位相を4点設定する上記(1)から(4)のいずれかに記載の進行方位算出装置。
 (6)上記歩行周期設定部は、上記鉛直加速度において所定部分に類似する波形が再度出現するまでの期間を基に上記歩行周期の長さを設定する上記(1)から(5)のいずれかに記載の進行方位算出装置。
 (7)上記歩行周期設定部は、上記鉛直加速度について位相差を順次増加させながら自己相関度を算出し、当該自己相関度が高くなる極値が2回目に出現するときの位相差を上記歩行周期の長さとする上記(5)に記載の進行方位算出装置。
 (8)上記歩行周期設定部は、上記自己相関度の高さに応じて値が小さくなる自己相関値により上記自己相関度を算出し、当該自己相関値の1回目の極小値がその直前に出現した極大値のj倍(ただし0<j<1)以下であり、且つ当該自己相関値の2回目の極小値がその直前に出現した極大値のk倍(ただし0<k<j)以下であるときに、当該2回目の極小値が出現する時の位相差を上記歩行周期の長さとする上記(6)または(7)に記載の進行方位算出装置。
 (9)上記歩行周期設定部は、上記歩行周期を設定すると共に、上記歩行周期内において上記鉛直加速度の互いに隣接する極大値と極小値との落差が最大となる下りのゼロクロス点を位相の基準となる基準位相に設定する上記(1)から(8)のいずれかに記載の進行方位算出装置。
 (10)上記検出部は、上記進行方位算出装置に加えられる加速度を検出し、固有の3次元でなる検出座標系で表された加速度検出値とする加速度センサと、上記加速度検出値を基に鉛直方向を算出する鉛直方向算出部と、上記加速度検出値のうち上記鉛直方向成分を上記鉛直加速度とすると共に、上記加速度検出値のうち上記鉛直方向と直交する水平面に含まれる2次元の成分を上記水平加速度とする変換部とをさらに有する上記(1)から(9)のいずれかに記載の進行方位算出装置。
 (11)上記検出部は、上記進行方位算出装置における磁北の方向を検出する地磁気センサをさらに有し、上記変換部は、上記水平加速度が表す方位を、上記磁北を基準とした絶対方位に変換する上記(10)に記載の進行方位算出装置。
 (12)上記変換部は、上記加速度検出値を、上記検出座標系から、上記鉛直方向及び上記磁北に相当する方向をそれぞれ1つの軸方向とする地上座標系に変換する上記(10)または(11)に記載の進行方位算出装置。
 (13)上記水平加速度の大きさに応じた係数を上記進行方位に乗じて加算平均を算出する進行方位平滑化部をさらに有する上記(1)から(12)のいずれかに記載の進行方位算出装置。
 本開示は、携帯型のナビゲーション装置、ナビゲーション機能を搭載した携帯電話機、或いはディジタルスチルカメラやコンピュータ装置等の種々の電子機器でも利用できる。
 1……スマートフォン、10……制御部、27……加速度センサ、28……地磁気センサ、33……進行方位算出部、34……方位フィルタ、41……鉛直方向検出部、42……変換行列生成部、43……座標変換部、44……BPF、45……歩行周期算出部、46……加減速区間切替位相学習部、47……加減速区間推定部、49……進行方位算出部、50……進行方位平滑化部、A1、A2、A3……加速度、M……地磁気値、Av……鉛直加速度、Ah……水平加速度、PW……歩行周期、PS……位相基準点、PC……加減速切替位相、PU……基準上りゼロクロス点、SR……減速区間、SA……加速区間、IAR……加減速情報、C1……進行方位データ

Claims (16)

  1.  使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出部と、
     上記鉛直加速度のゼロクロス点を基に、上記使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定部と、
     上記歩行周期内において、上記水平加速度の大きさが極小となる位相を基に、上記使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定部と、
     上記加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定部と、
     上記減速区間では上記水平加速度が表す方位に基づき、上記加速区間では上記水平加速度が表す方位と反対の方位に基づき、上記使用者の進行方位を決定する進行方位決定部と
     を有する進行方位算出装置。
  2.  上記加減速切替位相設定部は、
     上記歩行周期内において上記水平加速度の大きさが極小となる頻度が高い位相を上記加減速切替位相に設定する
     請求項1に記載の進行方位算出装置。
  3.  上記加減速切替位相設定部は、
     上記水平加速度を基に上記加速度が作用する方位を極座標により表す方位角及び当該方位角の微分値を算出し、上記水平加速度の大きさが極小となる位相のうち上記方位角の微分値が大きい順に所定数を上記頻度の加算対象とする
     請求項2に記載の進行方位算出装置。
  4.  上記加減速切替位相設定部は、
     上記歩行周期内において上記水平加速度の大きさが極小となる頻度が最も高い位相から順次上記加減速切替位相に設定し、既に設定した上記加減速切替位相から所定間隔未満の位相を新たな上記加減速切替位相の設定対象から除外する
     請求項2に記載の進行方位算出装置。
  5.  上記加減速切替位相設定部は、
     上記歩行周期内において上記加減速切替位相を4点設定する
     請求項1に記載の進行方位算出装置。
  6.  上記歩行周期設定部は、
     上記鉛直加速度において所定部分に類似する波形が再度出現するまでの期間を基に上記歩行周期の長さを設定する
     請求項1に記載の進行方位算出装置。
  7.  上記歩行周期設定部は、
     上記鉛直加速度について位相差を順次増加させながら自己相関度を算出し、当該自己相関度が高くなる極値が2回目に出現するときの位相差を上記歩行周期の長さとする
     請求項6に記載の進行方位算出装置。
  8.  上記歩行周期設定部は、
     上記自己相関度の高さに応じて値が小さくなる自己相関値により上記自己相関度を算出し、当該自己相関値の1回目の極小値がその直前に出現した極大値のj倍(ただし0<j<1)以下であり、且つ当該自己相関値の2回目の極小値がその直前に出現した極大値のk倍(ただし0<k<j)以下であるときに、当該2回目の極小値が出現する時の位相差を上記歩行周期の長さとする
     請求項7に記載の進行方位算出装置。
  9.  上記歩行周期設定部は、
     上記歩行周期を設定すると共に、上記歩行周期内において上記鉛直加速度の互いに隣接する極大値と極小値との落差が最大となる下りのゼロクロス点を位相の基準となる基準位相に設定する
     請求項1に記載の進行方位算出装置。
  10.  上記検出部は、
     上記進行方位算出装置に加えられる加速度を検出し、固有の3次元でなる検出座標系で表された加速度検出値とする加速度センサと、
     上記加速度検出値を基に鉛直方向を算出する鉛直方向算出部と、
     上記加速度検出値のうち上記鉛直方向成分を上記鉛直加速度とすると共に、上記加速度検出値のうち上記鉛直方向と直交する水平面に含まれる2次元の成分を上記水平加速度とする変換部と
     をさらに有する請求項1に記載の進行方位算出装置。
  11.  上記検出部は、
     上記進行方位算出装置における磁北の方向を検出する地磁気センサ
     をさらに有し、
     上記変換部は、
     上記水平加速度が表す方位を、上記磁北を基準とした絶対方位に変換する
     請求項10に記載の進行方位算出装置。
  12.  上記変換部は、
     上記加速度検出値を、上記検出座標系から、上記鉛直方向及び上記磁北に相当する方向をそれぞれ1つの軸方向とする地上座標系に変換する
     請求項11に記載の進行方位算出装置。
  13.  上記水平加速度の大きさに応じた係数を上記進行方位に乗じて加算平均を算出する進行方位平滑化部
     をさらに有する請求項1に記載の進行方位算出装置。
  14.  検出部により、使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出ステップと、
     歩行周期設定部により、上記鉛直加速度のゼロクロス点を基に、上記使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定ステップと、
     加減速切替位相設定部により、上記歩行周期内において、上記水平加速度の大きさが極小となる位相を基に、上記使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定ステップと、
     加減速区間推定部により、上記加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定ステップと、
     進行方位決定部により、上記減速区間では上記水平加速度が表す方位に基づき、上記加速区間では上記水平加速度が表す方位と反対の方位に基づき、上記使用者の進行方位を決定する進行方位決定ステップと
     を有する進行方位算出方法。
  15.  情報処理装置に対し、
     使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出ステップと、
     上記鉛直加速度のゼロクロス点を基に、上記使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定ステップと、
     上記歩行周期内において、上記水平加速度の大きさが極小となる位相を基に、上記使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定ステップと、
     上記加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定ステップと、
     上記減速区間では上記水平加速度が表す方位に基づき、上記加速区間では上記水平加速度が表す方位と反対の方位に基づき、上記使用者の進行方位を決定する進行方位決定ステップと
     を実行させるための進行方位算出プログラム。
  16.  使用者の歩行に伴い発生する加速度のうち、鉛直方向の加速度を表す鉛直加速度と、水平面内における加速度の方位及び大きさを表す水平加速度とを検出する検出部と、
     上記鉛直加速度のゼロクロス点を基に、上記使用者の2歩に相当する期間を歩行周期として設定する歩行周期設定部と、
     上記歩行周期内において、上記水平加速度の大きさが極小となる位相を基に、上記使用者の進行方向への加速と減速とが切り替わる加減速切替位相を設定する加減速切替位相設定部と、
     上記加減速切替位相毎に区切られた各区間を交互に加速区間又は減速区間として推定する加減速区間推定部と、
     上記減速区間では上記水平加速度が表す方位に基づき、上記加速区間では上記水平加速度が表す方位と反対の方位に基づき、上記使用者の進行方位を決定する進行方位決定部と、
     所定の位置検出部により検出した現在位置と上記進行方位とに基づいた案内を所定の提示部により上記使用者に提示させる提示制御部と
     を有するナビゲーション装置。
PCT/JP2012/062441 2011-05-17 2012-05-09 進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置 WO2012157652A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US14/116,141 US20140088867A1 (en) 2011-05-17 2012-05-09 Travel orientation calculation apparatus, travel orientation calculation method, travel orientation calculation program, and navigation apparatus
EP12785505.4A EP2711669A4 (en) 2011-05-17 2012-05-09 DEVICE FOR CALCULATING A WAY ALIGNMENT, METHOD FOR CALCULATING A WAY ALIGNMENT, PROGRAM FOR CALCULATING A WAY ALIGNMENT AND NAVIGATION DEVICE
CN201280022320.6A CN103502773A (zh) 2011-05-17 2012-05-09 行进方位计算设备、行进方位计算方法、行进方位计算程序及导航设备

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2011-110730 2011-05-17
JP2011110730A JP2012242179A (ja) 2011-05-17 2011-05-17 進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置

Publications (1)

Publication Number Publication Date
WO2012157652A1 true WO2012157652A1 (ja) 2012-11-22

Family

ID=47176969

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2012/062441 WO2012157652A1 (ja) 2011-05-17 2012-05-09 進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置

Country Status (5)

Country Link
US (1) US20140088867A1 (ja)
EP (1) EP2711669A4 (ja)
JP (1) JP2012242179A (ja)
CN (1) CN103502773A (ja)
WO (1) WO2012157652A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105102928A (zh) * 2013-02-01 2015-11-25 株式会社理光 惯性装置、方法和程序

Families Citing this family (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013160671A (ja) * 2012-02-07 2013-08-19 Seiko Epson Corp 状態検出装置、電子機器及びプログラム
JP5935365B2 (ja) * 2012-02-07 2016-06-15 セイコーエプソン株式会社 状態検出装置、電子機器及びプログラム
US9429437B2 (en) * 2012-06-08 2016-08-30 Apple Inc. Determining location and direction of travel using map vector constraints
JP6358889B2 (ja) 2013-09-26 2018-07-18 株式会社メガチップス 歩行者観測システム、プログラムおよび進行方向推定方法
JP6496996B2 (ja) * 2013-11-05 2019-04-10 セイコーエプソン株式会社 運動諸量算出方法、運動諸量算出装置及び携帯機器
CN103792386B (zh) * 2013-11-21 2016-01-20 清华大学 一种步行方向检测方法和装置
US9887564B2 (en) * 2014-02-13 2018-02-06 Infineon Technologies Austria Ag Switched mode power supply circuit
US20150316577A1 (en) * 2014-05-02 2015-11-05 Qualcomm Incorporated Motion direction determination and application
US9983224B2 (en) 2014-05-02 2018-05-29 Qualcomm Incorporated Motion direction determination and application
US10281484B2 (en) * 2014-05-02 2019-05-07 Qualcomm Incorporated Motion direction determination and application
CN105318868A (zh) * 2014-06-03 2016-02-10 中兴通讯股份有限公司 导航信息的获取方法及装置、移动终端
JP6372249B2 (ja) * 2014-08-22 2018-08-15 カシオ計算機株式会社 情報処理装置、進行方向推定方法及びプログラム
CN104197952B (zh) * 2014-09-02 2017-06-30 百度在线网络技术(北京)有限公司 一种用户步行计步方法、装置及移动终端
JP6446922B2 (ja) * 2014-09-02 2019-01-09 カシオ計算機株式会社 計測装置、計測方法及びプログラム
JP6446941B2 (ja) * 2014-09-22 2019-01-09 カシオ計算機株式会社 運動解析装置、方法、およびプログラム
US11504029B1 (en) * 2014-10-26 2022-11-22 David Martin Mobile control using gait cadence
CN106153067A (zh) * 2015-03-30 2016-11-23 联想(北京)有限公司 一种电子设备、测距方法及运算处理部件
US10042057B2 (en) 2015-05-15 2018-08-07 Casio Computer Co., Ltd. Information processing device, traveling direction estimation method and storage medium
CN104949685B (zh) * 2015-05-22 2018-04-27 邓伟廷 能在多模式多部位实现精确计步的方法及其装置
CN104990562B (zh) * 2015-06-29 2018-02-23 合肥工业大学 基于自相关运算的计步方法
CN104964685B (zh) * 2015-06-30 2018-02-16 广州市香港科大霍英东研究院 一种手机运动姿态的判定方法
US10814788B2 (en) * 2016-07-05 2020-10-27 Mitsubishi Electric Corporation Recognized-region estimation device, recognized-region estimation method, and recognized-region estimation program
WO2018186077A1 (ja) * 2017-04-05 2018-10-11 シャープ株式会社 進行方向計算装置、進行方向決定方法、および制御プログラム
JP6392937B2 (ja) * 2017-06-09 2018-09-19 ヤフー株式会社 推定装置、推定方法及び推定プログラム
TWI680277B (zh) 2017-10-31 2019-12-21 芬蘭商亞瑪芬體育數字服務公司 用於確定物體的運動方向的方法和系統
GB2595065B (en) 2017-10-31 2022-05-11 Amer Sports Digital Services Oy Method and system for tracking and determining an indoor position of an object
CN110319851B (zh) * 2018-03-30 2022-03-01 北京百度网讯科技有限公司 传感器的校正方法、装置、设备及存储介质
JP2019190937A (ja) * 2018-04-23 2019-10-31 シャープ株式会社 進行方向計算装置、進行方向決定方法、および制御プログラム
CN109870172B (zh) * 2019-02-25 2020-12-18 广州市香港科大霍英东研究院 计步检测方法、装置、设备及存储介质
CN110686672A (zh) * 2019-10-23 2020-01-14 北京航空航天大学 一种适用于配带智能手机行人的行走航向检测方法
CN112729331B (zh) * 2020-12-21 2024-03-08 卡哈科技(深圳)有限公司 基于三轴加速度计的双带通滤波计步方法及电子设备
CN114465531B (zh) * 2022-02-25 2022-11-18 深圳市鼎拓达机电有限公司 一种直流无刷电机控制方法、系统、存储介质及程序产品

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003302419A (ja) * 2002-04-08 2003-10-24 Casio Comput Co Ltd 歩行方向検出方法、歩行方向検出装置、及びプログラム
WO2006104140A1 (ja) * 2005-03-28 2006-10-05 Asahi Kasei Emd Corporation 進行方向計測装置及び進行方向計測方法
JP2008039619A (ja) * 2006-08-07 2008-02-21 Aichi Micro Intelligent Corp 歩行者用の経路案内装置及び携帯電話機
JP2008116315A (ja) * 2006-11-02 2008-05-22 Yamaha Corp 歩行ナビゲーション方法、システムおよびプログラム
JP2009186376A (ja) * 2008-02-07 2009-08-20 Fujitsu Ltd 移動方向算出装置および移動方向算出プログラム
JP2010271167A (ja) * 2009-05-21 2010-12-02 Kddi Corp 加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法
JP2011117945A (ja) * 2009-10-30 2011-06-16 Casio Computer Co Ltd 歩行計測装置、歩行計測方法およびプログラム
JP2011163861A (ja) * 2010-02-08 2011-08-25 Kddi Corp 地磁気センサ及び加速度センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法
JP2012021870A (ja) * 2010-07-14 2012-02-02 Kddi Corp 加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5583776A (en) * 1995-03-16 1996-12-10 Point Research Corporation Dead reckoning navigational system using accelerometer to measure foot impacts
DE102009031268A1 (de) * 2009-06-30 2011-01-13 Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. Analysieren von Bewegungen von Objekten

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003302419A (ja) * 2002-04-08 2003-10-24 Casio Comput Co Ltd 歩行方向検出方法、歩行方向検出装置、及びプログラム
WO2006104140A1 (ja) * 2005-03-28 2006-10-05 Asahi Kasei Emd Corporation 進行方向計測装置及び進行方向計測方法
JP2008039619A (ja) * 2006-08-07 2008-02-21 Aichi Micro Intelligent Corp 歩行者用の経路案内装置及び携帯電話機
JP2008116315A (ja) * 2006-11-02 2008-05-22 Yamaha Corp 歩行ナビゲーション方法、システムおよびプログラム
JP2009186376A (ja) * 2008-02-07 2009-08-20 Fujitsu Ltd 移動方向算出装置および移動方向算出プログラム
JP2010271167A (ja) * 2009-05-21 2010-12-02 Kddi Corp 加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法
JP2011117945A (ja) * 2009-10-30 2011-06-16 Casio Computer Co Ltd 歩行計測装置、歩行計測方法およびプログラム
JP2011163861A (ja) * 2010-02-08 2011-08-25 Kddi Corp 地磁気センサ及び加速度センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法
JP2012021870A (ja) * 2010-07-14 2012-02-02 Kddi Corp 加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP2711669A4 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105102928A (zh) * 2013-02-01 2015-11-25 株式会社理光 惯性装置、方法和程序
EP2951530A4 (en) * 2013-02-01 2016-03-09 Ricoh Co Ltd ARMOR DEVICE, PROCESS AND PROGRAM
US10234293B2 (en) 2013-02-01 2019-03-19 Ricoh Company, Ltd. Inertial device including an acceleration, method performed by the same, and program

Also Published As

Publication number Publication date
US20140088867A1 (en) 2014-03-27
EP2711669A4 (en) 2014-11-12
CN103502773A (zh) 2014-01-08
EP2711669A1 (en) 2014-03-26
JP2012242179A (ja) 2012-12-10

Similar Documents

Publication Publication Date Title
WO2012157652A1 (ja) 進行方位算出装置、進行方位算出方法及び進行方位算出プログラム並びにナビゲーション装置
JP2012107992A (ja) 歩行状況検出装置、歩行状況検出方法及び歩行状況検出プログラム
Kang et al. Improved heading estimation for smartphone-based indoor positioning systems
Huang et al. Synergism of INS and PDR in self-contained pedestrian tracking with a miniature sensor module
AU2015316575B2 (en) Inertial tracking based determination of the position of a mobile device carried by a user in a geographical area
Zhang et al. A handheld inertial pedestrian navigation system with accurate step modes and device poses recognition
Zhang et al. Indoor localization using a smart phone
Racko et al. Pedestrian dead reckoning with particle filter for handheld smartphone
Diaz et al. Step detector and step length estimator for an inertial pocket navigation system
Lan et al. Using smart-phones and floor plans for indoor location tracking-Withdrawn
US20130197857A1 (en) Gps-calibrated pedometer
JP5953677B2 (ja) 情報処理装置、情報処理方法、プログラム、及び記録媒体
Lee et al. An experimental heuristic approach to multi-pose pedestrian dead reckoning without using magnetometers for indoor localization
WO2006104140A1 (ja) 進行方向計測装置及び進行方向計測方法
CN107255474B (zh) 一种融合电子罗盘和陀螺仪的pdr航向角确定方法
US10830606B2 (en) System and method for detecting non-meaningful motion
Tian et al. An enhanced pedestrian dead reckoning approach for pedestrian tracking using smartphones
JP5742794B2 (ja) 慣性航法装置及びプログラム
CN104501808A (zh) 路径追踪方法及装置
JP5741194B2 (ja) 向き推定方法、向き推定装置及び端末装置
WO2012045484A1 (en) Gps-calibrated pedometer
Gowda et al. UMOISP: Usage mode and orientation invariant smartphone pedometer
Qian et al. RPNOS: Reliable pedestrian navigation on a smartphone
CN113325455B (zh) 用于跟踪和确定物体的室内位置的方法和系统
Rantakokko et al. Scenario-based evaluations of high-accuracy personal positioning systems

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 12785505

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 14116141

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 2012785505

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE