Disclosure of Invention
Aiming at the problems in the prior art, the invention provides a system and a method for positioning a microsatellite base station based on a single or a plurality of Bluetooth transmitting units.
The invention is realized in such a way that a single or multiple Bluetooth transmitting units based microsatellite base station positioning system comprises:
at least one microsatellite base station which is arranged on a fixed point with known coordinates and is used for transmitting information used for positioning, wherein the information comprises but is not limited to identification codes, coordinates, floors, room numbers, signal propagation parameters and telegraph information of working modes of the microsatellite base station;
a microsatellite base station positioning system on the user equipment; the system is connected with the microsatellite base station through wireless signals and is used for receiving signals of the microsatellite base station and analyzing the obtained telegraph text information and calculating the one-dimensional, two-dimensional or three-dimensional coordinates of the microsatellite base station.
Further, the coordinates also comprise a WGS84 coordinate, a CGCS2000 coordinate, an independent coordinate system coordinate, an indoor coordinate system coordinate and an encrypted coordinate system coordinate; a plurality of microsatellite base stations form an ad hoc network system.
Furthermore, the microsatellite base station consists of one or more Bluetooth units and a Micro Control Unit (MCU);
each Bluetooth unit consists of a Bluetooth chip, a Bluetooth signal antenna and a peripheral circuit; the Bluetooth units are arranged according to a certain geometric configuration to improve the quality of Bluetooth signals;
all the Bluetooth units are connected with the MCU; wherein, part of the Bluetooth units are used for transmitting Bluetooth signals, and the other part of the Bluetooth units are used for receiving the Bluetooth signals; and the micro control unit MCU is responsible for controlling each Bluetooth unit to work.
Furthermore, a microsatellite base station positioning system on the user equipment comprises a user terminal, and real-time positioning is realized by analyzing the message information and measuring the distance to the microsatellite base station; the user terminal can obtain the information for positioning only by scanning the Bluetooth signal without pairing and linking with the microsatellite base station;
the user terminal obtains high-precision and high-reliability distance measurement values through a data processing strategy by receiving signal strength values RSSI of a plurality of Bluetooth transmitters of the same microsatellite base station;
the positioning operation mode of the user terminal includes, but is not limited to, obtaining a spatial three-dimensional coordinate, a horizontal plane two-dimensional coordinate, a vertical plane two-dimensional coordinate, a one-dimensional coordinate, mileage information, floor information, and a room number.
Further, the user terminal scans a plurality of Bluetooth modules and performs measurement data calculation processing; the user terminal includes, but is not limited to, a smart phone, a bracelet, a tracker, an embedded module, a smart robot, and an industrial sensor device.
Another objective of the present invention is to provide a method for positioning a pico base station based on one or more bluetooth transmitting units, which specifically includes:
uniformly selecting the mounting points of the microsatellite base station in a service area according to a certain density; the installation density is calculated according to the effective distance of the microsatellite base station; for three-dimensional positioning, any area in a service area can receive signals of three or more than three microsatellite base stations; the installation points are distributed in the whole service area; in the corridor and the strip-shaped area of the corridor, the microsatellite base stations are prevented from being arranged on the same straight line or the similar straight line, so that the deployment of the microsatellite base stations has good geometric strength;
step two, injecting relevant information of the microsatellite base station concerned by the user terminal into the microsatellite base station; numbering the microsatellite base stations to be installed in the whole service area one by one, coding and encrypting the numbering, the coordinates, the floors and other related information of the microsatellite base stations and the signal correction parameters, and injecting the coded and encrypted information into the microsatellite base stations; when the microsatellite base station works, the written information can be broadcasted to the user terminal in a telegraph text form; when the number of the microsatellite base stations is large, the spatial topology analysis is needed to ensure that two microsatellite base stations with the same number are not in the same working area during the layout;
step three, installing the microsatellite base stations to the specified positions one by one, and starting the microsatellite base stations; in the installation process, the spatial position of the micro-satellite base station to be installed is in one-to-one correspondence with the information injected in the step two; after starting the microsatellite base station, checking whether the signal of the microsatellite base station works normally and whether the content of the broadcast message is correct;
step four, the user terminal starts a Bluetooth receiving function and can scan and obtain signals transmitted by the microsatellite base station; starting a microsatellite base station positioning service, automatically acquiring the received microsatellite base station information, and demodulating the text content;
step five, the microsatellite base station positioning service running at the user terminal can acquire the signal strength RSSI transmitted by each microsatellite base station in real time, demodulate the position of the microsatellite base station and other related information contained in the telegraph text, extract stable and reliable geometric distance information from the received signals by a proper signal processing and filtering method, and determine the position of the user terminal by a geometric method;
and sixthly, coordinates obtained by calculation of the microsatellite base station positioning service running on the user terminal are matched with an indoor map through a system API, so that indoor navigation, positioning, tracking, track display and monitoring are realized.
Further, in the first step, the geometric strength of the microsatellite base station is evaluated by a positioning precision attenuation factor PDOP; the positioning accuracy attenuation factor defines an observation matrix A:
in the formula [ x, y, z]For the user position, [ x ]
i,y
i,z
i]Is the location of the ith microsatellite base station, ρ
iFor the geometric distance between the user position and the ith microsatellite base station
n is the number of visible microsatellite base stations at the user position;
defining a co-factor from the observation matrix for Q ═ AT*A)-1Wherein the operator represents a matrix multiplication, the operator (·)TRepresenting a matrix transpose operation, operator (·)-1Representing a matrix inversion operation;
the calculated Q matrix is a 3 x 3 square matrix and PDOP can be calculated by:
in the formula qijElements representing the ith row and the jth column of the Q matrix; the larger the PDOP is, the poorer the geometric configuration strength of the microsatellite base station is; in the stage of selecting the installing point of the microsatellite base station, whether the installing point of the microsatellite base station is reasonable or not is determined by calculating the PDOP value of each network point in the service area; for the two-dimensional positioning, the calculation method can be subjected to dimension reduction;
after the mounting points of the microsatellite base station are selected, measuring the coordinates of the mounting points one by one; the coordinates of each installation point are ensured to be under the same set of coordinate system, and the coordinate system is a room coordinate system, a local coordinate system of a building coordinate system or global coordinate system coordinates; the method for obtaining the global coordinate system coordinates of the indoor micro satellite base station mounting point comprises the following steps:
a method of relative positioning measurement; the global coordinate system coordinates of one or more outdoor mark points are obtained by using a GNSS method, the relative positions of an indoor target point and the outdoor mark points are measured by a total station, a theodolite and a laser range finder, and then the global coordinate system coordinates of the indoor mark points are calculated;
a method of local coordinate system transformation; measuring global coordinate systems of three or more building feature points by using a GNSS means according to the relative position relation of a local coordinate system with a design drawing in a service area, and solving conversion parameters between two sets of coordinate systems by using the global coordinates and the local coordinates of the feature points; the local coordinate system coordinates are all converted into global coordinate system coordinates by using the conversion parameters.
Further, stable and reliable geometric distance information is extracted from the received signals through a signal processing and filtering method, and the position of the user terminal is determined by using a geometric method; the geometric distance from the user to the microsatellite base station is expanded by Taylor series and is expressed as:
where rho0The approximate geometric distance of the user equipment, namely the microsatellite base station, wherein epsilon is a nonlinear error; [ x ] ofi,yi,zi]Is the coordinate of the ith microsatellite base station, [ dx, dy, dz]Is the increment of the user's coordinates; neglecting the non-linear error term of the above formula, the above formula is expressed as:
considering the case of multiple microsatellite base stations, the linearization system is represented as:
E(y)≈Ax;
least squares solution of the linearized system
Wherein
Estimating to obtain a user coordinate increment, wherein P is a weight matrix; after the coordinate increment is obtained, updating the approximate coordinates, and recalculating the coordinate increment until the calculated coordinate increment is small enough;
when the user approximate coordinates are unknown during first positioning, an outdoor GNSS positioning result is used as the initial approximate coordinates, or the initial coordinates are set in a mode of adding a random offset to the coordinates of a certain base station; the least square method is used for initializing the filter, and the extended Kalman filtering EKF is used for subsequent navigation positioning calculation; for most indoor positioning scenes, an EKF (extended Kalman Filter) simulates the coordinate movement state of a user terminal by using a random walk model, and an extended Kalman filter model is expressed as follows:
and (3) time updating:
Qkis a process noise matrix of epoch k, which is adjusted according to the movement velocity of the user equipment;
Kkis a filter gain matrix of epoch k, RkAnd obtaining updated user terminal position information after filtering is finished.
The invention has the advantages and positive effects that:
the invention provides a low-cost indoor positioning scheme, and the microsatellite base station has low cost and convenient deployment and does not need precise time synchronization.
The invention can obtain the precision equivalent to the outdoor positioning by using the public mobile phone without changing the habit of the user.
The invention can realize seamless butt joint of indoor and outdoor positioning and improve the user experience of indoor positioning.
According to the invention, the accuracy, stability and reliability of Bluetooth signal distance measurement are improved in a manner of cooperative work of a plurality of Bluetooth units, and the positioning performance of Bluetooth signals is improved.
The micro-satellite base station has low power consumption, convenient deployment, no need of external network cables, optical fibers and the like, and low maintenance cost. One-dimensional, two-dimensional and three-dimensional positioning can be realized according to indoor scenes, and the method has good environmental adaptability and expandability.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is further described in detail with reference to the following embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
The application of the principles of the present invention will be further described with reference to the accompanying drawings and specific embodiments.
As shown in fig. 1, the positioning system of a microsatellite base station based on a single or multiple bluetooth transmitting units provided by the embodiment of the present invention comprises two parts, namely a microsatellite base station 1 and a microsatellite base station positioning system 2 operating on user equipment;
the system operation requires the deployment of two or more microsatellite base stations 1 mounted on fixed points with known coordinates.
The microsatellite base station positioning system 2 on the user equipment calculates the one-dimensional, two-dimensional or three-dimensional coordinates of the user equipment by receiving the signals of the microsatellite base station and analyzing the obtained message information.
If the one-dimensional or two-dimensional coordinates of the user need to be calculated, at least two microsatellite base stations are needed; if the three-dimensional coordinates of the user need to be calculated, at least three microsatellite base stations are needed. The single microsatellite base station 1 has the bluetooth signal transmitting and receiving function by itself. The bluetooth module inside the microsatellite base station 1 performs link and signal transmission control between modules through a Microcontroller (MCU). And the micro satellite base station 1 and the base station have the functions of mutual transmission and networking of signals.
The electric principle of the microsatellite base station related by the invention is shown in figure 2, and the microsatellite base station related by the invention consists of one or more Bluetooth units and a micro control unit. Each Bluetooth unit consists of a Bluetooth chip, a Bluetooth signal antenna and a peripheral circuit. The Bluetooth units are arranged according to a certain geometric configuration to improve the quality of Bluetooth signals. All bluetooth units are connected to a Micro Control Unit (MCU). Wherein, a part of the Bluetooth units are used for transmitting Bluetooth signals, and the other part of the Bluetooth units are used for receiving the Bluetooth signals. The MCU is responsible for controlling each Bluetooth unit to work. The whole micro-satellite base station has the functions of ad hoc network and signal transmission.
The logic function structure of the microsatellite base station related by the invention is shown in figure 3. Each bluetooth unit is responsible for independent bluetooth signal transmission or reception, and the whole micro-satellite base station may comprise one or more bluetooth units for independently transmitting/receiving bluetooth signals. All bluetooth units are controlled by a Micro Control Unit (MCU). The micro control unit (the micro star base station management module) mainly completes four aspects of work: (1) managing the Bluetooth unit, including controlling the Bluetooth unit to work, realizing the E-mail of the Bluetooth unit, and the like; (2) the message coding and encryption work, and the MCU codes and encrypts the message to be broadcasted by the microsatellite base station according to a certain rule and a certain data protocol, so that the message is ensured to be correctly and reliably transmitted to the user equipment. (3) Monitoring the health state of each Bluetooth unit, wherein the MCU masters the working condition of each Bluetooth unit through communication with each Bluetooth unit, and monitors the working states of other surrounding microsatellite base stations and Bluetooth signal calibration through the Bluetooth receiving unit; (4) and a system administrator sends commands to the micro star base station through communication with the MCU to realize configuration, control, query of working states and the like of the micro star base station. The software and hardware of the microsatellite base station form a service end of the whole positioning system, and the user terminal is mobile equipment such as a smart phone and the like which runs the microsatellite base station positioning service software.
As shown in fig. 4, the method for positioning a microsatellite base station based on one or more bluetooth transmitting units provided by the embodiment of the present invention specifically includes:
s101: uniformly selecting the installing points of the microsatellite base station in a service area according to a certain density; the installation density is calculated according to the effective distance of the microsatellite base station; for three-dimensional positioning, any area in a service area can receive signals of three or more than three microsatellite base stations; the installation points are distributed in the whole service area; in the corridor and the strip-shaped area of the corridor, the microsatellite base stations are prevented from being arranged on the same straight line or the similar straight line, so that the deployment of the microsatellite base stations has good geometric strength;
s102: injecting relevant information of the microsatellite base station concerned by the user terminal into the microsatellite base station; numbering the microsatellite base stations to be installed in the whole service area one by one, coding and encrypting the numbering, the coordinates, the floors and other related information of the microsatellite base stations and the signal correction parameters, and injecting the coded and encrypted information into the microsatellite base stations; when the microsatellite base station works, the written information can be broadcasted to the user terminal in a telegraph text form; when the number of the microsatellite base stations is large, the spatial topology analysis is needed to ensure that two microsatellite base stations with the same number are not in the same working area during the layout;
s103: installing the microsatellite base stations to a specified position one by one, and starting the microsatellite base stations; in the installation process, the information injected in the space position S102 for installing the microsatellite base station is kept in one-to-one correspondence; after starting the microsatellite base station, checking whether the signal of the microsatellite base station works normally and whether the content of the broadcast message is correct;
s104: the user terminal starts a Bluetooth receiving function and can scan and obtain signals transmitted by the microsatellite base station; starting a microsatellite base station positioning service, automatically acquiring the received microsatellite base station information, and demodulating the text content;
s105: the method comprises the steps that a microsatellite base station positioning service running at a user terminal can acquire the signal strength RSSI transmitted by each microsatellite base station in real time, demodulate the position of the microsatellite base station and other related information contained in a message, extract stable and reliable geometric distance information from received signals through a proper signal processing and filtering method, and determine the position of the user terminal by using a geometric method;
s106: coordinates obtained by calculation of the microsatellite base station positioning service running on the user terminal are matched with an indoor map through a system API, so that indoor navigation, positioning, tracking, track display and monitoring are realized.
The application of the principles of the present invention will now be described in further detail with reference to specific embodiments.
In the method for positioning the microsatellite base station based on the single or the plurality of Bluetooth transmitting units provided by the embodiment of the invention,
1) the micro-satellite base station installation points are uniformly selected as much as possible in the service area of the system according to a certain density. The installation density is calculated according to the effective distance of the micro-satellite base stations, for the three-dimensional positioning, any area in the service area can be ensured to receive signals of three or more micro-satellite base stations, and the installation points are distributed in the whole service area as far as possible. In the corridor, the corridor and other strip-shaped areas, the situation that the microsatellite base stations are arranged on the same straight line or the similar same straight line is avoided, and the deployment of the microsatellite base stations is ensured to have better geometric strength. The geometry strength of the microsatellite base station can be evaluated by a positioning accuracy degradation factor (PDOP). The geometric dilution of precision factor may define an observation matrix a:
in the formula [ x, y, z]For the user position, [ x ]
i,y
i,z
i]Is the location of the ith microsatellite base station, ρ
iFor the geometric distance between the user position and the ith microsatellite base station
n is the number of visible microsatellite base stations at the user position. The co-factor can be defined according to the observation matrix as Q ═ A
T*A)
-1Wherein the operator represents a matrix multiplication, the operator (·)
TRepresenting a matrix transpose operation, operator (·)
-1Representing a matrix inversion operation. The calculated Q matrix is a 3 x 3 square matrix and PDOP can be calculated by:
in the formula qijThe elements of the ith row and the jth column of the Q matrix are represented. The larger the PDOP, the less robust the microsatellite base station geometry is considered. In the stage of selecting the installing point of the micro-satellite base station, whether the installing point of the micro-satellite base station is reasonable or not can be determined by calculating the PDOP value of each network point in the service area. For the case of two-dimensional positioning, dimension reduction processing can be performed on the calculation method, and the calculation process is similar.
After the mounting points of the microsatellite base station are selected, the coordinates of the mounting points are measured one by one. The coordinates of each installation point are ensured to be under the same coordinate system, which can be a local coordinate system such as a room coordinate system, a building coordinate system and the like, and can also be global coordinate system coordinates, such as a WGS84 coordinate system, a CGCS2000 coordinate system and the like. The global coordinate system is used as a precondition for realizing indoor and outdoor seamless positioning, so that the global coordinate system has higher practical value. The method for obtaining the global coordinate system coordinates of the indoor micro satellite base station installation point comprises two methods:
(1) the global coordinate system coordinates of one or more outdoor mark points are obtained by using a GNSS positioning method, the relative positions of an indoor target point and the outdoor mark points are measured by relative positioning means such as a total station, a theodolite, a laser range finder and other equipment, and then the global coordinate system coordinates of the indoor mark points are calculated. (2) A method of coordinate transformation using a local coordinate system map. If the service area has the relative position relation of local coordinate systems such as design drawings and the like, global coordinate systems of three or more than three building feature points can be measured by using a GNSS means, and conversion parameters between two sets of coordinate systems are solved by using the global coordinates and the local coordinates of the feature points. The local coordinate system coordinates can be completely converted into global coordinate system coordinates by using the conversion parameters. Therefore, the coordinates of the global coordinate system of the microsatellite base station can be obtained through conversion only by measuring the coordinates of the mounting point of the microsatellite base station in the local coordinate system.
2) And injecting the relevant information of the microsatellite base station concerned by the user equipment into the microsatellite base station. The method comprises the steps of numbering the microsatellite base stations required to be installed in the whole service area one by one, coding and encrypting other related information such as the number, coordinates, floors, signal correction parameters and the like of the microsatellite base stations, injecting the information into the microsatellite base stations, and broadcasting the written information to user terminal equipment in a telegraph text mode when the microsatellite base stations work. For an indoor positioning scene with a large area, a plurality of microsatellite base stations need to be arranged, and at the moment, the numbering of the microsatellite base stations needs to be specially processed, so that the numbering of the base stations is avoided from being repeated. The number of bits occupied by the microsatellite base station number is limited by the length of the text code. In a scene with more microsatellite base stations, base station numbering multiplexing is needed to realize large-scale base station cooperative work. When the micro-satellite base stations are distributed, the spatial topology analysis is needed to ensure that the two micro-satellite base stations with the same serial numbers are not in the same working area.
3) And installing the micro-satellite base stations to the designated positions one by one, and starting the micro-satellite base stations. In the installation process, the spatial position of the micro satellite base station to be installed is ensured to be in one-to-one correspondence with the information injected in the step 2). After the microsatellite base station is started, whether the signal of the microsatellite base station works normally or not and whether the content of the broadcast message is correct or not should be checked.
The positioning part of the user terminal analyzes the text content by receiving the signals of the microsatellite base station during the system operation and calculates the current position of the user equipment in real time. The user end equipment can be wearable equipment such as smart phones, bracelets, and can also be the sensor that has bluetooth communication and computing power. Whatever the hardware platform, the system should be pre-loaded with the microsatellite base station positioning service software. The user terminal location part also comprises three steps:
4) the user terminal starts a Bluetooth receiving function and starts a micro satellite base station positioning service. And starting a Bluetooth receiving function, wherein the user equipment can scan and obtain signals transmitted by the microsatellite base station, and start a microsatellite base station positioning service, and the service can automatically acquire the received microsatellite base station information and demodulate the text content.
5) The microsatellite base station positioning service running at the user terminal can acquire the signal strength (RSSI) transmitted by each microsatellite base station in real time, demodulate the position of the microsatellite base station and other related information contained in a message, extract stable and reliable geometric distance information from the received signals by a proper signal processing and filtering method, and determine the position of user equipment by a geometric method. The geometric distance from the user to the microsatellite base station can be expanded by a Taylor series and is expressed as:
where rho0The approximate geometric distance of the user equipment, namely the microsatellite base station, wherein epsilon is a nonlinear error; [ x ] ofi,yi,zi]Is the coordinate of the ith microsatellite base station, [ dx, dy, dz]Is the increment of the user's coordinates. Neglecting the non-linear error term of the above equation, the above equation can be expressed as:
considering the case of multiple microsatellite base stations, the linearization system can be expressed as:
E(y)≈Ax;
least squares solution of the linearized system
Wherein
The user coordinate increment is obtained by estimation, and P is a weight matrix. After the coordinate increment is obtained, the approximate coordinates are updated, and the coordinate increment is recalculated until the calculated coordinate increment is small enough. When the user approximate coordinates are unknown during the first positioning, the initial coordinates can be set in a mode of adding a random offset to the coordinates of a certain base station. The least squares method is typically used only to initialize the filter, and subsequent navigation fix calculations typically use Extended Kalman Filtering (EKF). For most indoor positioning scenarios, the EKF may use a random walk model to simulate the ue coordinate movement state, and the extended kalman filter model may be expressed as follows:
and (3) time updating:
Qkis a process noise matrix for epoch k, which may be adjusted according to the velocity of motion of the user equipment.
KkIs a filter gain matrix of epoch k, RkAnd obtaining updated user equipment position information after filtering is finished.
6) The coordinates obtained by calculation of the microsatellite base station positioning service running on the user terminal are provided for other application programs through a system API or other modes, and are matched with an indoor map. The monitoring and tracking function is realized by the user equipment transmitting the positioning result back to the central server through a certain data communication mode, such as Wi-Fi, Bluetooth, cellular network, etc., so as to realize the application functions of positioning, navigation, monitoring, etc.
In the microsatellite base station positioning system based on a single or a plurality of Bluetooth transmitting units provided by the embodiment of the invention, each microsatellite base station consists of a single or a plurality of Bluetooth transmitters working simultaneously and a plurality of Bluetooth receivers, two or more than two microsatellite base stations are used as positioning signal sources to broadcast the position and related information of the microsatellite base station to a user terminal, and the user terminal realizes a real-time positioning function by analyzing message information and measuring the distance to the microsatellite base station.
The positioning system has the function of being obtained by starting up, has a similar part with the outdoor GNSS positioning process, but has different distance measurement technologies. When the user is positioned, the outdoor GNSS positioning system can be directly connected without knowing any information (such as a fingerprint library) of the positioning environment in advance, and the indoor and outdoor seamless positioning of the intelligent terminal is realized.
The microsatellite base station transmits message information for positioning to the user terminal, wherein the message content comprises but is not limited to identification codes, coordinates, floors, room numbers, signal propagation parameters, working modes and the like of the microsatellite base station.
The coordinate system of the coordinate information of the microsatellite base station transmitted to the user terminal comprises global coordinate system coordinates such as WGS84 coordinates and CGCS2000 coordinates, and also comprises independent coordinate system coordinates, indoor coordinate system coordinates, encrypted coordinate system coordinates and the like.
The user terminal can obtain the information for positioning only by scanning the Bluetooth signal without pairing link.
The user terminal can obtain high-precision and high-reliability distance measurement values through a data processing strategy by receiving signal strength values (RSSI) of a plurality of Bluetooth transmitters of the same microsatellite base station.
The positioning operation mode of the user terminal includes, but is not limited to, obtaining a three-dimensional coordinate of a space, a two-dimensional coordinate of a horizontal plane, a two-dimensional coordinate of a vertical plane, a one-dimensional coordinate, mileage information, floor information, a room number, and the like.
The user terminal has the capability of scanning a plurality of Bluetooth devices and the capability of computing and processing measurement data, and comprises wearable devices such as a smart phone, a bracelet and a tracker, and industrial sensor devices such as an embedded module, an intelligent robot and a device sensor.
The positioning system composed of two or more than two micro-satellite base stations has an automatic networking function, and the micro-satellite base stations have automatic signal calibration and communication functions.
The above description is only for the purpose of illustrating the preferred embodiments of the present invention and is not to be construed as limiting the invention, and any modifications, equivalents and improvements made within the spirit and principle of the present invention are intended to be included within the scope of the present invention.