阅读说明：本技术 基于阵列调频连续波和传感算法的厂线用定位系统 (Positioning system for factory line based on array frequency modulation continuous wave and sensing algorithm ) 是由 陈科锦 汪子元 于 2019-09-30 设计创作，主要内容包括：本发明公开了一种基于阵列调频连续波和传感算法的厂线用定位系统,包括3D模型构建单元、移动设备、无线充电单元等,移动设备包括传感设备,3D模型构建单元内有收发器；在空间内布置3D模型构建单元,移动设备设于被测物体上；在空间出入口布置无线充电单元,将其所在位置作为传感数据采集起点；收发器进行单发多收逐一循环,对发射信号进行调频,接收器接收反射信号并记录原始数据形成3D Matlab图像元素矩阵；采集传感数据完成惯性位移计算和轨迹形成；3D建模,通过位移轨迹纠正偏移形成物体位置和状态,完成GUI图像呈现。本发明可满足在工厂产线、大型仓储等场所的智能化高效定位需求,定位精准可靠,可实现大规模商用。(The invention discloses a positioning system for a factory line based on array frequency modulation continuous wave and a sensing algorithm, which comprises a 3D model building unit, mobile equipment, a wireless charging unit and the like, wherein the mobile equipment comprises the sensing equipment, and a transceiver is arranged in the 3D model building unit; arranging a 3D model building unit in a space, and arranging mobile equipment on a measured object; arranging a wireless charging unit at an entrance and an exit of the space, and taking the position of the wireless charging unit as a sensing data acquisition starting point; the transceiver performs single-transmission and multi-reception circulation one by one, the frequency modulation is performed on the transmission signals, and the receiver receives the reflection signals and records the original data to form a 3D Matlab image element matrix; collecting sensing data to complete inertial displacement calculation and track formation; and 3D modeling, namely correcting the offset through the displacement track to form the position and the state of the object, and finishing GUI image presentation. The invention can meet the intelligent and efficient positioning requirements in places such as factory production lines, large-scale storage and the like, has accurate and reliable positioning and can realize large-scale commercial use.)

1. A positioning system for a factory line based on array frequency modulation continuous wave and a sensing algorithm is characterized by comprising a 3D model building unit, mobile equipment, a wireless charging unit and an MCU (microprogrammed control unit), wherein an accelerometer, a gyroscope and a geomagnetic sensor are arranged on the mobile equipment, and a transceiver is arranged in the 3D model building unit; arranging the 3D model building unit in a space according to the space height and the space plane area, wherein the mobile device is arranged on a measured object; arranging the wireless charging unit at an entrance and an exit of a space, and taking the position of the wireless charging unit as a sensing data acquisition starting point; the transceiver performs single-transmission and multi-reception circulation one by one, frequency modulation is performed on the transmitted signals, and a receiver in the transceiver receives all the reflected signals and records original data to form a 3D Matlab image element matrix; when the object to be measured moves, acquiring data of an accelerometer, a gyroscope and a geomagnetic sensor and uploading the data to the MCU to complete inertial displacement calculation and track formation; and forming 3D modeling according to the reflection signal data matrix, correcting the offset through the displacement track, and finally forming the position and the state of the object to finish GUI image presentation.

2. The array frequency modulated continuous wave and sensing algorithm based plant line positioning system according to claim 1, wherein the layout 3D model building unit comprises:

according to the space height x, calculating the radius covered by each 3D model building unit as

And performing region segmentation on the space plane according to the area of the space plane and the signal coverage area Z of each 3D model building unit, and arranging the 3D model building unit at the top of the central point of each region.

3. The array frequency modulated continuous wave and sensing algorithm based location system for a plant line as claimed in claim 1, wherein the wireless charging unit is disposed at an entrance of a space, wherein the space comprises a plurality of entrances and exits, and the wireless charging unit is disposed at each entrance and exit and is configured with location information.

4. The array frequency modulated continuous wave and sensing algorithm based factory line positioning system of claim 1, wherein the forming of the 3D Matlab image element matrix comprises:

48 integrated radio frequency transceivers are arranged in each 3D model building unit and are respectively an RF₀～RF₄₇When RF₀RF at transmission₁～RF₄₇Receive when RF₁RF at transmission₀、RF₂～RF₄₇Receiving, and circulating one by one;

