A method for intelligently detecting three-dimensional coordinates of spatial sites and its application
By installing a nine-axis gyroscope and ranging sensor on the carrier, the three-dimensional coordinate calculation of spatial locations is simplified by using mathematical conversion principles, the problems of complexity and high cost in the existing technology are solved, and efficient and low-cost three-dimensional coordinates are achieved Detection is suitable for preventing myopia and topographic mapping.
Patent Information
- Application Number
- CN202210915825.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-01
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2042-08-01
AI Technical Summary
In the intelligent detection of three-dimensional coordinates of spatial sites, the data processing is complex, the operating cost is high, and the detection accuracy is affected by the performance of visual equipment or radar equipment, and the equipment is huge, which limits the wide application of technology, especially in preventing myopia. There are problems such as poor accuracy, frequent false alarms and short battery life in terrain surveying and mapping products.
The nine-axis gyroscope sensor and the ranging sensor are installed on the carrier of synchronous motion. The three-dimensional coordinate calculation formula of the spatial location in the reference coordinate system is constructed through the mathematical conversion principle. The nine-axis gyroscope sensor is used to obtain the attitude angle in real time and measure the distance. The sensor detects distance in real time, simplifies the calculation process, and achieves efficient and low-cost detection.
The simplicity and efficiency of three-dimensional coordinate detection and calculation of spatial sites in the reference coordinate system is realized, and is suitable for preventing myopia and topographic mapping, reducing detection costs, improving detection accuracy and popularization of application.
Smart Images

