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.
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
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.
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.
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.
Smart Images

Figure CN112924931B_ABST
Abstract
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