each radio frequency transceiver continuously transmits n signals once, the signals are transmitted from low to high within the frequency range of 77-81 GHz, and the frequency increment of each transmission is dHz:

the reflected signals received by the receiver in the radio frequency transceiver are stored using a complex matrix.

5. The array frequency modulated continuous wave and sensing algorithm based plant line positioning system of claim 1, wherein the inertial displacement trajectory calculation comprises:

calculating the step length and the direction of the operation of the personnel according to the acquired acceleration, angular velocity and magnetic force data, and calculating the position of the next moment;

suppose a previous time T₀Position P₀(X₀,Y₀) At a later time T₁Is in the position P₁(X₁,Y₁) The direction of this time is theta₀Step length of d₀Then, the two time position relations are:

X₁＝X₀+d₀·sin(θ₀)

Y₁＝Y₀+d₀·cos(θ₀)

if the position at the nth time is P_nThen P is_nAnd P₀The position relation of (1) is as follows:

marking the position of the ith time as X according to X, Y, T three elements_i、Y_i、T_i。

6. The array frequency modulated continuous wave and sensing algorithm based plant line positioning system of claim 1, wherein said forming a final object position and state comprises:

performing algorithm analysis and modeling on the data information of the reflected signals, constructing a plurality of target object objects, and marking the object objects at simple positions X, Y, Z, T, wherein Z is the height of the highest position of the object, and T is a timestamp;

forming a track L1 according to X, Y, Z, T queues submitted by the 3D model building unit, and forming a track L2 according to X, Y, T queues;

and performing an optimized autoregressive data algorithm on the same timestamp T according to linear filtering and a prediction theory by taking the trajectory L1 as prediction method data and the trajectory L2 as observation method data to complete filtering, so as to form a final position trajectory L.

7. The array frequency modulated continuous wave and sensing algorithm based plant line positioning system of claim 6, wherein the optimized autoregressive data algorithm is:

p＝p+Q

p on the right side of the equal sign is the covariance of the optimal position deviation at the last moment, the initial value is 1, Q is the covariance of the L1 track position at the last moment, and the left side of the equal sign is the obtained prediction covariance at the moment;

k＝p/(p+R)

r is covariance calculated by the observed value of the L2 track position, and k is obtained gain;

x＝x+k*(S-x)

x on the right side of the equal sign is the track position value L1 at the moment, S is the track position value L2 at the moment, and x on the left side of the equal sign is the optimized position at the moment;

p＝(1-k)*p

the covariance of the optimum position deviation at this time is updated, and then calculation of the next time is continued.

Technical Field

The invention belongs to the field of positioning in large-scale equipment and laboratory environments, and particularly relates to a factory-line positioning system based on array frequency modulation continuous waves and a sensing algorithm.

Background

With the continuous maturity and updating of the internet of things technology, various internet of things application scenes are popularized and applied, the positioning function related to safety exerts greater and greater effects, and various positioning systems are also continuously released. The positioning systems on the market at present mainly comprise the following systems, wherein the first system is a global satellite positioning system (GNSS), which is a standard on a smart phone and supports satellite systems such as Beidou (China), GPS (American), GLONASS (Russia), Galileo (European Union) and the like, and provides accurate technical support for outdoor positioning; the second type is a positioning system based on wireless RSSI, which comprises WIFI and BT, wherein the WIFI/BT is also integrated as the most universal communication module on a smart phone and various smart terminals, and the positioning system also provides technical realization for positioning articles based on the WIFI RSSI and the BTiBeacon; the third is a space perception positioning system based on MIMO-OFDM WIFI, and analysis positioning and the like are carried out through CSI information; and the personnel positioning detection is realized based on technologies such as Zigbee and RFID. However, there are very significant limitations to achieving positioning in large factories, warehouses, laboratories and the like with large metal equipment and instruments based on these existing positioning systems: the satellite positioning system almost loses the function in the building due to the shielding of signals; because of the spatial attenuation characteristics and many interference source factors of the positioning system based on the wireless RSSI, including shielding of large metal, interference of surrounding wireless equipment and the like, the positioning accuracy is very limited unless high-density network distribution is performed to avoid all shielding and interference sources, and certainly, high-cost investment is brought; however, the spatial awareness positioning of the WIFI CSI information is firstly based on the interface opening of a functional chip factory, at present, few chip factories open information data of the layer, and only synthesized RSSI values are provided for an application layer, although a part of interface APIs are selectively opened on ieee802.11ad/ay chips by a chip factory, the chip factory is expensive, and the CSI-based spatial awareness technology is more focused on the existence or nonexistence, and the positioning function is far from becoming mature to a commercial stage in algorithm. Patent CN102063600A discloses a positioning system of mill, including equipment and positioner, equipment is used for responding to the carrier signal of fixed frequency, encode into the carrier signal transmission with the ID modulation of this equipment, positioner is used for transmitting the carrier signal of fixed frequency, receive the carrier signal that its signal coverage internal equipment returned, this carrier signal is decoded in the modulation, obtain the ID that this equipment corresponds, confirm the position of this equipment on the equipment arrangement drawing, be the current position and the display of this positioner promptly, above-mentioned patent technical scheme system design is too simple, can't satisfy the demand. Therefore, depending on the existing positioning system, there is a technical limitation or a problem of an excessively high cost in realizing indoor positioning in a large-scale factory, a warehouse, a laboratory, or the like. With the continuous improvement of intelligent management, the positioning requirements in places such as factory production lines, large-scale warehouses, laboratories and the like are more and more urgent, and how to realize a set of accurate and effective positioning system in the places is a problem to be solved urgently.

