A kind of indoor real-time high-precision positioning system
Technical field
The present invention relates to a kind of positioning system, be specifically related to a kind of indoor real-time high-precision positioning system.
Background technology
Positional information all has great significance for people's live and work, and positional information is provided in real time, very large facility is provided can for people's live and work.For example, the navigation of complex environment etc. under the guide to visitors in the shopping guide of large department store, museum, the parking stall of seeking the airport underground garage, the mine.
Under outdoor environment, the GPS GPS can satisfy basic positioning requirements, but in indoor situation, because blocking and multipath effect of building, the bearing accuracy of gps system sharply descends, do not satisfy people's needs, indoor locating system arises at the historic moment, such as radio-frequency (RF) identification (RFID) positioning system, ultra broadband (UWB) indoor locating system, infrared, the ultrasonic bluetooth indoor locating system etc. that involves, these systems have satisfied the ask for something of people for indoor location information more or less, but also exist some drawbacks, as: need the extra transceiver of installing, produce electromagnetic radiation etc.
Summary of the invention
In order to overcome the shortcoming of above-mentioned prior art, the object of the present invention is to provide a kind of indoor real-time high-precision positioning system, do not need additionally to install transmitter, do not expend any frequency spectrum resource, avoid simultaneously the volume electromagnetic radiation.
In order to achieve the above object, the technical scheme taked of the present invention is:
A kind of indoor real-time high-precision positioning system, comprise emitter and receiving trap, emitter is comprised of LED illuminating lamp and driving circuit, the function of driving circuit is except the drive current that the LED illuminating lamp is provided, the positional information that has also loaded the LED illuminating lamp is modulated, the LED illuminating lamp is being broadcasted the positional information of self when realizing illumination functions;
Receiving trap comprises hand-held receiving terminal, the sensor of hand-held receiving terminal has two kinds, and a kind of is camera, and another kind is photodiode PD, the effect of photodiode PD is to receive the positional information that the LED illuminating lamp is broadcasted, the absolute position that obtains the LED illuminating lamp; The effect of camera is the scene image to the photographs lamp, to calculate the relative position of receiving terminal and LED illuminating lamp.
The relative position of described camera and LED illuminating lamp calculates, need three parameters: the height of the height of indoor ceiling, hand-held receiving terminal and the direction of receiving terminal are pointed to, wherein the elevation information of indoor ceiling is preset in the indoor scene map, the height of hand-held receiving terminal is then estimated by the input height information, the direction of hand-held receiving terminal is pointed to, then holding the built-in magnetic compass of receipts terminal according to catcher determines, concern according to geometric projection, add the sensing of hand-held receiving terminal, just can get terminal for the relative position of LED illuminating lamp.
The field angle of described camera is greater than the field of view of receiver angle of photodiode PD.
The process of the present invention location is: hand-held receiving terminal is downloaded the map of place indoor scene, and this process can be passed through the LED illuminating lamp broadcasting of fixed point, is received by photodiode PD and downloads; Hand-held receiving terminal flush end up, the location is begun by the positional information that photodiode PD receives first LED illuminating lamp, calculated simultaneously the relative position of hand-held receiving terminal and LED illuminating lamp by camera, so add hand-held receiving terminal and LED illuminating lamp relative position by LED illuminating lamp absolute position, just obtain the particular location of hand-held receiving terminal, and be presented in real time in the indoor scene map;
When photodiode PD walks out the broadcasting area of first LED illuminating lamp, hand-held receiving terminal continues to follow the tracks of first LED illuminating lamp by camera and positions, until photodiode PD receives till the broadcasting of next second LED illuminating lamp, camera begins to follow the tracks of second LED illuminating lamp and carries out the relative position calibration afterwards;
When photodiode PD receives the broadcast message of two or more LED illuminating lamps simultaneously, by scene that camera is clapped and photodiode PD received each LED illuminating lamp issued light power different to come image that camera and photodiode PD are received and positional information to carry out corresponding one by one, and a LED illuminating lamp following the tracks of the received power maximum carries out position correction;
Like this, in using the indoor environment of LED illuminating lamp as illuminator, just real-time high-accuracy position system can have been realized.
Advantage of the present invention is: do not need additionally to install transmitter, do not expend any frequency spectrum resource, avoid simultaneously the volume electromagnetic radiation.
Description of drawings
Fig. 1 is structural representation of the present invention.
Fig. 2 is that the relative position of camera and LED illuminating lamp calculates schematic diagram.
Fig. 3 is position fixing process process flow diagram of the present invention.
Fig. 4 is the theory diagram of emitter of the present invention.
Fig. 5 is the theory diagram of receiving trap of the present invention.
Embodiment
Below in conjunction with accompanying drawing the present invention is described in detail.
With reference to Fig. 1, a kind of indoor real-time high-precision positioning system, comprise emitter and receiving trap, emitter is comprised of LED illuminating lamp and driving circuit, the function of driving circuit is except the drive current that the LED illuminating lamp is provided, and the positional information that has also loaded the LED illuminating lamp is modulated, and the LED illuminating lamp is when realizing illumination functions, broadcast the positional information of self, utilizing CDMA multiplexing to distinguish between the adjacent LED illuminating lamp.
Receiving trap comprises hand-held receiving terminal, the sensor of hand-held receiving terminal has two kinds, and a kind of is camera, and another kind is photodiode PD, the effect of photodiode PD is to receive the positional information that the LED illuminating lamp is broadcasted, the absolute position that obtains the LED illuminating lamp; The effect of camera is the scene image to the photographs lamp, to calculate the relative position of receiving terminal and LED illuminating lamp.
The relative position of described camera and LED illuminating lamp calculates, need three parameters: the height of the height of indoor ceiling, hand-held receiving terminal and the direction of receiving terminal are pointed to, wherein the elevation information of indoor ceiling is preset in the indoor scene map, the height of hand-held receiving terminal is then estimated by the input height information, the direction of hand-held receiving terminal is pointed to, and then determines according to the hand-held built-in magnetic compass of receiving terminal, concerns according to geometric projection, as shown in Figure 2
Add from the direction sensing of the hand-held receiving terminal of magnetic compass extraction, just can get terminal for the relative position of LED illuminating lamp.
The field angle of described camera is greater than the field of view of receiver angle of photodiode PD.
The process of the present invention location is: as shown in Figure 3, hand-held receiving terminal is downloaded the map of place indoor scene, and this process can be passed through the LED illuminating lamp broadcasting of fixed point, is received by photodiode PD and downloads; Hand-held receiving terminal flush end up, the location is begun by the positional information that photodiode PD receives first LED illuminating lamp, calculated simultaneously the relative position of hand-held receiving terminal and LED illuminating lamp by camera, so add hand-held receiving terminal and LED illuminating lamp relative position by LED illuminating lamp absolute position, just obtain the particular location of hand-held receiving terminal, and be presented in real time in the indoor scene map.
Because the attribute of device itself, the field angle of camera is greater than the field of view of receiver angle of photodiode PD, so, when photodiode PD walks out the broadcasting area of first LED illuminating lamp, hand-held receiving terminal continues to follow the tracks of first LED illuminating lamp by camera and positions, until photodiode PD receives till the broadcasting of next second LED illuminating lamp, camera begins to follow the tracks of second LED illuminating lamp and carries out the relative position calibration afterwards.
When photodiode PD receives the broadcast message of two or more LED illuminating lamps simultaneously, by scene that camera is clapped and photodiode PD received each LED illuminating lamp issued light power different to come image that camera and photodiode PD are received and positional information to carry out corresponding one by one, and a LED illuminating lamp following the tracks of the received power maximum carries out position correction.
Like this, in using the indoor environment of LED illuminating lamp as illuminator, just real-time high-accuracy position system can have been realized.
Referring to Fig. 4, emitter comprises CPU (central processing unit), power module, WIFI module, driving circuit, LED lamp, control center is transferred to location service information by WIFI the WIFI module of transmitting terminal, the WIFI module passes to CPU (central processing unit) with information, CPU (central processing unit) is responsible for information is encoded, and signal is modulated on the LED illuminating lamp via driving circuit broadcasts away by spatial light.
Referring to Fig. 5, receiving trap comprises the assemblies such as CPU (central processing unit), power module, photodiode PD, self-adaptation amplifying circuit, camera and display, photodiode PD receives the spatial light broadcast message of LED illuminating lamp, via the self-adaptation amplifying circuit signal is passed to CPU (central processing unit), simultaneously, camera passes to CPU (central processing unit) with the illumination image of LED illuminating lamp, CPU (central processing unit) is decoded the signal that PD receives, the image that simultaneously camera is received is processed, and the positional information of clearing place is presented in the display in real time.