The aspect of the embodiments relates to an angular velocity detection device, an image display apparatus, an angular velocity detection method, and a storage medium.
A gyro sensor is a sensor that detects angular velocity. The gyro sensor has been used in autonomous navigation of automobiles and vessels. In recent years, the gyro sensor is also utilized in camera shake detection, orientation detection of a head mounted display, etc. Some of gyro sensors have characteristics that can change depending on environment conditions (temperature, vibration, acceleration, magnetism, etc.). Due to influence of the change in characteristics, an error occurs in a gyro output, and therefore a bias error occurs in a measured angular velocity. When angular velocity including the error is integrated to determine orientation of a moving object, bias drift occurs, which influences accuracy of orientation estimation of the moving object. Therefore, calibration of the gyro sensor is important.
Ojeda Lauro and Borenstein Johann, “Personal Dead-reckoning System for GPS-denied Environments”, IEEE International Workshop on Safety, Security, and Rescue Robotics (SSRR2007) Rome Italy, Sep. 27-29, pp. 1 to 6, 2007 discusses a technology in which a gyro sensor is attached to a foot of a robot, and zero velocity update for updating bias of the velocity in a stationary state is performed by using the fact that the velocity is reset to zero every time the foot contacts a surface in walking. Further, Japanese Patent Application Laid-Open No. 2009-276242 discusses a technology in which bias of a detected angular velocity value is dynamically calibrated by using angular velocities determined from an output of a gyro sensor and an output of a moving object motion sensor different from the gyro sensor.
Meanwhile, in recent years, mixed reality (MR) for seamless combination of a real space and a virtual space has been actively studied. The MR includes a video see-through system and an optical see-through system. In the video see-through system, an image of a virtual space drawn by, for example, computer graphics is superimposed on an image of a real space captured by an imaging apparatus such as a video camera, and the superimposed image is displayed. In the optical see-through system, a display screen of a display apparatus is made optically transparent to allow a real space to be seen while an image of a virtual space is superimposed on real space on the display screen. In the MR technology, the gyro sensor is used to detect orientation of a moving object, such as a head mounted display. Japanese Patent Application Laid-Open No. 2003-203252 discusses a relative coordinate conversion method between a camera directed to a line of sight and a gyro sensor in a case where the gyro sensor is applied to the video see-through head mounted display.
The technology to calibrate the output of the gyro sensor include the technology discussed in the above-described paper by Ojeda et al. and the technology discussed in Japanese Patent Application Laid-Open No. 2009-276242. By the technology discussed in the above-described paper, however, since the zero update is performed in the stationary state, convenience may be impaired depending on an application in which the function for calibration is to be included. Further, in the technology discussed in Japanese Patent Application Laid-Open No. 2009-276242, a moving object motion sensor different from the gyro sensor is additionally required.
According to an aspect of the embodiments, an angular velocity detection device includes an angular velocity sensor configured to detect angular velocity, an acquisition unit configured to acquire orientation information in a three-dimensional space on a moving object including the angular velocity sensor, a calculation unit configured to calculate estimated angular velocity based on the orientation information acquired by the acquisition unit, and a correction unit configured to correct an output of the angular velocity sensor based on the angular velocity detected by the angular velocity sensor and the estimated angular velocity calculated by the calculation unit.
Further features of the disclosure will become apparent from the following description of exemplary embodiments with reference to the attached drawings.
Some exemplary embodiments of the disclosure are described below with reference to drawings.
A first exemplary embodiment of the disclosure is described.
The HMD 101 includes a right camera 105 and a left camera 106 that capture an image of a visual field area of an HMD user. In this example, position orientation detection images are extracted from captured images captured by the right camera 105 and the left camera 106, and data of the position orientation detection images is analyzed to detect a position and orientation in a three-dimensional space. The orientation detection method using analysis of the position orientation detection images includes a plurality of systems.
As an example, a marker position orientation detection system is described with reference to
Further, in place of the marker position orientation detection system illustrated in
As another method, a plurality of the same types of markers may be used, a plurality of types of markers may be used at the same time, or a system combining the marker position orientation detection and the natural feature position orientation detection that uses the marker information and the information on the feature points in the image as a combination may be used. Using these systems enhances generation of precise orientation information in the three-dimensional space.
The HMD 101 includes a gyro sensor (angular velocity sensor) that detects an angular velocity for orientation detection, and regularly measures a movement rotation amount of the HMD 101 at a predetermined sampling frequency. The HMD 101 further includes an image display unit that displays an image to the HMD user. The PC 130 receives a captured image 125 as an image of a real space captured by the HMD 101, generates a combined image 126 that is obtained by superimposing an image of a virtual space drawn by a computer graphics or the like on the captured image 125, and transmits the combined image 126 to the HMD 101. The captured image as the image of the real space and the image of the virtual space are combined with reference to, for example, the angular velocity detected by the gyro sensor of the HMD 101. The MR system provides the combined image (MR image) in which the real space and the virtual space are combined, to the user of the HMD 101 in the above-described manner.
The imaging unit 401 corresponds to the right camera 105 and the left camera 106 included in the HMD 101 and captures images in the visual field area of right and left eyes of the user. The orientation information acquisition unit 402 acquires orientation information on the user in the three-dimensional space from the images captured by the imaging unit 401. The orientation information acquired in the present exemplary embodiment is orientation information at the viewpoint of the user in the world coordinate system. Therefore, the coordinate conversion unit 404 converts the user orientation information into the orientation information in the sensor coordinate system based on the gyro sensor 406 by using the coordinate correction information 403 previously acquired.
The angular velocity calculation unit 405 receives the orientation information in the sensor coordinate system from the coordinate conversion unit 404, and calculates an estimated angular velocity ωo=(ωx, ωy, ωz) from orientation information qo=(qx, qy, qz, qw). The orientation information qo can be converted into the estimated angular velocity ωo by using the following simultaneous equations derived from a general formula. The estimated angular velocity ωo calculated by the angular velocity calculation unit 405 is output to the angular velocity correction calculation unit 407.
While, in the present exemplary embodiment, the orientation information is represented as quaternion, the orientation information is not limited thereto. It is sufficient to derive the estimated angular velocity from the orientation information, and the orientation information may be represented by, for example, a 3 by 3 rotation matrix, or roll, pitch, and yaw.
The gyro sensor 406 corresponds to the gyro sensor included in the HMD 101, and detects the angular velocity of the HMD 101 as a moving object at predetermined sampling timing. Angular velocity ωg acquired by the gyro sensor 406 is output to the angular velocity correction calculation unit 407.
The angular velocity ωg and the estimated angular velocity ωo are represented by the following expressions,
ωg=ωg_sig+ωbias+ωg_noise,ωo=ωo_sig+ωo_noise
where, in the angular velocity ωg, ωg-sig is a signal component of the angular velocity, ωbias is zero-point bias, and ωg_noise is white noise included in the output of the gyro sensor 406. The estimated angular velocity ωo similarly includes a signal component ωo_sig and white noise ωo_noise.
The angular velocity ωg acquired by the gyro sensor 406 and the estimated angular velocity ωo calculated by the angular velocity calculation unit 405 are input to the angular velocity correction calculation unit 407. The angular velocity correction calculation unit 407 derives the zero-point bias ωbias by using the input angular velocity ωg and the input estimated angular velocity ωo, and performs zero-point calibration of the gyro sensor 406. For example, the angular velocity correction calculation unit 407 uses a Kalman filter to dynamically estimate the zero-point bias ωbias. The method of deriving the zero-point bias is not limited thereto, and the zero-point bias may be derived by the other method.
In step S502, the angular velocity correction calculation unit 407 acquires the angular velocity ωg detected by the gyro sensor 406. In step S503, the orientation information acquisition unit 402 acquires the user orientation information in the three-dimensional space from the images captured by the imaging unit 401. The user orientation information acquired in step S503 is orientation information in the world coordinate system. Next, in step S504, the coordinate conversion unit 404 performs the coordinate conversion on the orientation information in the world coordinate system acquired in step S503, to convert the orientation information into the orientation information in the sensor coordinate system. Subsequently, in step S505, the angular velocity calculation unit 405 calculates the estimated angular velocity too from the orientation information in the sensor coordinate system converted in step S504. The processing order of the processing in step S502 is not limited to the processing order illustrated in
Next, in step S506, the angular velocity detection device determines whether the number of execution times of the processing in steps S502 to S505 is less than a designated number of times N. In a case where it is determined that the number of execution times of the processing in steps S502 to S505 is less than the designated number of times N (YES in step S506), the processing returns to step S501. Meanwhile, in a case where it is determined that the number of execution times of the processing in steps S502 to S505 is not less than the designated number of times N, namely, in a case where it is determined that the processing in steps S502 to S505 is performed the designated number of times N (NO in step S506), the processing proceeds to step S507. In step S507, the angular velocity correction calculation unit 407 calculates the zero-point bias ωbias based on the angular velocity ωg and the estimated angular velocity ωo acquired by the above-described processing, and stores the zero-point bias ωbias in the memory.
In step S508, the angular velocity correction calculation unit 407 corrects the angular velocity ωg from the gyro sensor 406 by using the zero-point bias ωbias, and outputs the corrected angular velocity ωg. As a result, the output of the gyro sensor 406 can be appropriately corrected by using the zero-point bias ωbias
In a case where it is determined in step S501 that the orientation information is absent (NO in step S501), control to perform zero-point calibration of the gyro sensor 406 in the stationary state is performed. In step S509, the angular velocity detection device determines whether the gyro sensor 406 is in the stationary state. The determination whether the gyro sensor 406 is in the stationary state is performed based on, for example, whether the angular velocity ωg is lower than or equal to a threshold. In a case where it is determined that the gyro sensor 406 is in the stationary state (YES in step S509), the processing proceeds to step S510. In a case where it is determined that the gyro sensor 406 is not in the stationary state (NO in step S509), the processing proceeds to step S513.
In step S510, the angular velocity correction calculation unit 407 acquires the angular velocity ωg detected by the gyro sensor 406. Next, in step S511, the angular velocity detection device determines whether the number of execution times of the processing in step S510 is less than the designated number of times N. In a case where it is determined that the number of execution times of the processing in step S510 is less than the designated number of times N (YES in step S511), the processing returns to step S509. Meanwhile, in a case where it is determined that the number of execution times of the processing in step S510 is not less than the designated number of times N, namely, in a case where it is determined that the processing in step S510 is performed the designated number of times N (NO in step S511), the processing proceeds to step S512. In step S512, the angular velocity correction calculation unit 407 calculates the zero-point bias ωbias based on the angular velocity ωg acquired by the above-described processing, and stores the zero-point bias ωbias in the memory. The processing then proceeds to step S508.
In the case where it is determined in step S509 that the gyro sensor 406 is not in the stationary state, the processing proceeds to step S513. In step S513, the angular velocity correction calculation unit 407 acquires the angular velocity ωg detected by the gyro sensor 406. The processing then proceeds to step S508. In this case, the zero-point bias ωbias is not calculated. In a case where the zero-point bias ωbias has been already calculated, the angular velocity ωg from the gyro sensor 406 is corrected by using the known zero-point bias ωbias.
The processing illustrated in
According to the first exemplary embodiment, the zero-point calibration of the gyro sensor 406 can be dynamically performed by using the estimated angular velocity that is calculated based on the orientation information on the HMD 101, which makes it possible to improve convenience of the system that originally requires the zero-point calibration in the stationary state. Further, it is possible to perform the zero-point calibration of the angular velocity sensor with the simple system configuration in which another moving object sensor other than the gyro sensor is not included.
Next, a second exemplary embodiment of the disclosure is described. In the following, differences from the above-described first exemplary embodiment are described.
More specifically, the angular velocity detection device according to the second exemplary embodiment is different from the first exemplary embodiment in a configuration in which the imaging unit 401 is replaced with the depth camera 601, and the acceleration sensor 602 for variation determination is added. The depth camera 601 captures a depth image in which each pixel of a captured image represents a distance. The depth camera 601 acquires a depth image by using invisible light such as infrared light. The acceleration sensor 602 detects moving acceleration of the HMD 101 as the moving object.
The angular velocity ωg acquired by the gyro sensor 406, the estimated angular velocity ωo calculated by the angular velocity calculation unit 405, and acceleration acc acquired by the acceleration sensor 602 are input to the angular velocity correction calculation unit 603. In a case where the acceleration acc is less than a threshold, the angular velocity correction calculation unit 603 derives the zero-point bias ωbias by using the angular velocity ωg and the estimated angular velocity ωo, and performs the zero-point calibration of the gyro sensor 406.
While, in the present exemplary embodiment, the depth camera is used as a source of the orientation information, the orientation information may be acquired by a magnetic field sensor that detects magnetism. For example, in the case of using the magnetic field sensor, magnetism near the HMD 101 is detected, and the orientation information in the three-dimensional space is acquired based on the detected magnetism. In either of the above described cases, coordinate conversion of the orientation information, derivation of the estimated angular velocity, and acquisition of the angular velocity of the gyro sensor are performed in a manner similar to the first exemplary embodiment.
Next, the angular velocity detection processing by the angular velocity detection device according to the second exemplary embodiment is described.
In step S702, the angular velocity detection device determines presence/absence of the orientation information. In a case where it is determined that the orientation information is present (YES in step S702), the processing proceeds to step S703. In a case where it is determined that the orientation information is absent (NO in step S702), the processing proceeds to step S711.
In step S703, the angular velocity correction calculation unit 603 acquires the angular velocity ωg detected by the gyro sensor 406. In step S704, the orientation information acquisition unit 402 acquires the user orientation information from the image captured by the depth camera 601. Next, in step S705, the coordinate conversion unit 404 performs the coordinate conversion on the orientation information in the world coordinate system acquired in step S704, to convert the orientation information into the orientation information in the sensor coordinate system. Subsequently, in step S706, the angular velocity calculation unit 405 calculates the estimated angular velocity ωo from the orientation information in the sensor coordinate system converted in step S705. In step S707, the angular velocity correction calculation unit 603 acquires the acceleration acc detected by the acceleration sensor 602. The processing order of the processing in each of step S703 and step S707 is not limited to the processing order illustrated in
Next, in step S708, the angular velocity detection device determines whether the number of execution times of the processing in steps S703 to S707 is less than the designated number of times N. In a case where it is determined that the number of execution times of the processing in steps S703 to S707 is less than the designated number of times N (YES in step S708), the processing returns to step S701. Meanwhile, in a case where it is determined that the number of execution times of the processing in steps S703 to S707 is not less than the designated number of times N, namely, in a case where it is determined that the processing in steps S703 to S707 is performed the designated number of times N (NO in step S708), the processing proceeds to step S709. In step S709, the angular velocity correction calculation unit 603 calculates the zero-point bias ωbias based on the angular velocity ωg and the estimated angular velocity ωo acquired by the above-described processing, and stores the zero-point bias ωbias in the memory.
In step S710, the angular velocity correction calculation unit 603 corrects the angular velocity ωg from the gyro sensor 406 by using the zero-point bias ωbias, and outputs the corrected angular velocity ωg. As a result, the output of the gyro sensor 406 can be appropriately corrected by using the zero-point bias ωbias.
In a case where it is determined in step S702 that the orientation information is absent (NO in step S702), control to perform zero-point calibration of the gyro sensor 406 in the stationary state is performed. In step S711, the angular velocity detection device determines whether the gyro sensor 406 is in the stationary state. In a case where it is determined that the gyro sensor 406 is in the stationary state (YES in step S711), the processing proceeds to step S712. In a case where it is determined that the gyro sensor 406 is not in the stationary state (NO in step S711), the processing proceeds to step S717.
In step S712, the angular velocity correction calculation unit 603 acquires the angular velocity ωg detected by the gyro sensor 406. In step S713, the angular velocity correction calculation unit 603 acquires the acceleration acc detected by the acceleration sensor 602. The processing in step S712 and step S713 may be performed in an optional order. The processing in step S712 may be performed after the processing in step S713 is performed. In step S714, the angular velocity detection device determines whether the acceleration acc acquired in step S713 is less than the threshold. In a case where it is determined that the acceleration acc is less than the threshold (YES in step S714), the processing proceeds to step S715. In a case where it is determined that the acceleration acc is greater than or equal to the threshold (NO in step S714), the processing proceeds to step S717.
Next, in step S715, the angular velocity detection device determines whether the number of execution times of the processing in steps S712 to S714 is less than the designated number of times N. In a case where it is determined that the number of execution times of the processing in steps S712 to S714 is less than the designated number of times N (YES in step S715), the processing returns to step S711. Meanwhile, in a case where it is determined that the number of execution times of the processing in steps S712 to S714 is not less than the designated number of times N, namely, in a case where it is determined that the processing in steps S712 to S714 is performed the designated number of times N (NO in step S715), the processing proceeds to step S716. In step S716, the angular velocity correction calculation unit 603 calculates the zero-point bias ωbias based on the angular velocity ωg acquired by the above-described processing, and stores the zero-point bias ωbias in the memory. The processing then proceeds to step S710.
In the case where it is determined in step S701 or step S714 that acceleration acc is greater than or equal to the threshold, the processing proceeds to step S717. In step S717, the angular velocity correction calculation unit 603 acquires the angular velocity ωg detected by the gyro sensor 406. The processing then proceeds to step S710. In other words, in the case where it is determined that the acceleration acc is greater than or equal to the threshold, only acquisition of the angular velocity ωg is performed without performing the correction processing. When sudden motion occurs, the orientation information not suitable for the correction and the estimated angular velocity obtained from such orientation information are prevented from being used in the correction in the above-described manner. This makes it possible to reduce the processing load. Further, in the case where it is determined in step S711 that the gyro sensor 406 is not in the stationary state, the angular velocity correction calculation unit 603 acquires, in step S717, the angular velocity ωg detected by the gyro sensor 406, and the processing then proceeds to step S710. In these cases, the zero-point bias ωbias is not calculated. In the case where the zero-point bias ωbias has been already calculated, the angular velocity ωg from the gyro sensor 406 is corrected by using the known zero-point bias ωbias.
As with the first exemplary embodiment, the processing illustrated in
The disclosure can be realized by supplying a program realizing one or more functions of the above-described exemplary embodiments to a system or an apparatus through a network or a storage medium and causing one or more processors in a computer of the system or the apparatus to read out and execute the program. Further, the disclosure can be realized by a circuit (e.g., application specific integrated circuit (ASIC)) realizing one or more functions.
The CPU 801 controls each of the units connected to the system bus 808. The RAM 802 is used as a main storage device of the CPU 801. The ROM 803 stores, for example, an activation program of the apparatus. When the CPU 801 reads out a program from the storage unit 806 and executes the program, for example, the angular velocity detection processing according to each of the above-described exemplary embodiments is realized.
The input unit 804 receives input, etc. from the user, and receives image data. The input unit 804 includes, for example, the gyro sensor (angular velocity sensor) and the camera. The output unit 805 outputs image data, a result of the processing by the CPU 801, etc. The storage unit 806 is a nonvolatile storage device that stores control programs relating to operation and processing of the apparatus. The communication IF 807 controls information communication between the apparatus and the other apparatus.
When the apparatus having the above-described configuration is turned on, the CPU 801 reads the control programs, etc. from the storage unit 806 to the RAM 802 based on the activation program stored in the ROM 803. The CPU 801 performs the processing based on the control programs, etc. read in the RAM 802, thereby realizing the functions of the HMD. In other words, the CPU 801 of the HMD performs the processing based on the control programs, etc., to realize the functional configuration and the operation of the HMD and the angular velocity detection device.
The above-described exemplary embodiments merely illustrate concrete examples of implementing the disclosure, and the technical scope of the disclosure is not to be construed in a restrictive manner by the exemplary embodiments. In other words, the disclosure may be implemented in various modes without departing from the technical spirit or main features thereof.
Embodiment(s) of the disclosure can also be realized by a computer of a system or apparatus that reads out and executes computer executable instructions (e.g., one or more programs) recorded on a storage medium (which may also be referred to more fully as a ‘non-transitory computer-readable storage medium’) to perform the functions of one or more of the above-described embodiment(s) and/or that includes one or more circuits (e.g., application specific integrated circuit (ASIC)) for performing the functions of one or more of the above-described embodiment(s), and by a method performed by the computer of the system or apparatus by, for example, reading out and executing the computer executable instructions from the storage medium to perform the functions of one or more of the above-described embodiment(s) and/or controlling the one or more circuits to perform the functions of one or more of the above-described embodiment(s). The computer may comprise one or more processors (e.g., central processing unit (CPU), micro processing unit (MPU)) and may include a network of separate computers or separate processors to read out and execute the computer executable instructions. The computer executable instructions may be provided to the computer, for example, from a network or the storage medium. The storage medium may include, for example, one or more of a hard disk, a random-access memory (RAM), a read only memory (ROM), a storage of distributed computing systems, an optical disk (such as a compact disc (CD), digital versatile disc (DVD), or Blu-ray Disc (BD)™), a flash memory device, a memory card, and the like.
While the disclosure has been described with reference to exemplary embodiments, it is to be understood that the disclosure is not limited to the disclosed exemplary embodiments. The scope of the following claims is to be accorded the broadest interpretation so as to encompass all such modifications and equivalent structures and functions.
This application claims the benefit of Japanese Patent Application No. 2019-174087, filed Sep. 25, 2019, which is hereby incorporated by reference herein in its entirety.
Number | Date | Country | Kind |
---|---|---|---|
JP2019-174087 | Sep 2019 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
10007350 | Holz | Jun 2018 | B1 |
20040113818 | Yokokohji | Jun 2004 | A1 |
20090295722 | Yamamoto | Dec 2009 | A1 |
20100273461 | Choi | Oct 2010 | A1 |
20110241656 | Piemonte | Oct 2011 | A1 |
20150128699 | Maki | May 2015 | A1 |
20150285834 | Shibuya | Oct 2015 | A1 |
20170045736 | Fu | Feb 2017 | A1 |
20170122739 | Kurashina | May 2017 | A1 |
20180075669 | Yeh | Mar 2018 | A1 |
20200033825 | Otani | Jan 2020 | A1 |
Number | Date | Country |
---|---|---|
2003-203252 | Jul 2003 | JP |
2009-276242 | Nov 2009 | JP |
Entry |
---|
Lauro Ojeda; “Personal Dead-reckoning System for GPS-denied Environments;” IEEE International Workshop on Safety, Security, and Rescue Robotics (SSRR2007), Rome, Italy, Sep. 27-29, 2007; pp. 1-6. |
Number | Date | Country | |
---|---|---|---|
20210088550 A1 | Mar 2021 | US |