Disclosure of Invention

In view of the above, the present invention provides a positioning system for a plant line based on an array frequency modulated continuous wave and a sensing algorithm, so as to solve the deficiencies in the prior art.

In order to achieve the purpose, the invention is realized by the following technical scheme:

the positioning system for the plant line based on the array frequency modulation continuous wave and the sensing algorithm is provided, and comprises a 3D model building unit, mobile equipment, a wireless charging unit and an MCU (microprogrammed control unit), wherein the mobile equipment is provided with an accelerometer, a gyroscope and a geomagnetic sensor, and a transceiver is arranged in the 3D model building unit; arranging the 3D model building unit in a space according to the space height and the space plane area, wherein the mobile device is arranged on a measured object; arranging the wireless charging unit at an entrance and an exit of a space, and taking the position of the wireless charging unit as a sensing data acquisition starting point; the transceiver performs single-transmission and multi-reception circulation one by one, frequency modulation is performed on the transmitted signals, and a receiver in the transceiver receives all the reflected signals and records original data to form a 3D Matlab image element matrix; when the object to be measured moves, acquiring data of an accelerometer, a gyroscope and a geomagnetic sensor and uploading the data to the MCU to complete inertial displacement calculation and track formation; and forming 3D modeling according to the reflection signal data matrix, correcting the offset through the displacement track, and finally forming the position and the state of the object to finish GUI image presentation.

The above positioning system for a plant line based on array frequency modulation continuous wave and sensing algorithm, wherein the 3D model building unit includes:

according to the space height x, calculating the radius covered by each 3D model building unit asThe area A of the circular signal coverage area Z is pi r²；

And performing region segmentation on the space plane according to the area of the space plane and the signal coverage area Z of each 3D model building unit, and arranging the 3D model building unit at the top of the central point of each region.

The positioning system for the plant line based on the array frequency modulation continuous wave and the sensing algorithm is characterized in that wireless charging units are arranged at entrances and exits of a space, the space comprises a plurality of entrances and exits, and the wireless charging units are arranged at each entrance and exit and are configured with position information.

The above positioning system for a plant line based on array frequency modulation continuous wave and sensing algorithm, wherein the forming of the 3D Matlab image element matrix includes:

48 integrated radio frequency transceivers are arranged in each 3D model building unit and are respectively an RF₀～RF₄₇When RF₀RF at transmission₁～RF₄₇Receive when RF₁RF at transmission₀、RF₂～RF₄₇Receiving, and circulating one by one;

each radio frequency transceiver continuously transmits n signals once, the signals are transmitted from low to high within the frequency range of 77-81 GHz, and the frequency increment of each transmission is dHz:

the reflected signals received by the receiver in the radio frequency transceiver are stored using a complex matrix.

The above positioning system for a plant line based on array frequency modulation continuous wave and sensing algorithm, wherein the inertial displacement trajectory calculation includes:

calculating the step length and the direction of the operation of the personnel according to the acquired acceleration, angular velocity and magnetic force data, and calculating the position of the next moment;

suppose a previous time T₀Position P₀(X₀,Y₀) At a later time T₁Is in the position P₁(X₁,Y₁) The direction of this time is theta₀Step length of d₀Then, the two time position relations are:

X₁＝X₀+d₀·sin(θ₀)

Y₁＝Y₀+d₀·cos(θ₀)

if the position at the nth time is P_nThen P is_nAnd P₀The position relation of (1) is as follows:

marking the position of the ith time as X according to X, Y, T three elements_i、Y_i、T_i。

The above positioning system for a plant line based on array frequency modulated continuous wave and sensing algorithm, wherein the forming of the final object position and state includes:

performing algorithm analysis and modeling on the data information of the reflected signals, constructing a plurality of target object objects, and marking the object objects at simple positions X, Y, Z, T, wherein Z is the height of the highest position of the object, and T is a timestamp;

forming a track L1 according to X, Y, Z, T queues submitted by the 3D model building unit, and forming a track L2 according to X, Y, T queues;

and performing an optimized autoregressive data algorithm on the same timestamp T according to linear filtering and a prediction theory by taking the trajectory L1 as prediction method data and the trajectory L2 as observation method data to complete filtering, so as to form a final position trajectory L.

The positioning system for the plant line based on the array frequency modulation continuous wave and the sensing algorithm is characterized in that the optimized autoregressive data algorithm is as follows:

p＝p+Q

p on the right side of the equal sign is the covariance of the optimal position deviation at the last moment, the initial value is 1, Q is the covariance of the L1 track position at the last moment, and the left side of the equal sign is the obtained prediction covariance at the moment;

k＝p/(p+R)

r is covariance calculated by the observed value of the L2 track position, and k is obtained gain;

x＝x+k*(S-x)

x on the right side of the equal sign is the track position value L1 at the moment, S is the track position value L2 at the moment, and x on the left side of the equal sign is the optimized position at the moment;

p＝(1-k)*p

the covariance of the optimum position deviation at this time is updated, and then calculation of the next time is continued.

The technical scheme of the invention has the beneficial effects that:

the intelligent high-efficiency positioning device can meet the intelligent high-efficiency positioning requirements of places such as a factory production line, a large warehouse, a laboratory and the like, is accurate and reliable in positioning, and can realize large-scale commercial use.

Drawings

FIG. 1 is a schematic view of a positioning process of the positioning system of the present invention;

FIG. 2a and FIG. 2b are schematic diagrams of a method for calculating the perception area of each 3D modeling node unit according to the invention;

FIG. 3 is a schematic diagram of a method for obtaining location information based on sensed data according to the present invention;

FIG. 4 is a schematic diagram of trajectory fusion by an algorithm according to the present invention.

Detailed Description

The invention is further described with reference to the following drawings and specific examples, which are not intended to be limiting.

Referring to fig. 1, 2a, 2b, 3 and 4, the positioning system for a plant line based on an array frequency modulation continuous wave and a sensing algorithm according to the present invention includes a 3D model building unit, a mobile device, a wireless charging unit and an MCU, wherein the mobile device is provided with an accelerometer, a gyroscope and a geomagnetic sensor, and the 3D model building unit is provided with a transceiver inside.

The specific positioning process comprises the following steps:

s1, arranging a 3D model building unit in a space according to space height and space plane area, supporting wireless charging by mobile equipment, and arranging the mobile equipment on a measured object. Arranging a 3D model building unit comprising: according to the space height x, calculating the radius covered by each 3D model building unit as

The area A of the circular signal coverage area Z is pi r²(ii) a And performing region segmentation on the space plane according to the area of the space plane and the signal coverage area Z of each 3D model building unit, and arranging the 3D model building unit at the top of the central point of each region.

And S2, arranging a wireless charging unit at an entrance and an exit of the space, and taking the position of the wireless charging unit as a sensing data acquisition starting point. The space therein includes a plurality of entrances and exits, at each of which a wireless charging unit is disposed and location information is configured. A plurality of wireless transmitting modules are arranged in each wireless charging unit, and the charging transmitting modules start wireless charging and synchronize position information to the wireless charging receiving modules when sensing that the wireless receiving modules exist.

