Light source position estimation system and estimation method based on arrival angle estimator

Through the light source position estimation system based on the arrival angle estimator, the linear equation system is solved using the least squares method, and the problems of difficulty and high cost of obtaining traditional light source coordinates are solved, and the rapid and efficient light source position estimation is achieved, which reduces the wireless optical positioning system Construction cost.

CN112924931BActive Publication Date: 2024-11-19SOUTHEAST UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202110112177.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-01-27
Publication Date
2024-11-19
Estimated Expiration
2041-01-27

AI Technical Summary

Technical Problem

In traditional wireless optical positioning systems, the light source coordinates are difficult to obtain and the regular update is high, and the traditional measurement methods are time-consuming and labor-intensive, and there is a lack of fast and efficient light source position estimation methods.

Method used

Using a light source position estimation system based on the arrival angle estimator, the optical signal is received through K arrival angle estimators, and the linear equation system is solved using the least squares method to calculate the three-dimensional coordinates of the light source, including using a camera or photodiode and photocell with different direction gains. , photomultiplier tube array, measure the direction of incident light, and build a light source location database.

Benefits of technology

It greatly reduces the labor overhead of building a light source location database, improves the speed and efficiency of the estimation algorithm, and relies on the solution of the system of linear equations to make the solution cost low, and can quickly obtain the three-dimensional coordinates of the light source.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN112924931B_ABST
    Figure CN112924931B_ABST
Patent Text Reader

Abstract

The present invention discloses a method for locating a light source based on a plurality of arrival angle estimators, including receiving a light source signal, structural design of an arrival angle estimator, and processing of a received signal. Each arrival angle estimator is composed of a plurality of photodiodes with different normal directions, and the difference in light signals received by different photodiodes can be used to estimate the direction of light. The traditional light positioning scheme locates a target by receiving signals from a plurality of light sources with known positions, and the assumption that the position of the light source is known is not valid in some cases. Therefore, the present invention proposes that the aforementioned arrival angle estimator can be used to quickly locate the light source in an indoor scenario. The present invention can effectively complement the traditional light positioning scheme, and compared with traditional position measurement methods such as laser rangefinders, the present scheme is simple and efficient.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of wireless optical positioning technology, and in particular to a positioning system using an arrival angle estimation method. Background Art

[0002] The traditional wireless optical positioning algorithm assumes that the coordinates of the light source are known, and then locates the light source through the measurement value of the receiver and the coordinates of the light source. The light source position is stored in the light source position database. However, in the actual environment, the coordinates of the light source are usually difficult to obtain, or the acquisition cost is very high. This is because the light source is usually located at a high position and is not easy to measure; and the building where the light source is located may deform due to changes in temperature and humidity and aging of materials, resulting in uncertainty in the position coordinates of the light source. Therefore, it is necessary to update the light source position coordinate database regularly. The traditional common coordinate measurement method is to use a laser rangefinder to measure the distance from the light source to each surface of the building to determine the coordinates of the light source in space. However, this approach requires the light of the laser rangefinder to be aimed at the target, and when the number of targets to be measured is large, this approach will become time-consuming and laborious. Therefore, it is necessary to propose a fast and efficient method for estimating the light source position to build a light source position database for the visible light positioning system. Summary of the invention

[0003] Purpose of the invention: The purpose of the present invention is to provide a light source position estimation system based on an arrival angle estimator, which can improve the efficiency of constructing a light source position database and reduce the construction cost of a wireless optical positioning system.

[0004] Technical solution: A light source position estimation system based on an arrival angle estimator includes K arrival angle estimators with known coordinates and direction angles and a light source, where K is a natural number greater than or equal to 1. The arrival angle estimator receives the light signal of the light source and obtains the direction vector of the light source reaching each arrival angle estimator, namely, the light incident vector. A set of equations is listed based on the known arrival angle estimator coordinates and the light incident vector, and the position of the light source is inferred using the least squares method.

[0005] Furthermore, the arrival angle estimator includes a camera or a photodiode, a photocell, or a photomultiplier tube array with different directional gains, and can obtain the incident light direction from the measured light intensity value by looking up a relationship table storing the photocurrent vector and the incident light direction or solving a linear equation system (constructed by a Lambertian model).

[0006] Furthermore, the three-dimensional coordinates of the arrival angle estimator are known, and the direction angle of the arrival angle estimator is known. The three-dimensional coordinates of the light source are calculated through the three-dimensional coordinates of the arrival angle estimator, the direction angle, and the measured incident light direction.

