Spatial positioning data fusion method, system, device and computer storage medium
By acquiring the message and time interval of the positioning device, calculating the position offset and converting data, the problem of low fusion accuracy of multi-level coordinate system in the prior art is solved, and high-precision positioning data fusion is achieved.
Patent Information
- Application Number
- CN202011382875.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-12-01
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2040-12-01
AI Technical Summary
The prior art cannot effectively realize the fusion of positioning data of multi-level coordinate systems and improve positioning accuracy, especially in high-precision maps and static coordinate system scenarios of multi-level coordinate systems.
By obtaining the message and time interval sent by the positioning device, the device position offset is determined, and the positioning and fused position data is calculated using the offset and time interval, and finally the data is converted into position information in different coordinate systems to achieve multi-level Data fusion of coordinate system.
The mutual conversion of multi-source coordinate values is realized, the positioning accuracy is improved, and the positioning data of multi-level coordinate systems can be effectively integrated.
Smart Images

Figure CN114579679B_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to the field of positioning technology, and in particular to a spatial positioning data fusion method, system, device and computer storage medium. Background Art
[0002] In the current existing technology, the solution for multi-coordinate system data fusion is mainly to collect the same-name coordinate point pairs in the specified maps based on different coordinate systems in advance, and then use the coordinate points of the specified first unknown coordinate system to dynamically establish the mapping relationship between the various coordinate systems in the local area with a radius R as the unit, and then use the least squares method to calculate the coordinate conversion coefficient of the corresponding local area, and establish the local area coordinate conversion equation, and finally bring the coordinates of the specified first unknown coordinate system into the conversion equation to obtain the conversion result, so as to realize the coordinate point conversion of the local area.
[0003] The solutions of the prior art are mainly used in dynamic coordinate system application scenarios based on GPS positioning, but are unable to improve positioning accuracy and are not suitable for static coordinate system scenarios that require high-precision maps and multi-level coordinate systems.
[0004] Therefore, how to solve the fusion of high-precision and multi-level coordinate system positioning data is a technical problem that needs to be solved urgently. Summary of the invention
[0005] The purpose of the embodiments of the present disclosure is to provide a spatial positioning data fusion method, system, device and computer storage medium to solve the problem that the existing spatial positioning data fusion methods cannot achieve positioning data fusion of multi-level coordinate systems and improve accuracy.
[0006] In the first aspect, the embodiment of the present application provides a spatial positioning data fusion method, the method comprising: obtaining a message sent by a first positioning device in a local map, and a time interval for the first positioning device to send the message; determining the position data of the first positioning device in the local map according to the message; determining the position offset of the first positioning device according to the position data; determining the positioning fusion position data according to the position offset and the time interval; converting the positioning fusion position data in the local map into the coordinate position of the first local map, wherein the local map and the first local map use different coordinate systems to represent the position information. .
[0007] In some implementable embodiments of the first aspect, determining a position offset of a first positioning device according to position data includes: acquiring the position data of the first positioning device of a coordinate system in a local map for multiple times; calculating the difference between the coordinate value of the first positioning device and the median of each dimensional coordinate value of the first positioning device according to the position data of the first positioning device acquired for multiple times, wherein each dimensional coordinate value includes a longitude coordinate value and a dimensional coordinate value; comparing the difference in the medians with a preset offset of the coordinate system in the local map; when the difference in the medians is not less than the preset offset, determining the preset offset as the position offset; and when the difference in the medians is less than the preset offset, determining the average of the difference in the medians and the preset offset as the position offset.
[0008] In some implementations of the first aspect, determining the positioning fusion position data based on the offset and the first positioning device includes: acquiring trajectory information of the first positioning device, the trajectory information including motion parameters; and determining the positioning fusion position data of the first positioning device based on the motion parameters and time intervals.
[0009] In some implementable methods of the first aspect, the positioning fusion position data in the coordinate system of the local map is converted into the coordinate position of the first local map, including: when the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is not the coordinate system of the first local map, using a coordinate value conversion formula to convert the positioning fusion position data upward into the coordinate position in the parent coordinate system corresponding to the coordinate system in the local map where the positioning fusion position data is located.
[0010] In some implementable methods of the first aspect, the positioning fusion position data in the coordinate system of the local map is converted into the coordinate position of the first local map, including: when the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is the coordinate system of the first local map, the positioning fusion position data is converted into the coordinate position of the first local map coordinate system by using a coordinate value conversion formula.
[0011] Some possible implementations of the first aspect include: configuring local area maps and a first local area map for different application scenarios, wherein the local area map and the first local area map use different coordinate systems to represent positions; configuring location information of at least one first positioning device in the local area map and the first local area map, and a preset offset of the position of at least one first positioning device in the local area map and the first local area map.
[0012] In a second aspect, an embodiment of the present application provides a spatial positioning data fusion system, which may include: an acquisition module, used to acquire a message sent by a first positioning device in a local area map, and a time interval for the first positioning device to send the message; a determination module, used to determine the position data of the first positioning device in the local area map according to the message; a determination module, used to determine the position offset of the first positioning device according to the position data; a determination module, used to determine the positioning fusion position data according to the position offset and the time interval; a conversion module, used to convert the positioning fusion position data in the local area map into the coordinate position of the first local area map, wherein the local area map and the first local area map use different coordinate systems to represent the position information.
[0013] In some implementations of the second aspect, the determination module has a function for: repeatedly acquiring position data of a first positioning device of a coordinate system in the local map; calculating the difference between the coordinate value of the first positioning device and the median of each dimensional coordinate value of the first positioning device based on the position data of the first positioning device acquired multiple times, wherein each dimensional coordinate value includes a longitude coordinate value and a dimensional coordinate value; comparing the difference between the medians with a preset offset of the coordinate system in the local map; when the difference between the medians is not less than the preset offset, determining the preset offset as the position offset; when the difference between the medians is less than the preset offset, determining the average value of the difference between the medians and the preset offset as the position offset.
[0014] In some implementations of the second aspect, the determination module is specifically used to: obtain trajectory information of the first positioning device, the trajectory information including motion parameters; and determine the positioning fusion position data of the first positioning device according to the motion parameters and the time interval.
[0015] In some implementable embodiments of the second aspect, the conversion module is specifically used to: when the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is not the first local map coordinate system, use the coordinate value conversion formula to convert the positioning fusion position data upward into the coordinate position in the parent coordinate system corresponding to the coordinate system in the local map where the positioning fusion position data is located.
[0016] In some implementation methods of the second aspect, the conversion module is specifically used to: when the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is the first local map coordinate system, use the coordinate value conversion formula to convert the positioning fusion position data into the coordinate position of the first local map coordinate system.
[0017] In a third aspect, a spatial positioning data fusion device is provided in an embodiment of the present application, and the spatial positioning data fusion device includes: a processor and a memory storing computer program instructions; when the processor executes the computer program instructions, it implements the spatial positioning data fusion method shown in any embodiment of the first aspect.
[0018] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium having computer program instructions stored thereon. When the computer program instructions are executed by a processor, a spatial positioning data fusion method as shown in any embodiment of the first aspect is implemented.
[0019] The technical solution provided by the embodiments of the present disclosure brings at least the following beneficial effects:
[0020] The embodiment of the present application will determine the position data of the first positioning device in the local area map according to the message after obtaining the message sent by the first device in the local area map and the time interval for sending the message, and then determine the position offset of the first positioning device according to the determined position data, and then determine the positioning fusion position data according to the position offset and the time interval of the message, and finally convert the positioning fusion position data in the local area map into the position information of the first local area map, integrating the positioning data of multi-level coordinate systems, realizing the mutual conversion of multi-source coordinate values, and improving the positioning accuracy.
[0021] It is to be understood that the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the present disclosure. BRIEF DESCRIPTION OF THE DRAWINGS
[0022] In order to more clearly illustrate the technical solution of the embodiments of the present application, the drawings required for use in the embodiments of the present application will be briefly introduced below. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
[0023] Figure 1 It is a flowchart of a spatial positioning data fusion method provided in an embodiment of the present application;
[0024] Figure 2 It is a flowchart of another spatial positioning data fusion method provided in an embodiment of the present application;
[0025] Figure 3 It is a logical schematic diagram for determining positioning fusion position data provided by an embodiment of the present application;
[0026] Figure 4 It is a logical schematic diagram of different coordinate system transformations provided in an embodiment of the present application;
[0027] Figure 5It is a structural diagram of a spatial positioning fusion data system provided in an embodiment of the present application;
[0028] Figure 6 It is a structural diagram of a spatial positioning fusion data device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0029] The features and exemplary embodiments of various aspects of the present application will be described in detail below. In order to make the purpose, technical solutions and advantages of the present application clearer, the present application will be further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be understood that the specific embodiments described herein are only intended to explain the present application, rather than to limit the present application. For those skilled in the art, the present application can be implemented without the need for some of these specific details. The following description of the embodiments is only to provide a better understanding of the present application by illustrating the examples of the present application.
[0030] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the statement "include..." do not exclude the presence of other identical elements in the process, method, article or device including the elements.
[0031] The term "and / or" in this article is merely a description of the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone.
[0032] In order to solve the problem that existing spatial positioning data fusion methods cannot achieve positioning data fusion of multi-level coordinate systems and improve accuracy, the embodiments of the present application provide a spatial positioning data fusion method, system, device and computer-readable storage medium.
[0033] The technical solution provided in the embodiments of the present application is described below in conjunction with the accompanying drawings.
[0034] Figure 1 It is a flowchart of a spatial positioning data fusion method provided in an embodiment of the present application.
[0035] like Figure 1As shown, the execution subject of the method is a spatial positioning data fusion system, and the spatial positioning data fusion method may include the following steps:
[0036] S101: Acquire a message sent by a first positioning device in a local area map and a time interval between the messages sent by the first positioning device.
[0037] Specifically, the first positioning device refers to a terminal used by a user that can be positioned in space, including a mobile phone, a smart watch, a vehicle-mounted positioning terminal or other electronic terminals that can be positioned. The first positioning device uploads a message at a predetermined time interval, and the message includes time and location information of the first positioning device.
[0038] S102: Determine location data of the first positioning device in the local area map according to the message.
[0039] Specifically, the location data of the first positioning device in the local area map is determined according to the location information of the first positioning device uploaded by the message.
[0040] S103: Determine a position offset of the first positioning device according to the position data.
[0041] Specifically, the position offset refers to the difference between the 0-point coordinates and the 0-point GPS coordinates in the coordinate system of the local map where the first device is located. For example, differential GPS requires first converting the position data of the GPS mobile point (combined with the reference point (0-point GPS coordinates) into local positioning data based on its 0-point coordinates through the GPS relative distance conversion formula.
[0042] The position offset is used to correct the coordinate value. The general correction formula is: Pdestination coordinate value = Psource coordinate value + d.
[0043] S104, determining the positioning fusion position data according to the position offset and the time interval.
[0044] Specifically, the positioning fusion position data refers to the position data that needs to be transformed and fused into multiple coordinate systems.
[0045] S105, converting the positioning fusion position data in the local area map into the coordinate position of the first local area map.
[0046] Specifically, the local area map and the first local area map use different coordinate systems to represent location information.
[0047] The spatial positioning data fusion method of the embodiment of the present application, after obtaining the message sent by the first device of the local map and the time interval for sending the message, determines the position data of the first positioning device in the local map according to the message, and then determines the position offset of the first positioning device according to the determined position data, and then determines the positioning fusion position data according to the position offset and the time interval of the message, and finally converts the positioning fusion position data in the local map into the position information of the first local map, integrates the positioning data of multi-level coordinate systems, realizes the mutual conversion of multi-source coordinate values, and improves the positioning accuracy.
[0048] Figure 2 It is a flowchart of another spatial positioning data fusion method provided in an embodiment of the present application.
[0049] like Figure 2 As shown, the spatial positioning data fusion method may include the following steps:
[0050] S201, configuring local area maps for different application scenarios and a first local area map.
[0051] Among them, the local map and the first local map use different coordinate systems to represent the position. Specifically, according to the CAD modeling output picture of the scene as a template, use professional SVG format vector graphics software to draw necessary geographic elements, such as rooms, plots, paths and obstacles, etc. Pay attention to the scale when making maps, that is, 1 pixel represents the size in meters, such as 1 pixel represents 1 meter, the scale is 1, and then output the SVG vector picture as the base map of the local map, in pixels; register the map number, name, version number, base map, 0 point coordinates (upper left corner geographic GPS position), scale, if necessary, you can set the offset of the 0 point coordinates and the offset of the map pixel, the role of the offset is to correct the geographic measurement value or trajectory data, can be adjusted. The details are shown in Table 1 Basic Specifications of Maps.
[0052] Table 1 Basic map specifications
[0053] Data Item illustrate Map Number Unique, identifying map Map Name Usually named after a place name, building, etc. plus a serial number Map borders Determine the map range, upper left corner coordinates and geometric center coordinates Map images Vector diagram of the corresponding self-drawn map Pixel ratio The length represented by one pixel on the map, unit: cm Coordinate offset Correct map position Pixel offset Correcting the position of elements in the map Version Number Version Management
[0054] Among them, the local map and the first local map are both in a coordinate system, with 0 point as the upper left corner, the positive direction of the X-axis horizontally to the east, and the positive direction of the Y-axis vertically to the south.
[0055] The first local map may include multiple configured coordinate systems, and a coordinate system may include sub-coordinate systems to reflect the hierarchical relationship and realize upward and downward conversion of coordinates.
[0056] First, measure the 0-point coordinates (unit: meter) of each coordinate system in its parent coordinate system, the angle between the X-axis and the X-axis of the parent coordinate system (clockwise), the direction of the Y-axis and the Y-axis of the parent coordinate system (same or opposite), register the coordinate system number, name, version number, coordinate system type (divided into local and wide area according to the reported coordinate data type), 0-point coordinates, 0-point GPS coordinates (only GPS devices), X-axis angle, Y-axis direction, coordinate offset (adjustable), parent coordinate system, boundary (valid range), priority (coordinate system judgment of the repeated part of the boundary). The details are shown in Table 2 Basic Specifications of Coordinate Systems
[0057] Table 2 Basic specifications of coordinate system
[0058]
[0059] Note: The coordinate conversion accuracy between the coordinate systems is closely related to the registered measurement values. The more levels there are, the more errors will accumulate, resulting in low fusion accuracy. Therefore, it is necessary to limit the nesting depth of the coordinate system.
[0060] S202, obtaining the message sent by the first positioning device in the local area map and the time interval between the messages sent by the first positioning device. Please refer to the description of S101 for details, which will not be repeated here.
[0061] S203: Determine the location data of the first positioning device in the local area map.
[0062] In some embodiments, the location data of the first positioning device in the local area map is determined according to the message. For details, please refer to the description of S102, which will not be repeated here.
[0063] S204, repeatedly acquiring position data of a first positioning device in a coordinate system in a local area map.
[0064] S205: Calculate the difference between the coordinate value of the first positioning device and the median of the coordinate values of each dimension.
[0065] Specifically, each dimensional coordinate value includes a longitude coordinate value and a latitude coordinate value. The median is the middle value in the probability distribution.
[0066] S206, comparing whether the difference of the medians is less than a preset offset. If yes, executing step S207; if no, executing step S208.
[0067] Specifically, the preset offset is the offset of the coordinate system of the local map, which is determined by the positioning device associated with the local map. The preset offset can be provided by the manufacturer of the positioning device (the manufacturer will provide the basic specifications of the positioning device, as shown in Table 3 Basic Specifications of Positioning Devices), or it can be obtained by statistical analysis of test and production data. The preset offsets of different positioning devices are different, and the preset offsets of the associated coordinate system need to be readjusted when updating the positioning device.
[0068] Table 3 Basic specifications of positioning equipment
[0069] Data Item illustrate Equipment No. Unique, identifying device Device Name Naming based on application scenarios Equipment Brand Identify the manufacturer Device Type Device Model Device offset
[0070] Similarly, if the two registered coordinate systems need to be converted to each other, they can also be corrected through the position offset. Assume that the position offsets of the source coordinate system and the destination coordinate system in the spatial coordinate system management system are dsource and ddestination respectively, then the calculation formula for the new position offset d is: d=dsource-ddestination.
[0071] S207, when the difference between the medians is less than the preset offset, determine an average value of the difference between the medians and the preset offset as the position offset.
[0072] S208, when the difference between the medians is not less than the preset offset, determining the preset offset as the position offset.
[0073] S209: Acquire trajectory information of the first positioning device.
[0074] Specifically, the trajectory information includes motion parameters of the first positioning device, for example, motion parameters such as linear velocity, linear acceleration, angular velocity, and angular acceleration of the first positioning device.
[0075] S210: Determine positioning fusion position data of the first positioning device according to the motion parameters of the first positioning device and the time interval for reporting messages.
[0076] Specifically, first, after the P4 position, the system will calculate the motion parameters of the positioned device based on the most recent P1, P2, P3 and P4 position data, and then use formula (1) to calculate the position data of the next position.
[0077]
[0078] Among them, P k represents the kth point, V k represents the linear velocity of the kth point, ω k represents the angular velocity of the kth point, β k represents the angle of the kth point, Δt represents the time interval for uploading messages, and a k represents the linear velocity of the kth point, θ krepresents the angular acceleration of the kth point, k can be expressed as 1, 2, 3······n in sequence, where n is a positive integer.
[0079] Secondly, the next message contains the positioning data of the three positioning devices A, B and C, and the offset of the coordinate system of each positioning device is added for correction.
[0080] Finally, the A positioning data is excluded from the range with P5 as the center and r as the radius, where r has an adjustable range. If the maximum value is exceeded, all the positioning data in this message are invalid. Among the B positioning data and C positioning data, the C closest to P5 is selected to correct the offset in the coordinate system of the map to obtain the positioning fusion position data.
[0081] S211, determining whether the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is not the first local map coordinate system. If yes, executing step S212; if no, executing step S213.
[0082] S212, converting the positioning fusion position data into the coordinates of the parent coordinates of the coordinate system of the local map. Continue to execute step S211.
[0083] S213: Convert the positioning fusion position data into coordinate positions of the first local map coordinate system.
[0084] Specifically, the positioning fusion position data is converted into the coordinates of the parent coordinates of the coordinate system of the local map through the coordinate conversion formula. At the same time, the positioning fusion position data can also be converted into the coordinates of the child coordinates of the coordinate system of the local map through the coordinate conversion formula.
[0085] The formula for transforming the child coordinate system to the parent coordinate system is:
[0086] Assume that the 0 point position of the child coordinate system in the parent coordinate system is (X0, Y0), the X-axis angle is α, and the Y-axis direction parameter is γ (-1 / 1). One point (X, Y) is converted to the coordinates in the parent coordinate system (X p ,Y p ) is:
[0087] X p =X0+X*Math.cos(α)-Y*Math.sin(α)*γ (2)
[0088] Y p =Y0+Y*Math.cos(α)*γ+X*Math.sin(α) (3)
[0089] Therefore, it can be converted step by step upward to the first local map coordinate system according to the parent coordinate system relationship.
[0090] The formula for transforming the parent coordinate system to the child coordinate system is:
[0091] X p =(Y-Y0)*Math.sin(α)*γ+(X-X0)*Math.cos(α) (4)
[0092] Y p =(Y-Y0)*Math.cos(α)*γ+(X-X0)*Math.sin(α) (5)
[0093] If there are multiple sub-coordinate systems, you need to first determine which sub-coordinate system the coordinate point is in based on the boundaries and priorities of each sub-coordinate system, and then use the above formula to convert it.
[0094] Based on the above specifications and formulas, it is theoretically possible to perform an infinite number of coordinate transformations in a specified local map, as well as coordinate transformations between arbitrary coordinate systems.
[0095] In one embodiment, Figure 4 As shown, O is the coordinate system of the local map, with the X axis pointing east and the Y axis pointing south; the parent coordinate system of the O1 coordinate system is O, the X axis angle is a1, and the Y axis is in the same direction as the Y axis of the parent coordinate system. The coordinates of its 0 point are (O1.x, O1.y), and P1 is one of the points with the coordinates (P1.x, P1.y). The coordinates converted to O are (x1, y1); the parent coordinate system of the O2 coordinate system is O1, the X axis angle is a2, and the Y axis is in the same direction as the Y axis of the parent coordinate system , its 0 point coordinates are (O2.x, O2.y), P2 is one of the points, the coordinates are (P2.x, P2.y), and the coordinates converted to O are (x2, y2); the parent coordinate system of the O3 coordinate system is O, the X-axis angle is a3, the Y-axis is in the opposite direction to the Y-axis of the parent coordinate system, its 0 point coordinates are (O3.x, O3.y), P3 is one of the points, the coordinates are (P3.x, P3.y), and the coordinates converted to O are (x3, y3).
[0096] like Figure 5 As shown, the spatial positioning data fusion system 500 may include: an acquisition module 510 , a determination module 520 and a conversion module 530 .
[0097] Among them, the acquisition module 510 is used to obtain the message sent by the first positioning device in the local map, and the time interval for the first positioning device to send the message; the determination module 520 is used to determine the position data of the first positioning device in the local map according to the message; the determination module 520 is used to determine the position offset of the first positioning device according to the position data; the determination module 520 is used to determine the positioning fusion position data according to the position offset and the time interval; the conversion module 530 is used to convert the positioning fusion position data in the local map into the coordinate position of the first local map, wherein the local map and the first local map use different coordinate systems to represent the position information.
[0098] In some embodiments, the determination module 520 is also used to: obtain the position data of the first positioning device of the coordinate system in the local map multiple times; calculate the difference between the coordinate value of the first positioning device and the median of each dimensional coordinate value of the first positioning device based on the position data of the first positioning device obtained multiple times, and each dimensional coordinate value includes a longitude coordinate value and a dimensional coordinate value; compare the difference in medians with a preset offset of the coordinate system in the local map; when the difference in medians is not less than the preset offset, determine the preset offset as the position offset; when the difference in medians is less than the preset offset, determine the average of the difference in medians and the preset offset as the position offset.
[0099] In some embodiments, the determination module 520 is further used to: obtain trajectory information of the first positioning device, the trajectory information includes motion parameters; and determine the positioning fusion position data of the first positioning device according to the motion parameters and the time interval.
[0100] In some embodiments, the conversion module 530 is also used for: when the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is not the first local map coordinate system, using the coordinate value conversion formula to convert the positioning fusion position data upward into the coordinate position in the parent coordinate system corresponding to the coordinate system in the local map where the positioning fusion position data is located.
[0101] In some embodiments, the conversion module 530 is also used to: when the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is the first local map coordinate system, use the coordinate value conversion formula to convert the positioning fusion position data into the coordinate position of the first local map coordinate system.
[0102] The above embodiment also includes: configuring local area maps and a first local area map for different application scenarios, the local area map and the first local area map using different coordinate systems to represent positions; configuring location information of at least one first positioning device in the local area map and the first local area map, and a preset offset of the position of at least one first positioning device in the local area map and the first local area map.
[0103] The spatial positioning data fusion system of the embodiment of the present application, after obtaining the message sent by the first device of the local map and the time interval for sending the message, determines the position data of the first positioning device in the local map according to the message, and then determines the position offset of the first positioning device according to the determined position data, and then determines the positioning fusion position data according to the position offset and the time interval of the message, and finally converts the positioning fusion position data in the local map into the position information of the first local map, fuses the positioning data of multi-level coordinate systems, realizes the mutual conversion of multi-source coordinate values, and improves the positioning accuracy.
[0104] Figure 6 It is a structural schematic diagram of a spatial positioning data fusion device provided in an embodiment of the present application.
[0105] like Figure 6 As shown, the spatial positioning data fusion device 600 in this embodiment includes an input device 601, an input interface 602, a central processing unit 603, a memory 604, an output interface 605, and an output device 606. The input interface 602, the central processing unit 603, the memory 604, and the output interface 605 are interconnected through a bus 610, and the input device 601 and the output device 606 are connected to the bus 610 through the input interface 602 and the output interface 605, respectively, and then connected to other components of the information acquisition device 600.
[0106] Specifically, the input device 601 receives input information from the outside and transmits the input information to the central processing unit 603 through the input interface 602; the central processing unit 603 processes the input information based on the computer executable instructions stored in the memory 604 to generate output information, temporarily or permanently stores the output information in the memory 604, and then transmits the output information to the output device 606 through the output interface 605; the output device 606 outputs the output information to the outside of the information acquisition device 600 for user use.
[0107] In one embodiment, Figure 6 The spatial positioning data fusion device 600 shown includes: a memory 604 for storing programs; a processor 603 for running the programs stored in the memory to execute the embodiments of the present application. Figure 1 or Figure 2 The method of the illustrated embodiment.
[0108] The present application also provides a computer-readable storage medium on which computer program instructions are stored; when the computer program instructions are executed by a processor, the present application also provides a computer-readable storage medium on which computer program instructions are stored; Figure 1 or Figure 2 The method of the illustrated embodiment.
[0109] It should be clear that the present application is not limited to the specific configuration and processing described above and shown in the figures. For the sake of simplicity, a detailed description of the known method is omitted here. In the above embodiments, several specific steps are described and shown as examples. However, the method process of the present application is not limited to the specific steps described and shown, and those skilled in the art can make various changes, modifications and additions, or change the order between the steps after understanding the spirit of the present application.
[0110] The functional blocks shown in the structural block diagram described above can be implemented as hardware, software, firmware or a combination thereof. When implemented in hardware, it can be, for example, an electronic circuit, an application-specific integrated circuit (Application Specific Integrated Circuit, ASIC), appropriate firmware, plug-in, function card, etc. When implemented in software, the elements of the present application are programs or code segments used to perform the required tasks. The program or code segment can be stored in a machine-readable medium, or transmitted on a transmission medium or communication link by a data signal carried in a carrier. "Machine-readable medium" may include any medium capable of storing or transmitting information. Examples of machine-readable media include electronic circuits, semiconductor memory devices, read-only memories (Read-Only Memory, ROM), flash memory, erasable ROM (EROM), floppy disks, CD-ROMs, optical disks, hard disks, optical fiber media, radio frequency (Radio Frequency, RF) links, etc. The code segment can be downloaded via a computer network such as the Internet, an intranet, etc.
[0111] It should also be noted that the exemplary embodiments mentioned in this application describe some methods or systems based on a series of steps or devices. However, this application is not limited to the order of the above steps, that is, the steps can be performed in the order mentioned in the embodiment, or in a different order from the embodiment, or several steps can be performed simultaneously.
[0112] The above is only a specific implementation of the present application. Those skilled in the art can clearly understand that for the convenience and simplicity of description, the specific working processes of the systems, modules and units described above can refer to the corresponding processes in the aforementioned method embodiments, and will not be repeated here. It should be understood that the protection scope of the present application is not limited to this. Any technician familiar with the technical field can easily think of various equivalent modifications or replacements within the technical scope disclosed in this application, and these modifications or replacements should be included in the protection scope of this application.
Claims
1. A spatial positioning data fusion method, It is characterized in that include: Acquire a message sent by a first positioning device in a local area map, and a time interval for sending the message by the first positioning device; Determine the location data of the first positioning device in the local area map according to the message; determining a position offset of the first positioning device according to the position data; Determine positioning fusion position data according to the position offset and the time interval; Converting the positioning fusion position data in the local area map into coordinate positions of a first local area map, wherein the local area map and the first local area map use different coordinate systems to represent position information; Determining the positioning fusion position data according to the offset and the time interval includes: Acquire trajectory information of the first positioning device, where the trajectory information includes motion parameters; Determine the positioning fusion position data of the first positioning device according to the motion parameter and the time interval; Determining the positioning fusion position data of the first positioning device according to the motion parameter and the time interval includes: The position data of the next position is calculated according to the relationship between the position data, the motion parameters and the time interval and the position data, and the position offset of the first positioning device of the local area map where the target positioning data is located is selected from the positioning data reported in the next message for correction to the positioning fusion position data, wherein the target positioning data is the positioning data closest to the position data of the next position; The local area map and the first local area map are configured with a preset offset of the coordinate system.
2. The method according to claim 1, It is characterized in that Determining the position offset of the first positioning device according to the position data includes: Acquire position data of a first positioning device in a coordinate system in the local area map multiple times; Calculate the difference between the coordinate value of the first positioning device and the median of each dimensional coordinate value of the first positioning device according to the position data of the first positioning device acquired multiple times, wherein each dimensional coordinate value includes a longitude coordinate value and a latitude coordinate value; comparing the difference between the medians and a preset offset of a coordinate system in the local map; When the difference between the medians is not less than the preset offset, determining the preset offset as the position offset; When the difference between the medians is less than the preset offset, an average value of the difference between the medians and the preset offset is determined as the position offset.
3. The method according to claim 1, It is characterized in that The converting the positioning fusion position data in the coordinate system of the local area map into the coordinate position of the first local area map includes: When the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is not the first local map coordinate system is met, the positioning fusion position data is converted upward into the coordinate position in the parent coordinate system corresponding to the coordinate system in the local map where the positioning fusion position data is located using the coordinate value conversion formula.
4. The method according to claim 1, It is characterized in that The converting the positioning fusion position data in the coordinate system of the local area map into the coordinate position of the first local area map includes: When the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is the first local map coordinate system is met, the positioning fusion position data is converted into the coordinate position of the first local map coordinate system using a coordinate value conversion formula.
5. The method according to any one of claims 1 to 4, It is characterized in that The method further comprises: Configuring local area maps and a first local area map for different application scenarios, wherein the local area map and the first local area map use different coordinate systems to represent positions; Configure location information of at least one of the first positioning devices in the local area map and the first local area map, and the preset offset of the location of the at least one of the first positioning devices in the local area map and the first local area map.
6. A spatial positioning data fusion system, It is characterized in that include: An acquisition module, used to acquire a message sent by a first positioning device in a local area map, and a time interval for sending the message by the first positioning device; A determination module, configured to determine the location data of the first positioning device in the local area map according to the message; The determination module is further used to determine the position offset of the first positioning device according to the position data; The determination module is further used to determine the positioning fusion position data according to the position offset and the time interval; a conversion module, configured to convert the positioning fusion position data in the local area map into coordinate positions of a first local area map, wherein the local area map and the first local area map use different coordinate systems to represent position information; The determination module is specifically used for: Acquire trajectory information of the first positioning device, where the trajectory information includes motion parameters; Determine the positioning fusion position data of the first positioning device according to the motion parameter and the time interval; Determining the positioning fusion position data of the first positioning device according to the motion parameter and the time interval includes: calculating the position data of the next position according to the relationship between the position data, the motion parameter and the time interval and the position data, selecting the position offset of the first positioning device of the local area map where the target positioning data is located in the positioning data reported by the next message for correction to the positioning fusion position data, wherein the target positioning data is the positioning data closest to the position data of the next position; The local area map and the first local area map are configured with a preset offset of the coordinate system.
7. The system according to claim 6, wherein the determining module is specifically configured to: Acquire position data of a first positioning device in a coordinate system in the local area map multiple times; Calculate the difference between the coordinate value of the first positioning device and the median of each dimensional coordinate value of the first positioning device according to the position data of the first positioning device acquired multiple times, wherein each dimensional coordinate value includes a longitude coordinate value and a latitude coordinate value; comparing the difference between the medians and a preset offset of a coordinate system in the local map; When the difference between the medians is not less than the preset offset, determining the preset offset as the position offset; When the difference between the medians is less than the preset offset, an average value of the difference between the medians and the preset offset is determined as the position offset.
8. The system according to claim 6, It is characterized in that The conversion module is specifically used for: When the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is not the first local map coordinate system is met, the positioning fusion position data is converted upward into the coordinate position in the parent coordinate system corresponding to the coordinate system in the local map where the positioning fusion position data is located using the coordinate value conversion formula.
9. The system according to claim 6, It is characterized in that The conversion module is specifically used for: When the condition that the parent coordinate system of the coordinate system in the local map where the positioning fusion position data is located is the first local map coordinate system is met, the positioning fusion position data is converted into the coordinate position of the first local map coordinate system using a coordinate value conversion formula.
10. A spatial positioning data fusion device, It is characterized in that The device comprises: a processor and a memory storing computer program instructions; When the processor executes the computer program instructions, the spatial positioning data fusion method as described in any one of claims 1-5 is implemented.
11. A computer-readable storage medium, It is characterized in that The computer-readable storage medium stores computer program instructions, and when the computer program instructions are executed by the processor, the spatial positioning data fusion method according to any one of claims 1 to 5 is implemented.