And S3, the transceiver performs single-transmission and multi-reception circulation one by one, the frequency modulation is performed on the transmitted signals, and the receiver in the transceiver receives all the reflected signals and records the original data to form a 3D Matlab image element matrix. Wherein, the forming of the 3D Matlab image element matrix comprises the following steps:

48 integrated radio frequency transceivers are arranged in each 3D model building unit and are respectively an RF₀～RF₄₇When RF₀RF at transmission₁～RF₄₇Receive when RF₁RF at transmission₀、RF₂～RF₄₇Receiving, and circulating one by one;

each radio frequency transceiver continuously transmits n signals once, the signals are transmitted from low to high within the frequency range of 77-81 GHz, and the frequency increment of each transmission is dHz:

the reflected signals received by the receiver in the radio frequency transceiver are stored in a complex matrix, the content of which can be analyzed by Matlab data analysis methods. The data structure for storage includes a Feq field for recording frequencies, a Smat field for storing a complex matrix recorded by the receiver at each frequency, an Xr field for recording the array of transmitter ports, an Rr field for recording the array of receiver ports, and a timestamp Time field in Matlab format.

And S4, acquiring data of the accelerometer, the gyroscope and the geomagnetic sensor when the measured object moves, and uploading the data to the MCU to complete inertial displacement calculation and track formation. The inertial displacement track calculation comprises the following steps:

calculating the step length and the direction of the operation of the personnel according to the acquired acceleration, angular velocity and magnetic force data, and calculating the position of the next moment;

suppose a previous time T₀Position P₀(X₀,Y₀) At a later time T₁Is in the position P₁(X₁,Y₁) The direction of this time is theta₀Step length of d₀Then, the two time position relations are:

X₁＝X₀+d₀·sin(θ₀)

Y₁＝Y₀+d₀·cos(θ₀)

if the position at the nth time is P_nThen P is_nAnd P₀The position relation of (1) is as follows:

marking the position of the ith time as X according to X, Y, T three elements_i、Y_i、T_i。

And S5, forming 3D modeling according to the data matrix of the reflection signal, correcting the offset formed by metal objects and other electromagnetic interference through the displacement track, and finally forming the position and the state of the object to finish GUI image presentation. Wherein forming the final object position and state comprises: performing algorithm analysis and modeling on the data information of the reflected signals, constructing a plurality of target object objects, and marking the object objects at simple positions X, Y, Z, T, wherein Z is the height of the highest position of the object, and T is a timestamp; the trajectory L1 is formed according to X, Y, Z, T queues submitted by the 3D model building unit, and the trajectory L2 is formed according to X, Y, T queues.

Data collected by the array frequency modulated continuous wave can drift or even be lost due to surrounding objects and electromagnetic interference, and similarly, data collected by sensing can form errors due to noise, so that the trajectories of the L1 and the L2 can deviate from the true trajectory. Here, the trajectory L1 is used as prediction data, the trajectory L2 is used as observation data, and filtering is performed by performing an optimized autoregressive data algorithm according to linear filtering and prediction theory on the same timestamp T to form a final position trajectory L, wherein the optimized autoregressive data algorithm is as follows:

p is p + Q, p on the right of the equal sign is the covariance of the optimal position deviation at the previous moment, the initial value is 1, Q is the covariance of the locus position at the previous moment L1, and the predicted covariance of the moment is obtained on the left of the equal sign; k is p/(p + R), R is the covariance estimated from the observed value of the L2 locus position, and k is the gain obtained; x is x + k (S-x), x on the right side of the equal sign is the track position value of the time L1, S is the track position value of the time L2, and x on the left side of the equal sign is the optimized time position; and p is (1-k) p, updating the covariance of the optimal position deviation at the moment, and then continuing to calculate the next moment.

And forming plane space presentation according to the position in the finally formed track, simultaneously performing standing, sitting and lying state analysis according to the height in the 3D image modeling, and finally forming GUI image presentation in the 3D space.

The invention can meet the intelligent and high-efficiency positioning requirements in places such as factory production lines, large-scale warehouses, laboratories and the like, has accurate and reliable positioning and can realize large-scale commercial use.

While the invention has been described with reference to a preferred embodiment, it will be understood by those skilled in the art that various changes in form and detail may be made therein without departing from the spirit and scope of the invention.