[0007] Furthermore, the number of the arrival angle estimators is 3, which are located at different positions on the same plane, and the line connecting any two arrival angle estimators forms a side of a triangle.

[0008] Furthermore, the arrival angle estimator is located on two lines of the orthogonal "cross" rigid support, and the distance between any arrival estimation angle and the nearest arrival estimation angle is the same.

[0009] A method for estimating a light source position based on an arrival angle estimator comprises the following steps:

[0010] Step 1: prepare K arrival angle estimators for determining the incident direction of the light signal, wherein the arrival angle estimators include cameras or photodiodes, photocells, and photomultiplier tube arrays with different directional gains;

[0011] Step 2: Place K arrival angle estimators at different locations and measure the three-dimensional coordinates a of each arrival angle estimator. k ,k=1,2,3…,K;

[0012] Step 3: Use the three-dimensional coordinate a of the arrival angle estimator k and the measured incident light direction r k , lists the distance d between the light source and the k-th arrival angle estimator k The linear equations are:

[0013] a k +d k r k =a j +d j r j ,k≠j

[0014] where r k is the length-normalized incident light direction vector, measurable by the angle estimator;

[0015] Step 4: Solve the above linear equations by the least squares method to obtain the distance d k :

[0016] d k r k -d j r j =a j -a k

[0017]

[0018]

[0019] in indicates (r k ,-rj )’s pseudo-inverse matrix;

[0020] Step 5: Pass a k , r k , d k We get the equations about the light source coordinate t,

[0021]

[0022] Step 6: Solve the above linear equations by the least squares method to obtain the estimated value of the light source position t

[0023]

[0024] Beneficial effects: The present invention discloses a light source position estimation system based on an arrival angle estimator, which has the following beneficial effects compared with the prior art:

[0025] 1) Multiple directional vector samples of the incident light signal are obtained through the arrival angle estimator, and the three-dimensional coordinates of the light source are obtained with extremely low manpower overhead.

[0026] 2) The light source position estimation algorithm relies on the solution of a system of linear equations, which has low solution cost and fast speed. BRIEF DESCRIPTION OF THE DRAWINGS

[0027] Figure 1 Implementation of the arrival angle estimator A;

[0028] Figure 2 Implementation of the arrival angle estimator B;

[0029] Figure 3 A schematic diagram of a light source position estimation system based on an arrival angle estimator proposed by the present invention (taking a system using three arrival angle estimators as an example);

[0030] Figure 4 It is a specific implementation method of the light source position estimator. DETAILED DESCRIPTION

[0031] The technical solution of the present invention is further introduced below in conjunction with specific implementation modes and drawings.

[0032] The light source position estimation system based on the arrival angle estimator of the present invention uses K arrival angle estimators to determine the incident direction of the light signal. The implementation of the arrival angle estimator includes: a camera or a photodiode, a photocell, or a photomultiplier tube array with different directional gains, such as Figure 1 , Figure 2 shown. Figure 1 The vector v in k represents the normal vector of the kth photodiode (PD), r represents the direction of the light source, Figure 2L represents the light source, O' represents the center of the lens, x'y' is the plane where the lens is located, z' is the direction of the lens normal vector, Q is the projection of L on the x'y' plane, θ' is the incident direction angle, P is the imaging point of the light source on the sensor array, O c is the projection point of the lens center on the sensor array, T is the line parallel to the y' axis through P and through O c Make the intersection of the parallel lines of the x' axis. For the camera, the position of the projection point of the light source on the imaging array can reflect the direction of the incident light, which can be calculated by the following formula:

[0033]

[0034] Among them, x P ,y P are the coordinates of point P on the imaging plane, and f is the focal length, such as Figure 2 As shown. For the photodiode array, it can be calculated by the following formula:

[0035]

[0036] where s is the length-normalized L×1 photocurrent vector acquired by L photodiodes, V PD It is an L×3 matrix whose lth row consists of the normal vector of the lth photodiode.

[0037] Place K arrival angle estimators at different locations and measure the three-dimensional coordinates a of each arrival angle estimator. k ,k=1,…,K, such as Figure 3 In addition, the following can also be used Figure 4 Arrange the arrival angle estimators in the manner shown, that is, place them on a rigid support, ensure that the relative positions between the arrival angle estimators remain unchanged and can be measured in advance, so as to obtain a k .

[0038] The three-dimensional coordinates a of the arrival angle estimator are k and the measured incident light direction r k , k = 1, ..., K, lists the distance d between the light source and the kth arrival angle estimator k ,k=1,…,K linear equations:

[0039] a k +d k r k =a j +d j r j ,k≠j

[0040] Among them, r kis the length-normalized direction vector, which can be measured by the angle estimator. For example, suppose there are 3 arrival angle estimators with coordinates:

[0041] a1=[1,0,0] T

[0042] a2=[-1,0,0] T

[0043] a3=[2,0,0] T

[0044] The measured incident vectors are:

[0045] r1=[0,0.32,0.95] T

[0046] r2=[0.53,0.27,0.80] T

[0047] r3=[-0.30,0.30,0.90] T

[0048] Then we can get three equations about d1, d2, and d3:

[0049] a1+d1r1=a2+d2r2

[0050] a1+d1r1=a3+d3r3

[0051] a2+d2r2=a3+d3r3

[0052] Solve the above linear equations by the least squares method and get the distance d k :

[0053] d k r k -d j r j =a j -a k

[0054]

[0055]

[0056] in indicates (r k ,-r j ). For the measured values ​​given in step 3, we can obtain:

[0057] d1=3.16

[0058] d2=3.74

[0059] d3=3.32

[0060] By a k , r k , d k The equations for the light source coordinate t are obtained:

[0061]

[0062] For the measured values ​​r1, r2, r3 given in step 3 and d1, d2, d3 in step 4, we have:

[0063] a1+d1r1=t

[0064] a2+d2r2=t

[0065] a3+d3r3=t

[0066] Solve the above linear equations by the least squares method to obtain the estimated value of the light source position t:

[0067]

[0068] Solving the system of equations in step 5, we obtain:

[0069] t=[1,1,3] T .

[0070] The above is only a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principle of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims

1. A light source position estimation system based on an arrival angle estimator, characterized in that: The invention comprises K arrival angle estimators with known coordinates and direction angles and a light source, K being a natural number greater than or equal to 1, the arrival angle estimator receives the light signal of the light source, obtains the direction vector of the light source reaching each arrival angle estimator, i.e., the light incident vector, lists an equation group according to the known arrival angle estimator coordinates and the light incident vector, and calculates the position of the light source by using the least square method; the arrival angle estimators are located on two lines of an orthogonal "cross" rigid body bracket, and the distance between any arrival angle estimator and the nearest arrival angle estimator is the same.

2. The light source position estimation system based on the arrival angle estimator according to claim 1, characterized in that: The arrival angle estimator includes a camera or a photodiode, a photocell, or a photomultiplier tube array with different directional gains. The incident light direction is obtained from the measured light intensity value by searching a relationship table storing the photocurrent vector and the incident light direction or solving a linear equation group.

3. The light source position estimation system based on the arrival angle estimator according to claim 1, characterized in that: The three-dimensional coordinates of the arrival angle estimator are known, and the direction angle of the arrival angle estimator is known. The three-dimensional coordinates of the light source are calculated through the three-dimensional coordinates of the arrival angle estimator, the direction angle, and the measured incident light direction.

4. The light source position estimation system based on the arrival angle estimator according to claim 1, characterized in that: The number of the arrival angle estimators is 3, which are located at different positions on the same plane, and the line connecting any two arrival angle estimators forms a side of a triangle.

5. A method for estimating the position of a light source based on an arrival angle estimator, using the system for estimating the position of a light source based on an arrival angle estimator according to claim 1, characterized in that: The steps include: Step 1: prepare K arrival angle estimators for determining the incident direction of the light signal, wherein the arrival angle estimators include cameras or photodiodes, photocells, and photomultiplier tube arrays with different directional gains; Step 2: Place K arrival angle estimators on two lines of the orthogonal "cross" rigid support. The distance between any arrival angle estimator and the nearest arrival angle estimator is the same. Measure the three-dimensional coordinates a of each arrival angle estimator. k ,k=1,2,3…,K; Step 3: Use the three-dimensional coordinate a of the arrival angle estimator k and the measured incident light direction r k , lists the distance d between the light source and the k-th arrival angle estimator k The linear equations are: a k +d k r k =a j +d j r j ,k≠j where r k is the length-normalized incident light direction vector, measurable by the angle estimator; Step 4: Solve the above linear equations by the least squares method to obtain the distance d k : in indicates (r k ,-r j )’s pseudo-inverse matrix; Step 5: Pass a k , r k , d k We get the equations for the light source coordinate t, Step 6: Solve the above linear equations by the least squares method to obtain the estimated value of the light source position t