Figure CN115235462B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a method for intelligently detecting three-dimensional coordinates of a spatial site and its application in myopia prevention and topographic mapping products, belonging to the field of intelligent detection technology. Background Art
[0002] With the rapid development of intelligent technology, the intelligent implementation in many industries has involved the problem of how to accurately locate space targets, such as smart wearable devices, online quality monitoring of robots, map surveying and mapping, rescue and exploration, etc. In order to achieve accurate positioning of space targets, it is necessary to solve the problem of intelligent detection of three-dimensional coordinates of spatial sites. At present, the intelligent monitoring of spatial sites is basically achieved by using visual image technology or navigation technology combined with radar. This technology not only has problems such as complex data processing and high operating costs, but also the detection accuracy is affected by the performance of visual equipment and / or radar equipment, and the data processing system has high requirements. Usually, high-speed detection efficiency must be met, which will lead to a large volume of intelligent processing system and high detection cost, thus limiting the wide application of this technology.
[0003] Currently, there are two main types of products for preventing myopia on the market: one is physical posture correction equipment, because this type of equipment needs to be installed on the study desk, it is difficult to disassemble and there are major safety hazards; the other is ranging alarm equipment. Although the direction of this type of equipment is correct, the existing equipment of this type not only has poor accuracy and frequent false alarms, but is also bulky and has a short battery life, making it impossible to popularize and use it, and it is not practical. Summary of the invention
[0004] In view of the above problems existing in the prior art, the purpose of the present invention is to provide a method for intelligently detecting three-dimensional coordinates of spatial sites and its application in topographic mapping and myopia prevention products.
[0005] To achieve the above object, the present invention adopts the following technical solution:
[0006] A method for intelligently detecting three-dimensional coordinates of a spatial position comprises a nine-axis gyroscope sensor and at least one ranging sensor, wherein the nine-axis gyroscope sensor and the ranging sensor are both mounted on a carrier capable of realizing their synchronous movement, and the method comprises the following steps:
[0007] 1) Select any point on the carrier as the origin O of the reference coordinate system, and assume that: the horizontal eastward direction is the X-axis, the horizontal northward direction is the Y-axis, the vertical skyward direction is the Z-axis, and θ is the attitude angle rotating around the X-axis according to the right-hand rule, is the attitude angle of rotation around the Y axis following the right-hand rule, ψ is the attitude angle of rotation around the Z axis following the right-hand rule; α O is the origin of the coordinate system where the ranging sensor is locatedA The line O connecting the origin O of the reference coordinate system A -The angle between O and X axis, β O It is the connection O A -The angle between O and the Y axis, γ O It is the connection O A -The angle between O and Z axis; α A is the origin of the coordinate system where the ranging sensor is located. A The line O connecting the spatial point to be measured (denoted as point A) A -The angle between A and the X axis, β A It is the connection O A -The angle between A and Y axis, γ A It is the connection O A -A is the angle between the Z axis and the Z axis; and a represents O A -A is the length of the line, m represents O A -O The length of the line;
[0008] 2) Since there are 6 internal rotation sequences of the attitude angle of the nine-axis gyroscope sensor, namely: ZYX, ZXY, YZX, YXZ, XYZ, XZY, the three-dimensional coordinates of the measured spatial point A in the reference coordinate system are calculated according to the following corresponding formula based on the specific internal rotation sequence of the attitude angle of the selected nine-axis gyroscope sensor, specifically:
[0009] 21) If the internal rotation sequence is ZYX, that is, first rotate around the Z axis, then around the Y axis, and finally around the X axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula (recorded as formula 1) is as follows:
[0010]
[0011]
[0012]
[0013] 22) If the internal rotation sequence is ZXY, that is, first rotate around the Z axis, then around the X axis, and finally around the Y axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula (recorded as Formula 2) is as follows:
[0014]
[0015]
[0016]
[0017] 23) If the internal rotation sequence is YXZ, that is, first rotate around the Y axis, then around the X axis, and finally around the Z axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula (recorded as Formula 3) is as follows:
[0018]
[0019]
[0020]
[0021] 24) If the internal rotation sequence is YZX, that is, first rotate around the Y axis, then around the Z axis, and finally around the X axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula (recorded as Formula 4) is as follows:
[0022]
[0023]
[0024]
[0025] 25) If the internal rotation sequence is XZY, that is, first rotate around the X axis, then around the Z axis, and finally around the Y axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula (recorded as Formula 5) is as follows:
[0026]
[0027]
[0028]
[0029] 26) If the internal rotation sequence is XYZ, that is, first rotate around the X axis, then around the Y axis, and finally around the Z axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula (recorded as Formula 6) is as follows:
[0030]
[0031]
[0032]
[0033] In one implementation scheme, the above-mentioned attitude angle θ, The value range of ψ is -180° to 180°.
[0034] A smart device for preventing myopia, comprising a head-mounted carrier, a nine-axis gyroscope sensor, at least three distance measuring sensors and a single-chip microcomputer, wherein the nine-axis gyroscope sensor and the distance measuring sensor are both fixedly mounted on the head-mounted carrier, and the nine-axis gyroscope sensor and the distance measuring sensor are both connected to the single-chip microcomputer for signal communication; characterized in that: the single-chip microcomputer is preset with at least three groups of calculation formulas for calculating the three-dimensional coordinates of a spatial position in a reference coordinate system according to the above method, and the attitude angles θ, The ψ values are acquired in real time by the nine-axis gyroscope sensor and sent to the microcontroller. O , β O , γ O , α A , β A , γ A The parameter values of and m are determined by the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located, and are fixed in each set of formulas. The parameter a value in each set of calculation formulas refers to the distance between the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located and the spatial location to be measured, which is acquired in real time by the corresponding ranging sensor and sent to the microcontroller.
[0035] In one implementation, the midpoint between the user's eyes on the head-mounted carrier is used as the origin O of the reference coordinate system. A total of 6 ranging sensors are provided on the head-mounted carrier, and the origins of the coordinate systems where they are located are respectively denoted as O A , O B , O C , O D , O E , O F ; Let: the horizontal eastward direction be the X-axis, the horizontal northward direction be the Y-axis, the vertical skyward direction be the Z-axis, θ be the attitude angle rotating around the X-axis following the right-hand rule, representing the angle of the user's head up and down, is the attitude angle rotated around the Y axis following the right-hand rule, representing the angle of the user's head tilting left and right, ψ is the attitude angle rotated around the Z axis following the right-hand rule, representing the angle of the direction the user is facing; and, in the single-chip microcomputer, there are preset coordinates corresponding to the origin O of the coordinate system where the ranging sensor is located. A , O B , O C , O D , O E , O F There are 6 corresponding groups of calculation formulas for calculating the three-dimensional coordinates of the spatial site in the reference coordinate system according to the above method. The α in each group of calculation formulas is O It refers to the origin of the coordinate system O where the corresponding ranging sensor is located. A / O B / O C / OD / O E / O F The line O connecting the origin O of the reference coordinate system A -O / O B -O / O C -O / O D -O / O E -O / O F -The angle between O and X axis, β O It is the connection O A -O / O B -O / O C -O / O D -O / O E -O / O F -The angle between O and the Y axis, γ O It is the connection O A -O / O B -O / O C -O / O D -O / O E -O / O F -The angle between O and Z axis; α in each calculation formula A It refers to the origin of the coordinate system O where the corresponding ranging sensor is located. A / O B / O C / O D / O E / O F The connection line with the spatial position to be measured (which can be recorded as A / B / C / D / E / F point) (e.g.: O A -A / O B -B / O C -C / O D -D / O E -E / O F -F) with the X-axis, β A It is the connection (such as: A -A / O B -B / O C -C / O D -D / O E -E / O F -F) with the Y axis, γ A It is the connection (such as: A -A / O B -B / O C -C / O D -D / O E -E / O F -F) and the Z axis; and a in each set of calculation formulas represents the origin of the coordinate system O where the corresponding ranging sensor is located. A / O B / O C / O D / O E / O F The connection line with the spatial position to be measured (which can be recorded as A / B / C / D / E / F point) (e.g.: O A -A / O B -B / O C -C / O D -D / O E -E / O F -F), and m in each calculation formula represents the origin of the coordinate system O where the corresponding ranging sensor is located. A / O B / O C / O D / O E / O F The line O connecting the origin O of the reference coordinate system A -O / O B -O / O C -O / O D -O / O E -O / O F -O length.
[0036] In a preferred embodiment, six distance measuring sensors provided on the head-mounted carrier are distributed on the left and right sides of the origin O of the reference coordinate system in a bilaterally symmetrical manner.
[0037] In one implementation scheme, the head-mounted carrier is also provided with a warning module, and the warning module is connected to the single-chip microcomputer for signal communication.
[0038] In a further implementation scheme, the warning module is any one of a vibration prompt module, a voice prompt module, and an indicator light prompt module, or a combination of several of them.
[0039] In one implementation manner, the head-mounted carrier is further provided with a timing module, and the timing module is connected to the single-chip microcomputer for signal communication.
[0040] In one implementation scheme, the head-mounted carrier is also provided with a light intensity sensor, and the light intensity sensor is connected to the single-chip microcomputer for signal communication.
[0041] In one implementation scheme, a touch switch is also provided on the head-mounted carrier.
[0042] In one embodiment, the head-mounted carrier is a spectacle frame, which may or may not contain lenses, and the lenses may be plano lenses or myopic lenses.
[0043] In one implementation scheme, the single chip microcomputer is preset with a module for determining whether it is in a learning state, and the specific determination method is as follows:
[0044] When the value of the posture angle ψ meets ω-25°<ψ<ω+25°, it is judged as a learning state, otherwise it is judged as a non-learning state; where: ω is the angle value of the initial posture angle ψ corresponding to the user facing the desk;
[0045] or / and
[0046] When the value of the attitude angle θ meets θ<10°, it is judged as a learning state, otherwise it is judged as a non-learning state;
[0047] or / and
[0048] If at least two of the three monitoring sites on the desktop have Z-axis coordinates greater than -500 mm in the reference coordinate system, it is judged to be in a learning state, otherwise it is judged to be a non-learning state.
[0049] In one implementation scheme, the single chip microcomputer is also preset with the following functions:
[0050] When the value of the posture angle θ meets the condition that θ<-40° and lasts for at least 10±5 seconds, a warning reminder of lowering the head too low will be triggered and relevant records will be stored. The warning reminder will continue until the value of the posture angle θ returns to the range of -40°≤θ<10°.
[0051] In one implementation scheme, the single chip microcomputer is also preset with the following functions:
[0052] When the attitude angle or If the duration is at least 10±5 seconds, the excessive head tilt warning will be triggered and relevant records will be stored. The warning will continue until the posture angle The value is restored to Stop when it reaches the range.
[0053] In one implementation scheme, the single chip microcomputer is also preset with the following functions:
[0054] If the distance between at least two of the three monitoring sites on the book and the origin of the coordinate system where the corresponding distance measuring sensors are located is less than 330mm and is maintained for at least 10±5 seconds, a warning reminder that the eyes are too close to the book will be triggered and relevant records will be stored. The warning reminder will continue until the distance measuring distance of at least two sites is restored to ≥330mm.
[0055] In one implementation scheme, the single chip microcomputer is also preset with the following functions:
[0056] If at least two of the three monitoring sites on the desktop are within the Z-axis coordinate Z of the reference coordinate system, 0When the distance between the eyes and the desktop is too close, the warning reminder will be triggered and the relevant records will be stored. The warning reminder will continue until the Z-axis coordinates of at least two points in the reference coordinate system are restored to -500mm<Z 0 It stops when the range is ≤-280mm.
[0057] A preferred solution is that when the above-mentioned smart device for preventing myopia is started, it first determines whether it is in a wearing state, then determines whether it is in a learning state, and then determines the functions that need to be started and turns off the remaining functions.
[0058] An implementation scheme is to set a temperature sensor on the head-mounted carrier and connect the temperature sensor to the single-chip computer for signal communication, and judge whether it is in the wearing state by whether the sensed temperature is greater than the room temperature. Specifically: if the temperature sensed by the temperature sensor is greater than the room temperature and is maintained for at least 10±5 seconds, it is judged to be in the wearing state.
[0059] A preferred solution is that the above-mentioned smart device for preventing myopia also includes a cloud server, and the cloud server is provided with an eye health record of each user to count and display the vision condition and eye habits of each user in real time.
[0060] An intelligent device for terrain surveying and mapping, comprising a nine-axis gyro sensor, a plurality of distance measuring sensors, a single-chip microcomputer and a carrying body for fixing and installing the above hardware, wherein the nine-axis gyro sensor and the distance measuring sensor are both connected to the single-chip microcomputer for signal communication; characterized in that: the single-chip microcomputer is preset with at least a plurality of calculation formulas for calculating the three-dimensional coordinates of a spatial position in a reference coordinate system according to the above method, and the attitude angles θ, The ψ values are acquired in real time by the nine-axis gyroscope sensor and sent to the microcontroller. The parameter α in each calculation formula O , β O , γ O , α A , β A , γ A The values of and m are determined by the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located, and are constants in each set of formulas. The parameter a value in each set of calculation formulas refers to the distance between the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located and the spatial location to be measured, which is acquired in real time by the corresponding ranging sensor and sent to the microcontroller.
[0061] In one implementation scheme, the carrying body is a tripod or a drone.
[0062] In one implementation scheme, the single chip microcomputer is also preset with the following function: constructing a 3D model diagram according to the three-dimensional coordinate values of multiple spatial locations in a reference coordinate system.
[0063] In one implementation scheme, the single chip microcomputer is also preset with the following function: judging whether the plane is horizontal or vertical according to whether there is a difference between the coordinate values of multiple spatial points located on the same plane in the same direction.
[0064] In addition, the distance measuring sensor described in the present invention includes but is not limited to any one of a laser distance measuring sensor, an ultrasonic distance measuring sensor and an infrared distance measuring sensor, and the laser distance measuring sensor is preferred.
[0065] Compared with the prior art, the beneficial technical effects of the present invention are:
[0066] The present invention installs the nine-axis gyro sensor and the distance measuring sensor on a carrier that enables them to move synchronously, and uses the mathematical transformation principle of the reference coordinate system to skillfully construct the three-dimensional coordinate value of the spatial point (such as point A) in the reference coordinate system. With each attitude angle θ, ψ and the installation direction angle α of the ranging sensor A , β A , γ A , the direction angle α of the origin of the coordinate system where the ranging sensor is located relative to the origin of the reference coordinate system o , β o , γ o , the mathematical relationship between the length m of the line connecting the origin of the coordinate system where the ranging sensor is located and the origin of the reference coordinate system and the length a of the line connecting the origin of the coordinate system where the ranging sensor is located and the spatial position to be measured; since in the mathematical relationship, the installation direction angle α of the ranging sensor A , β A , γ A , the direction angle α of the origin of the coordinate system where the ranging sensor is located relative to the origin of the reference coordinate system o , β o , γ o , the length m of the line connecting the origin of the coordinate system where the ranging sensor is located and the origin of the reference coordinate system, becomes a quantitative value after the origin of the reference coordinate system and the origin of the coordinate system where the ranging sensor is located are determined, and the attitude angle θ, ψ can be obtained in real time by the nine-axis gyroscope sensor, and the length a of the line between the origin of the coordinate system where the ranging sensor is located and the spatial position to be measured can be detected and obtained in real time by the corresponding ranging sensor. Therefore, the method of the present invention is very simple to realize the detection and calculation of the three-dimensional coordinates of the spatial position in the reference coordinate system, and is easy to realize efficient and low-cost detection and processing. It can be widely used in many fields, for example: it can be applied to the smart device for preventing myopia and the smart device for terrain surveying and mapping described in the present invention. Therefore, the present invention has significant practical value and is significantly advanced compared to the prior art. BRIEF DESCRIPTION OF THE DRAWINGS
[0067] Figure 1 The setting direction of the spatial coordinate system and the attitude angle in the method for intelligently detecting the three-dimensional coordinates of a spatial position described in Example 1 of the present invention is shown;
[0068] Figure 2 It shows that in the method for intelligently detecting the three-dimensional coordinates of a spatial position described in Example 1 of the present invention, the parameter α o , β o , γ o , α A , β A , γ A , a and m respectively represent the meanings;
[0069] Figure 3 It shows that in the method for intelligently detecting the three-dimensional coordinates of a spatial position described in Example 1 of the present invention, when the three attitude angles θ, The detection state diagram when ψ is zero (indicated by solid line) and the three attitude angles θ, Detection state diagram when ψ is not zero (indicated by the dotted line);
[0070] Figure 4 The figure shows the setting of the origin of the reference coordinate system and the origin of the coordinate system where the distance measuring sensor is located and the coordinate system in the smart device for preventing myopia described in Example 2 of the present invention;
[0071] Figure 5 A schematic diagram showing the smart device for preventing myopia described in Example 2 of the present invention when used for spatial site detection;
[0072] Figure 6 A schematic diagram showing the intelligent device for preventing myopia described in Example 2 of the present invention when judging whether it is in a learning state based on the posture angle ψ;
[0073] Figure 7 A schematic diagram showing the intelligent device for preventing myopia described in Example 2 of the present invention when judging whether it is in a learning state based on a posture angle θ;
[0074] Figure 8 A schematic diagram showing the intelligent device for preventing myopia described in Example 2 of the present invention when judging whether it is in a learning state based on the Z-axis coordinate of a monitoring point located on a desktop in a reference coordinate system;
[0075] Fig. 9 and Fig.10 A schematic diagram showing the intelligent device for preventing myopia described in Example 2 of the present invention being used for intelligent monitoring of eye use during learning;
[0076] Fig.11The figure shows the setting of the origin of the reference coordinate system and the origin of the coordinate system where the distance measuring sensor is located and the coordinate system in the intelligent device for terrain surveying and mapping described in Embodiment 3 of the present invention;
[0077] Fig.12 A schematic diagram showing the intelligent device for terrain mapping described in Example 3 of the present invention when used for spatial site detection;
[0078] Fig.13 and Fig.14 A schematic diagram showing the intelligent device for terrain mapping described in Example 3 of the present invention for detecting whether a wall and the ground are horizontal and / or vertical is shown. DETAILED DESCRIPTION
[0079] The technical solution of the present invention will be further clearly and completely described below in conjunction with the accompanying drawings and embodiments.
[0080] Example 1
[0081] Please combine Figures 1 to 3 As shown, the method for intelligently detecting three-dimensional coordinates of a spatial position described in the present invention comprises a nine-axis gyroscope sensor (not shown in the figure, a known commercial product is selected) and at least one ranging sensor (not shown in the figure, a known commercial product is selected), and the nine-axis gyroscope sensor and the ranging sensor are both installed on a carrier 01 that can realize their synchronous movement (the specific installation positions of the nine-axis gyroscope sensor and the ranging sensor on the carrier 01 are not limited, as long as the nine-axis gyroscope sensor and the ranging sensor can realize synchronous movement with the movement (such as rotation) of the carrier 01), and the method specifically comprises the following steps:
[0082] 1) Select any point on the carrier 01 as the origin O of the reference coordinate system, and assume that: the horizontal eastward direction is the X-axis, the horizontal northward direction is the Y-axis, the vertical skyward direction is the Z-axis, and θ is the attitude angle rotating around the X-axis according to the right-hand rule, is the attitude angle of rotation around the Y axis following the right-hand rule, and ψ is the attitude angle of rotation around the Z axis following the right-hand rule. For details, please refer to Figure 1 As shown;
[0083] 2) Please refer to Figure 2 Shown: α O is the origin of the coordinate system where the ranging sensor is located A The line O connecting the origin O of the reference coordinate system A -The angle between O and X axis, β O It is the connection O A -The angle between O and the Y axis, γ O It is the connection O A -The angle between O and Z axis; α Ais the origin of the coordinate system where the ranging sensor is located. A The line O connecting the spatial point to be measured (denoted as point A) A -The angle between A and the X axis, β A It is the connection O A -The angle between A and Y axis, γ A It is the connection O A -A is the angle between the Z axis and the A -A is the length of the line, m represents O A -O The length of the line;
[0084] Please refer to Figure 3 As shown: If the three attitude angles θ, When ψ is zero, the coordinates of point O are To express, the coordinates of point A are expressed as To express it, the mathematical expressions of their three-dimensional coordinates in their respective coordinate systems are as follows:
[0085]
[0086]
[0087] If the carrier 01 passes through three attitude angles θ, After ψ rotation, The point becomes point, The point becomes point;
[0088] Since there are 6 internal rotation sequences of the attitude angle of the nine-axis gyroscope sensor, namely: ZYX, ZXY, YZX, YXZ, XYZ, and XZY, it is necessary to select the corresponding formula according to the specific internal rotation sequence of the attitude angle of the selected nine-axis gyroscope sensor to calculate the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system. Specifically:
[0089] 21) If the order of internal rotation is ZYX, that is, first rotate around the Z axis, then around the Y axis, and finally around the X axis, then, The calculation formula for the three-dimensional coordinates of a point is:
[0090]
[0091]
[0092]
[0093] The calculation formula for the three-dimensional coordinates of a point is:
[0094]
[0095]
[0096]
[0097] According to the mathematical principle of coordinate transformation, the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation method is as follows:
[0098]
[0099] Therefore, according to the above The calculation formula can be simplified to obtain the following specific calculation formula (recorded as formula 1):
[0100]
[0101]
[0102]
[0103] 22) If the internal rotation sequence is ZXY, that is, first rotate around the Z axis, then around the X axis, and finally around the Y axis, then, The calculation formula for the three-dimensional coordinates of a point is:
[0104]
[0105]
[0106]
[0107] The calculation formula for the three-dimensional coordinates of a point is:
[0108]
[0109]
[0110]
[0111] According to the mathematical principle of coordinate transformation, the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation method is as follows:
[0112]
[0113] Therefore, according to the above The calculation formula can be simplified to obtain the following specific calculation formula (recorded as Formula 2):
[0114]
[0115]
[0116]
[0117] 23) If the order of internal rotation is YXZ, that is, first rotate around the Y axis, then around the X axis, and finally around the Z axis, then, The calculation formula for the three-dimensional coordinates of a point is:
[0118]
[0119]
[0120]
[0121] The calculation formula for the three-dimensional coordinates of a point is:
[0122]
[0123]
[0124]
[0125] According to the mathematical principle of coordinate transformation, the three-dimensional coordinates of the spatial point A to be measured in the reference system are The calculation method is as follows:
[0126]
[0127] According to the above The calculation formula can be simplified to obtain the following specific calculation formula (recorded as Formula 3):
[0128]
[0129]
[0130]
[0131] 24) If the order of internal rotation is YZX, that is, first rotate around the Y axis, then around the Z axis, and finally around the X axis, then, The calculation formula for the three-dimensional coordinates of a point is:
[0132]
[0133]
[0134]
[0135] The calculation formula for the three-dimensional coordinates of a point is:
[0136]
[0137]
[0138]
[0139] According to the mathematical principle of coordinate transformation, the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation method is as follows:
[0140]
[0141] Therefore, according to the above The calculation formula can be simplified to obtain the following specific calculation formula (recorded as Formula 4):
[0142]
[0143]
[0144]
[0145] 25) If the order of internal rotation is XZY, that is, first rotate around the X axis, then around the Z axis, and finally around the Y axis, then, The calculation formula for the three-dimensional coordinates of a point is:
[0146]
[0147]
[0148]
[0149] The calculation formula for the three-dimensional coordinates of a point is:
[0150]
[0151]
[0152]
[0153] According to the mathematical principle of coordinate transformation, the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation method is as follows:
[0154]
[0155] Therefore, according to the above The calculation formula can be simplified to obtain the following specific calculation formula (recorded as Formula 5):
[0156]
[0157]
[0158]
[0159] 26) If the order of internal rotation is XYZ, that is, first rotate around the X axis, then around the Y axis, and finally around the Z axis, then, The calculation formula for the three-dimensional coordinates of a point is:
[0160]
[0161]
[0162]
[0163] The calculation formula for the three-dimensional coordinates of a point is:
[0164]
[0165]
[0166]
[0167] According to the mathematical principle of coordinate transformation, the three-dimensional coordinates of the spatial point A to be measured in the reference system are The calculation method is as follows:
[0168]
[0169] According to the above The calculation formula can be simplified to obtain the following specific calculation formula (recorded as Formula 6):
[0170]
[0171]
[0172]
[0173] Because of Figure 2 As shown in the figure, when the reference coordinate system origin O and the coordinate system origin O where the ranging sensor is located are selected on the carrier 01 A , we can make α in the above formula o , β o , γ o , αA , β A , γ A The values of and m are quantitative values, and only the value of parameter a is a variable, which will change with the change of the spatial position to be measured, but the value of this parameter can be obtained by the real-time measurement and collection of the corresponding ranging sensor; In addition, the attitude angle θ, ψ can be obtained in real time by the nine-axis gyroscope sensor; therefore, the method of the present invention can make the detection and calculation of the three-dimensional coordinates of the spatial position in the reference coordinate system very simple, and it is easy to achieve efficient and low-cost detection processing.
[0174] In one implementation scheme, the above-mentioned attitude angle θ, The value range of ψ is -180° to 180°.
[0175] Example 2
[0176] See also Figure 4 As shown: a smart device for preventing myopia provided by the present invention is an application example of the method described in Example 1, and the smart device includes a head-mounted carrier (in this embodiment, the glasses frame 02 is taken as an example, but is not limited to this design), a nine-axis gyroscope sensor (not shown in the figure, a known commercial product is selected), at least three ranging sensors (in this embodiment, six are taken as an example, not shown in the figure, a known commercial product is selected) and a single-chip microcomputer (not shown in the figure, a known commercial product is selected), the nine-axis gyroscope sensor and the ranging sensor are both fixedly mounted on the head-mounted carrier (in this embodiment, the glasses frame 02), and the nine-axis gyroscope sensor and the ranging sensor are both connected to the single-chip microcomputer for signal communication; the single-chip microcomputer is preset with 6 groups of calculation formulas for calculating the three-dimensional coordinates of the spatial position in the reference coordinate system according to the method described in Example 1. In order to maintain a clear one-to-one correspondence between each group of calculation formulas and the corresponding ranging sensors, the origins of the coordinate systems where the 6 ranging sensors are located can be respectively recorded as O A , O B , O C , O D , O E , O F , the spatial locations that each ranging sensor is responsible for detecting are recorded as points A, B, C, D, E, and F (such as Figure 5 As shown), then the A involved in the calculation formula in which the spatial site described in Example 1 is recorded as point A is replaced by B or C or D or E or F, and the a involved in the calculation formula is replaced by b or c or d or e or f. For example, if the internal rotation sequence is ZYX, the three-dimensional coordinates of the spatial site B in the reference coordinate system are calculated as follows: The calculation formula is as follows:
[0177]
[0178]
[0179]
[0180] α in the formula O It refers to the origin of the coordinate system where the ranging sensor is located. B The line O connecting the origin O of the reference coordinate system B -The angle between O and X axis, β O It is the connection O B -The angle between O and the Y axis, γ O It is the connection O B -The angle between O and Z axis; α B It refers to the origin of the coordinate system where the ranging sensor is located. B The line O connecting the spatial location B to be measured B -The angle between B and the X axis, β B It is the connection O B -The angle between B and the Y axis, γ B It is the connection O B -B is the angle between the Z axis and the coordinate system origin O where the ranging sensor is located. B The line O connecting the spatial location B to be measured B -The length of B is determined by the coordinate system origin O B The distance sensor is measured, and m is the origin of the coordinate system where the distance sensor is located. B The line O connecting the origin O of the reference coordinate system B -O length.
[0181] As mentioned above, the calculation formula for calculating the three-dimensional coordinates of the spatial loci C, D, E, and F in the reference coordinate system only needs to refer to the formula and definition of point A, replace the letter A in the formula with C, D, E, or F, replace the a involved in the calculation formula with c, d, e, or f, and replace the origin of the coordinate system O in the definition with A All correspondingly replaced by O C / O D / O E / O F , the spatial location A to be tested can be replaced by C / D / E / F accordingly.
[0182] After the reference coordinate system origin O and the coordinate system origin where the ranging sensor is located are selected, the α in each set of formulas can be o , β o , γ o , α A / B / C / D / E / F , β A / B / C / D / E / F , γ A / B / C / D / E / FThe values of and m are all quantitative values, and only the values of parameters a / b / c / d / e / f are variables. However, since the parameters a / b / c / d / e / f refer to the origin of the coordinate system where the ranging sensor is located, A / O B / O C / O D / O E / O F The line O between the spatial location A / B / C / D / E / F to be measured A -A / O B -B / O C -C / O D -D / O E -E / O F -F can be measured in real time by the corresponding distance sensor and sent to the microcontroller; in addition, the attitude angles θ and In other words, when the reference coordinate system origin O is selected on the head-mounted carrier (the eyeglass frame 02 is used as an example in this embodiment, but is not limited to this design), and the nine-axis gyroscope sensor and the six ranging sensors are installed and fixed, the α in each set of formulas can be obtained. o , β o , γ o , α A / B / C / D / E / F , β A / B / C / D / E / F , γ A / B / C / D / E / F The values of θ and m can be used as fixed values to replace the final calculation formula for the three-dimensional coordinates of the spatial site in the reference coordinate system, so that only the variables θ, ψ and a / b / c / d / e / f, and about the variables θ, The value of ψ can be acquired in real time by the nine-axis gyroscope sensor and transmitted to the single-chip microcomputer, while the variables a / b / c / d / e / f can be acquired in real time by the corresponding ranging sensors and transmitted to the single-chip microcomputer, so that the formulas to be calculated in the single-chip microcomputer are very simple, which can make the operation efficiency very high, the calculation cost very low, and it has the advantages of high precision and good accuracy.
[0183] As a preferred solution, the midpoint between the user's eyes on the head-mounted carrier (the eyeglass frame 02 in this embodiment) is used as the origin O of the reference coordinate system, and the six ranging sensors are distributed on the left and right sides of the origin O of the reference coordinate system in a bilaterally symmetrical manner (see Figure 5 As shown); let: the horizontal eastward direction be the X-axis, the horizontal northward direction be the Y-axis, the vertical skyward direction be the Z-axis, θ is the attitude angle rotating around the X-axis following the right-hand rule, representing the angle of the user's head up and down, is the posture angle rotated around the Y axis following the right-hand rule, representing the angle at which the user tilts his head left or right. ψ is the posture angle rotated around the Z axis following the right-hand rule, representing the angle at which the user faces.
[0184] A preferred solution is that the head-mounted carrier (taking the glasses frame 02 as an example in this embodiment) is also provided with a warning module, and the warning module is connected to the single-chip microcomputer signal communication. The warning module is any one of a vibration prompt module, a voice prompt module, and an indicator light prompt module, or a combination of several of them. It is better to contain at least a vibration prompt module. When a situation that does not conform to scientific eye use occurs, a warning reminder is given by vibration, and continuous vibration can be used until the scientific eye use situation is reached, so as to prompt the user to adjust the unhealthy eye use situation in time; the warning module may contain a vibration prompt module and a voice prompt module or / and an indicator light prompt module at the same time, but the voice prompt module and the indicator light prompt module are preferably provided with a selective setting of independent switches; in addition, the head-mounted carrier is preferably provided with a timing module, and the timing module is connected to the single-chip microcomputer signal communication, so as to facilitate statistical analysis of the user's eye use habits.
[0185] In a preferred embodiment, the head-mounted carrier may be provided with a light sensor, and the light sensor is connected to the single-chip microcomputer for signal communication. The light sensor is set to sense the brightness of the eye-using environment to prevent the user from studying in an unscientific lighting environment and causing myopia. For example, if the sensed light intensity is not within the range of 300lx to 600lx, the single-chip microcomputer may give a warning through the warning module. However, when the sensed light intensity is less than 1lx, it is dark at this time and the eyes will not be used, so the single-chip microcomputer does not need to give a warning.
[0186] In one implementation scheme, a touch switch is also provided on the head-mounted carrier to facilitate switch operation and aesthetics.
[0187] In one embodiment, when the head-mounted carrier is a spectacle frame, the spectacle frame may or may not contain a lens, and the lens may be a plano lens or a myopia lens.
[0188] The principle of myopia prevention achieved by the smart device of the present invention is as follows:
[0189] By collecting information on whether the user's eyes are healthy when writing and reading, such as whether the posture or distance meets the requirements for healthy eye use, timely warnings are given to help users develop scientific eye habits and thus prevent myopia.
[0190] The specific working process of the smart device of the present invention to achieve myopia prevention is as follows:
[0191] When the smart device of the present invention is started, the smart device first determines whether it is worn by the user (specifically, a temperature sensor may be provided on the head-mounted carrier constituting the smart device, and the temperature sensor is connected to the single-chip computer for signal communication, and whether the temperature sensed is greater than the room temperature is determined to determine whether it is in the wearing state. For example, if the temperature sensed by the temperature sensor is greater than the room temperature and is maintained for at least 10±5 seconds, it is determined to be in the wearing state); if it is determined to be in the wearing state, then whether it is in the learning state is identified, which can be specifically identified as follows:
[0192] When the value of the posture angle ψ meets the condition of ω-25°<ψ<ω+25°, it is judged as the learning state, otherwise it is judged as the non-learning state; where: ω is the angle value of the initial posture angle ψ corresponding to the user facing the desk (see Figure 6 shown);
[0193] or / and
[0194] When the value of the attitude angle θ meets the condition that θ<10°, it is judged as the learning state, otherwise it is judged as the non-learning state (please refer to Figure 7 shown);
[0195] or / and
[0196] If at least two of the three monitoring sites on the desktop have a Z-axis coordinate greater than -500mm in the reference coordinate system, it is considered to be in a learning state, otherwise it is considered to be in a non-learning state, for example: Figure 8 Among the three points D, E, and F on the desktop, if the microcontroller calculates the Z-axis coordinates of D, E, and F in the reference coordinate system according to the preset formula:
[0197]
[0198] As long as at least two of the three points have a Z-axis coordinate greater than -500mm in the reference coordinate system, it is considered to be in learning state;
[0199] If it is judged to be in the learning state, it will then identify whether it is in the healthy eye use state and give a warning reminder, specifically:
[0200] When the value of the attitude angle θ is θ<-40° and the duration is at least 10±5 seconds, the head-down warning reminder will be triggered and relevant records will be stored. The warning reminder will continue until the value of the attitude angle θ returns to the range of -40°≤θ<10°.
[0201] When the attitude angle or If the duration is at least 10±5 seconds, the excessive head tilt warning will be triggered and relevant records will be stored. The warning will continue until the posture angle The value is restored to Stop when the range is reached;
[0202] If the three monitoring sites on the book (such as Fig. 9 and Fig.10 When the distances (a, b, c) between at least two of the points and the origin of the coordinate system where the distance measuring sensors are located are less than 330 mm and are maintained for at least 10±5 seconds, the warning reminder of the distance between the eyes and the book will be triggered and the relevant records will be stored. The warning reminder will continue until the distances between at least two points are restored to ≥330 mm.
[0203] If the three monitoring sites on the desktop (such as Fig. 9 and Fig.10 In D, E, and F), at least two sites have Z coordinates Z in the reference coordinate system. 0 When the distance between the eyes and the desktop is too close, the warning reminder will be triggered and the relevant records will be stored. The warning reminder will continue until the Z-axis coordinates of at least two points in the reference coordinate system are restored to -500mm<Z 0 It stops when the range is ≤-280mm.
[0204] In a preferred embodiment, the smart device described in the present invention further comprises a cloud server, wherein the cloud server is provided with an eye health record of each user so as to collect statistics and display the vision condition and eye habits of each user in real time.
[0205] Example 3
[0206] See also Fig.11 and Fig.12 As shown: An intelligent device for terrain surveying and mapping provided by the present invention is another application example of the method described in Example 1, comprising a nine-axis gyroscope sensor (not shown in the figure, a known commercial product is selected), a plurality of ranging sensors (not shown in the figure, a known commercial product is selected), a single-chip microcomputer (not shown in the figure, a known commercial product is selected) and a carrying body 03 for fixing and installing the above hardware (the carrying body 03 can also be a tripod or a drone), the nine-axis gyroscope sensor and the ranging sensor are both connected to the single-chip microcomputer for signal communication; the single-chip microcomputer is preset with at least a plurality of groups of calculation formulas for calculating the three-dimensional coordinates of a spatial position in a reference coordinate system according to the above method.
[0207] In order to maintain a clear one-to-one correspondence between each set of calculation formulas and the corresponding ranging sensors, the origins of the coordinate systems where the 16 ranging sensors shown in the figure are located can be respectively denoted as O A , O A1 , O A2 , O A3 , OB1 , O B2 , O B3 , O B4 , O C1 , O C2 , O C3 , O C4 , O D1 , O D2 , O D3 , O D4 , the spatial position detected by each ranging sensor is recorded as point A, A1, A2, A3, B1, B2, B3, B4, C1, C2, C3, C4, D1, D2, D3, D4, and then the A involved in the calculation formula in which the spatial position described in Example 1 is recorded as point A is replaced by A1, A2, A3, B1, B2, B3, B4, C1, C2, C3, C4, D1, D2, D3 or D4, and the a involved in the calculation formula is replaced by a1, a2, a3, b1, b2, b3, b4, c1, c2, c3, c4, d1, d2, d3, d4. For example, if the internal rotation sequence is ZYX, it is used to calculate the three-dimensional coordinates of the spatial position point A1 in the reference coordinate system The calculation formula is as follows:
[0208]
[0209]
[0210]
[0211] α in the formula O It refers to the origin of the coordinate system where the ranging sensor is located. A1 The line O connecting the origin O of the reference coordinate system A1 -The angle between O and X axis, β O It is the connection O A1 -The angle between O and the Y axis, γ O It is the connection O A1 -The angle between O and Z axis; α A1 It refers to the origin of the coordinate system where the ranging sensor is located. A1 The line O connecting the spatial location A1 to be measured A1 -The angle between A1 and X axis, β A1 It is the connection O A1 -The angle between A1 and the Y axis, γ A1 It is the connection O A1 -The angle between A1 and the Z axis; a1 represents the origin of the coordinate system where the ranging sensor is located. A1 The line O connecting the spatial location A1 to be measured A1-The length of A1 is determined by the coordinate system origin O A1 The distance sensor is measured, and m is the origin of the coordinate system where the distance sensor is located. A1 The line O connecting the origin O of the reference coordinate system A1 -O length.
[0212] As mentioned above, the three-dimensional coordinates of the calculated spatial points A2, A3, B1, B2, B3, B4, C1, C2, C3, C4, D1, D2, D3, and D4 in the reference coordinate system can be obtained by reference:
[0213]
[0214] A 3D model can be constructed based on the three-dimensional coordinate values of multiple spatial points in the reference coordinate system, so that a topographic contour map can be obtained; it is also possible to determine whether the plane is horizontal or vertical (such as Fig.13 and Fig.14 shown).
[0215] From the above, it can be seen that the intelligent device for topographic surveying provided by the present invention can accurately calculate the three-dimensional coordinates of each spatial location and the horizontal and vertical differences between the coordinates, so that it can not only intuitively construct a topographic contour map, but also accurately map whether the surveying surface is horizontal or vertical. It is not only simple and efficient to operate, but also the surveying results are accurate and intuitive, and it has obvious practical value.
[0216] It should also be noted that the distance measuring sensor described in the present invention includes but is not limited to any one of a laser distance measuring sensor, an ultrasonic distance measuring sensor and an infrared distance measuring sensor, with a laser distance measuring sensor being preferred, and any commercially available existing product can be used.
[0217] Finally, it is necessary to point out here that the above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto, and any changes or substitutions that can be easily thought of by any technician familiar with the technical field within the technical scope disclosed by the present invention should be covered within the protection scope of the present invention.
Claims
1. A method for intelligently detecting three-dimensional coordinates of a spatial position, comprising a nine-axis gyroscope sensor and at least one ranging sensor, wherein the nine-axis gyroscope sensor and the ranging sensor are both mounted on a carrier capable of realizing their synchronous movement. It is characterized in that The method comprises the following steps: 1) Select any point on the carrier as the origin O of the reference coordinate system, and assume that: the horizontal eastward direction is the X-axis, the horizontal northward direction is the Y-axis, the vertical skyward direction is the Z-axis, and θ is the attitude angle rotating around the X-axis according to the right-hand rule, is the attitude angle of rotation around the Y axis following the right-hand rule, ψ is the attitude angle of rotation around the Z axis following the right-hand rule; α O is the origin of the coordinate system where the ranging sensor is located A The line O connecting the origin O of the reference coordinate system A -The angle between O and X axis, β O It is the connection O A -The angle between O and the Y axis, γ O It is the connection O A -The angle between O and Z axis; α A is the origin of the coordinate system where the ranging sensor is located. A The line O connecting the spatial point A to be measured A -The angle between A and the X axis, β A It is the connection O A -The angle between A and Y axis, γ A It is the connection O A -A is the angle between the Z axis and the Z axis; and a represents O A -A is the length of the line, m represents O A -O The length of the line; 2) Since there are 6 internal rotation sequences of the attitude angle of the nine-axis gyroscope sensor, namely: ZYX, ZXY, YZX, YXZ, XYZ, XZY, the three-dimensional coordinates of the measured spatial point A in the reference coordinate system are calculated according to the following corresponding formula based on the specific internal rotation sequence of the attitude angle of the selected nine-axis gyroscope sensor, specifically: 21) If the internal rotation sequence is ZYX, that is, first rotate around the Z axis, then around the Y axis, and finally around the X axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula is recorded as formula 1, which is as follows: 22) If the internal rotation sequence is ZXY, that is, first rotate around the Z axis, then around the X axis, and finally around the Y axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula is recorded as formula 2, as follows: 23) If the internal rotation sequence is YXZ, that is, first rotate around the Y axis, then around the X axis, and finally around the Z axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula is recorded as formula 3, which is as follows: 24) If the internal rotation sequence is YZX, that is, first rotate around the Y axis, then around the Z axis, and finally around the X axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula is recorded as formula 4, which is as follows: 25) If the internal rotation sequence is XZY, that is, first rotate around the X axis, then around the Z axis, and finally around the Y axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula is recorded as Formula 5, which is as follows: 26) If the internal rotation sequence is XYZ, that is, first rotate around the X axis, then around the Y axis, and finally around the Z axis, then the three-dimensional coordinates of the spatial point A to be measured in the reference coordinate system are The calculation formula is recorded as Formula 6, which is as follows:
2. A smart device for preventing myopia, which uses the method of claim 1 to calculate the three-dimensional coordinates of a spatial position in a reference coordinate system, comprising a head-mounted carrier, a nine-axis gyroscope sensor, at least three distance measuring sensors and a single-chip microcomputer, wherein the nine-axis gyroscope sensor and the distance measuring sensor are both fixedly mounted on the head-mounted carrier, and the nine-axis gyroscope sensor and the distance measuring sensor are both connected to the single-chip microcomputer for signal communication; Features: The single chip microcomputer is preset with at least three groups of formulas from formula 1 to formula 6 in claim 1, and the posture angles θ, The ψ values are acquired in real time by the nine-axis gyroscope sensor and sent to the microcontroller. O , β O , γ O , α A , β A , γ A The parameter values of and m are determined by the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located, and are constants in each set of formulas. The parameter a value in each set of formulas refers to the distance between the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located and the spatial location to be measured, which is acquired in real time by the corresponding ranging sensor and sent to the microcontroller.
3. The smart device for preventing myopia according to claim 2, Features: The head-mounted carrier is also provided with a warning module, which is connected to the single-chip computer signal communication; the warning module is any one of a vibration prompt module, a voice prompt module, and an indicator light prompt module, or a combination of several of them.
4. The smart device for preventing myopia according to claim 2, Features: The head-mounted carrier is also provided with a timing module, and the timing module is connected to the single-chip microcomputer for signal communication.
5. The smart device for preventing myopia according to claim 2, Features: The single chip microcomputer is preset with a judgment module for whether it is in a learning state, and the specific judgment method is: When the value of the posture angle ψ meets ω-25°<ψ<ω+25°, it is judged as a learning state, otherwise it is judged as a non-learning state; where: ω is the angle value of the initial posture angle ψ corresponding to the user facing the desk; or / and When the value of the attitude angle θ meets θ<10°, it is judged as a learning state, otherwise it is judged as a non-learning state; or / and If at least two of the three monitoring sites on the desktop have Z-axis coordinates greater than -500 mm in the reference coordinate system, it is judged to be in a learning state, otherwise it is judged to be a non-learning state.
6. The smart device for preventing myopia according to claim 2 or 5, Features: The single chip microcomputer is also preset with the following functions: When the value of the attitude angle θ meets the condition of θ<-40° and lasts for at least 10±5 seconds, an alarm will be triggered and relevant records will be stored. The alarm will continue until the value of the attitude angle θ returns to the range of -40°≤θ<10°. or / and When the attitude angle or If the duration is at least 10±5 seconds, an alarm will be triggered and relevant records will be stored. The alarm will continue until the attitude angle The value is restored to Stop when the range is reached; or / and If the distance between at least two of the three monitoring sites on the book and the origin of the coordinate system where the corresponding distance measuring sensor is located is less than 330mm and is maintained for at least 10±5 seconds, an alarm will be triggered and relevant records will be stored. The alarm will continue until the distance between at least two sites is restored to ≥330mm. or / and If at least two of the three monitoring sites on the desktop are within the Z-axis coordinate Z of the reference coordinate system, 0 When the Z-axis coordinates of at least two locations in the reference coordinate system are restored to -500mm<Z 0 It stops when the range is ≤-280mm.
7. The smart device for preventing myopia according to claim 2, Features: When the intelligent device for preventing myopia is started, it is first judged whether it is in a wearing state, specifically: a temperature sensor is set on the head-mounted carrier, and the temperature sensor is connected to the single-chip computer for signal communication. If the temperature sensed by the temperature sensor is greater than the room temperature and is maintained for at least 10±5 seconds, it is judged to be in a wearing state.
8. An intelligent device for terrain surveying and mapping, using the method of claim 1 to calculate the three-dimensional coordinates of a spatial position in a reference coordinate system, comprising a nine-axis gyro sensor, a plurality of distance measuring sensors, a single-chip microcomputer, and a carrying body for fixing the nine-axis gyro sensor, the distance measuring sensor, and the single-chip microcomputer, wherein the nine-axis gyro sensor and the distance measuring sensor are both connected to the single-chip microcomputer for signal communication; Features: The single chip microcomputer is preset with multiple groups of formulas from formula 1 to formula 6 in claim 1, and the posture angles θ, The ψ values are acquired in real time by the nine-axis gyroscope sensor and sent to the microcontroller. The parameter α in each set of formulas O , β O , γ O , α A , β A , γ A The values of and m are determined by the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located, and are constants in each set of formulas. The value of parameter a in each set of formulas refers to the distance between the origin of the coordinate system where the ranging sensor corresponding to each set of formulas is located and the spatial location to be measured, which is acquired in real time by the corresponding ranging sensor and sent to the microcontroller.
9. The intelligent device for terrain surveying and mapping according to claim 8, Features: The single chip microcomputer is also preset with the following function: constructing a 3D model diagram according to the three-dimensional coordinate values of multiple spatial locations in the reference coordinate system.
10. The intelligent device for terrain surveying and mapping according to claim 8 or 9, Features: The single chip microcomputer is also preset with the following function: judging whether the plane is horizontal or vertical according to whether there is a difference between the coordinate values of multiple spatial points located on the same plane in the same direction.
