Annular trolley positioning method and system

By using a three-axis angle gyroscope instead of the rotary encoder in the ring car positioning system, the problem of high failure rate in harsh environments of traditional methods is solved, and higher equipment reliability and positioning accuracy are achieved, which is suitable for harsh production sites.

CN118960721APending Publication Date: 2024-11-15CHENGDU RUIJIAHE TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410896717.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-05
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

The traditional method of positioning annular path moving object using a rotary encoder, which has high failure rate and fragility of mechanical structure in harsh field environments, making it difficult to ensure positioning accuracy and equipment reliability.

Method used

A three-axis angle gyroscope is used instead of the rotary encoder, and acceleration integration is performed by measuring the Z-axis angle changes, eliminating mechanical structure coupling, realizing a completely closed gyroscope design for the positioning of the ring car.

Benefits of technology

It improves the service life and reliability of the equipment, enhances environmental tolerance, reduces maintenance difficulty, and is suitable for harsh production sites.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118960721A_ABST
    Figure CN118960721A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of annular path positioning, and particularly relates to an annular trolley positioning method and system. According to the specific technical scheme, the three-axis angle gyroscope is arranged on the mobile equipment, an original point is arranged on an annular path, and the following steps are carried out: S1, when the mobile equipment passes through the original point, the Z-axis angle JZ1 of the three-axis angle gyroscope is recorded; s2, recording the Z-axis angle JZ0 of a three-axis angle gyroscope on the mobile equipment along with the movement of the mobile equipment along the annular path; s3, the mobile device moves along the annular path, the angle deviation value JZ2 of the mobile device relative to the zero point is calculated, and JZ2 = JZ0-JZ1; and S4, the position of the mobile device on the annular path relative to the original point: S0 = S1 * (JZ2 / 360), wherein S1 is the perimeter of the annular path. The gyroscope is used as an annular path positioning core sensor, no mechanical structure exists, mechanical coupling with the outside is not needed, the environment endurance capacity is high, the positioning precision is not affected by a mechanical device, and the method is suitable for various severe production sites.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of circular path positioning, and in particular relates to a circular trolley positioning method and system. Background Art

[0002] In production applications, some specific occasions require circular positioning of moving equipment on a circular path to facilitate better work. For example, in the case of circular path feeding in a factory, multiple feeding points are arranged on the circular path, and the equipment for loading materials needs to be moved to the feeding point. At this time, it is necessary to locate the position of the equipment for loading materials on the circular path. The traditional method of positioning moving objects on a circular path usually uses an encoder plus an origin switch. This method uses precision sensor equipment such as a rotary encoder. This type of sensor generally has poor tolerance to the on-site environment and its own impact resistance. If used in a production site with a relatively harsh on-site environment, there will be a high failure rate. Summary of the invention

[0003] In order to solve the above technical problems, the present invention provides a circular trolley positioning method and system, which uses a three-axis angle gyroscope to replace the rotary encoder device, thereby eliminating all moving mechanical structures of the measuring device. The gyroscope can be completely enclosed in the outer shell, and the internal Z-axis angle change is obtained by integrating its own acceleration. No mechanical coupling with the outside world is required, which greatly improves the service life and reliability of the equipment.

[0004] To achieve the above-mentioned invention object, the technical solution adopted by the present invention is: a circular car positioning method, wherein a three-axis angle gyroscope is set on a mobile device, an origin is set on a circular path, and the following steps are performed:

[0005] S1. When the mobile device passes through the origin, the Z-axis angle JZ1 of the three-axis gyroscope is recorded;

[0006] S2, as the mobile device moves along the circular path, the Z-axis angle JZ0 of the three-axis gyroscope on the mobile device is recorded;

[0007] S3, the mobile device moves along the circular path, and the angular deviation JZ2 of the mobile device relative to the zero point is calculated, JZ2 = JZ0-JZ1;

[0008] S4. The position of the mobile device on the circular path relative to the origin: S0 = S1*(JZ2 / 360), where S1 is the circumference of the circular path.

[0009] Preferably, an origin reset switch is provided at the origin on the circular path, and the origin reset switch resets the Z-axis angle of the three-axis angle gyroscope to an initially set angle.

[0010] Preferably, in step S3, when JZ0 is greater than or equal to JZ1, JZ2=JZ0-JZ1; when JZ0 is less than JZ1, JZ2=(JZ0-JZ1)+360.

[0011] Preferably, the Z-axis angle of the three-axis angle gyroscope at the origin is set to 0°, and JZ2 = JZ0 - JZ1.

[0012] Preferably, when the mobile device moves on the circular path, the total mileage L of the mobile device after leaving the origin is recorded in real time. When the total mileage L is greater than a preset total mileage threshold L0, the mobile device is controlled to return to the origin.

[0013] Accordingly, a circular car positioning system includes a three-axis angle gyroscope, a microprocessor, and a display, wherein the three-axis angle gyroscope is communicatively connected to the microprocessor, and the microprocessor is communicatively connected to the display;

[0014] The three-axis angle gyroscope is arranged on the mobile device, and when the mobile device moves along the circular path, the Z-axis angle JZ0 measured by the three-axis angle gyroscope is transmitted to the microprocessor in real time;

[0015] The microprocessor receives the Z-axis angle JZ0 measured by the three-axis angle gyroscope in real time, calculates the position of the mobile device on the circular path relative to the origin in real time, and transmits the calculation result to the display for display.

[0016] Preferably, the system also includes a mileage recording unit and an alarm unit. The mileage recording unit records in real time the total mileage L of the mobile device after it leaves the origin, and transmits the total mileage L to the microprocessor for analysis. When the total mileage L is greater than a preset total mileage threshold L0, the microprocessor controls the mobile device to return to the origin and controls the alarm unit to sound an alarm.

[0017] Preferably, the microprocessor includes an angle judgment module, a mileage judgment module, a calculation and analysis module, and a storage module. The angle judgment module and the mileage judgment module are in communication connection with the calculation and analysis module, and the calculation and analysis module is in communication connection with the storage module.

[0018] The angle judgment module judges the size between JZ0 and JZ1, calculates the angle deviation JZ2, and transmits the calculated angle deviation JZ2 to the calculation and analysis module; when JZ0 is greater than or equal to JZ1, JZ2=JZ0-JZ1; when JZ0 is less than JZ1, JZ2=(JZ0-JZ1)+360; the calculation and analysis module calculates the position of the mobile device on the circular path relative to the origin: S0=S1*(JZ2 / 360), S1 is the circumference of the circular path; the calculation and analysis module transmits the positioning calculation results to the display and storage module;

[0019] The mileage recording unit transmits the recorded total mileage L to the mileage judgment module, and the mileage judgment module judges whether the total mileage L of the mobile device after leaving the origin is greater than the preset total mileage threshold L0, and transmits the judgment result to the calculation and analysis module; the calculation and analysis module controls the operation of the mobile device and the alarm unit according to the mileage judgment result, and transmits the mileage judgment result to the storage module.

[0020] Preferably, the system further comprises an origin reset switch arranged at the origin, the calculation and analysis module controls the operation of the origin reset switch, and the origin reset switch resets the Z-axis angle of the three-axis angle gyroscope to an initially set angle.

[0021] The present invention has the following beneficial effects:

[0022] This method uses a gyroscope as the core sensor for annular path positioning. It has no mechanical structure and does not require mechanical coupling with the outside world. It can be installed inside various types of shells. It has strong environmental tolerance, extremely high hardware reliability, easy maintenance, and the positioning accuracy is not affected by mechanical devices. It is suitable for various harsh production sites. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 A schematic diagram of a mobile device of the present invention along a circular path;

[0024] Figure 2 It is a structural block diagram of the circular trolley positioning system of the present invention. DETAILED DESCRIPTION

[0025] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Unless otherwise specified, the technical means used in the embodiments are conventional means well known to those skilled in the art.

[0026] like Figure 1 As shown, the present invention discloses a method for positioning a circular vehicle, wherein a three-axis angle gyroscope is set on a mobile device, the three-axis angle gyroscope is allowed to move with the mobile device, an origin is set at a suitable path point on the circular path, and then the following steps are performed:

[0027] S1. When the mobile device passes through the origin, the Z-axis angle JZ1 of the three-axis gyroscope is recorded;

[0028] S2. As the mobile device moves along the circular path, the Z-axis angle JZ0 of the three-axis gyroscope on the mobile device is recorded; JZ0 will change along the circular path, and the angle of the mobile device changes 360° in one movement;

[0029] S3, the mobile device moves along the circular path, and the angular deviation JZ2 of the mobile device relative to the zero point is calculated, JZ2 = JZ0-JZ1;

[0030] S4. The position of the mobile device on the circular path relative to the origin: S0 = S1*(JZ2 / 360), where S1 is the circumference of the circular path.

[0031] The mobile device can be a sports car or other moving equipment. The output value of the three-axis angle gyroscope is 0-360°. The appropriate path point is determined according to the specific application scenario. For example, in the factory feeding scenario, the origin is generally set at the loading point.

[0032] Furthermore, an origin reset switch is provided at the origin on the circular path, and the origin reset switch resets the Z-axis angle of the three-axis angle gyroscope to an initially set angle.

[0033] Furthermore, in step S3, the JZ1 angle at the origin is not necessarily set to 0°; when JZ0 is greater than or equal to JZ1, JZ2=JZ0-JZ1; when JZ0 is less than JZ1, JZ2=(JZ0-JZ1)+360. In a preferred technical solution, the Z-axis angle of the three-axis angle gyroscope at the origin is set to 0°, and JZ2=JZ0-JZ1.

[0034] Furthermore, considering that the Z-axis angle of the three-axis gyroscope is obtained by integrating the acceleration, after a long period of integration calculation, the error will gradually accumulate and become larger. Therefore, it is necessary to record the total mileage of the mobile device after leaving the origin, and limit the total mileage within a certain range. If the total mileage limit is reached, the mobile device needs to be controlled to return to the origin to reset the angle starting point to minimize the accumulated error. Specifically, when the mobile device moves on the circular path, the total mileage L of the mobile device after leaving the origin is recorded in real time. When the total mileage L is greater than the preset total mileage threshold L0, the mobile device is controlled to return to the origin.

[0035] Using a three-axis angle gyroscope to replace the rotary encoder device can eliminate all moving mechanical structures of the measuring device. The three-axis angle gyroscope can be completely enclosed in the housing, and the internal Z-axis angle change is obtained by integrating its own acceleration. It does not require mechanical coupling with the outside world, which greatly improves the service life and reliability of the equipment.

[0036] like Figure 2 As shown, the present invention also discloses a ring-shaped car positioning system, including a three-axis angle gyroscope, a microprocessor, and a display, wherein the three-axis angle gyroscope is communicatively connected to the microprocessor, and the microprocessor is communicatively connected to the display;

[0037] The three-axis angle gyroscope is arranged on the mobile device. When the mobile device moves along the circular path, the Z-axis angle JZ0 measured by the three-axis angle gyroscope is transmitted to the microprocessor in real time.

[0038] The microprocessor receives the Z-axis angle JZ0 measured by the three-axis angle gyroscope in real time, calculates the position of the mobile device on the circular path relative to the origin in real time, and transmits the calculation result to the display for display. The microprocessor and the display may be set on the mobile device or not, depending on actual needs.

[0039] Furthermore, the system also includes a mileage recording unit and an alarm unit. The mileage recording unit records the total mileage L of the mobile device after it leaves the origin in real time, and transmits the total mileage L to the microprocessor for analysis. When the total mileage L is greater than a preset total mileage threshold L0, the microprocessor controls the mobile device to return to the origin and controls the alarm unit to sound an alarm. The mileage recording unit is set on the mobile device.

[0040] Furthermore, the microprocessor includes an angle determination module, a mileage determination module, a calculation and analysis module, and a storage module. The angle determination module and the mileage determination module are in communication connection with the calculation and analysis module, and the calculation and analysis module is in communication connection with the storage module.

[0041] The angle judgment module judges the size between JZ0 and JZ1, calculates the angle deviation JZ2, and transmits the calculated angle deviation JZ2 to the calculation and analysis module; when JZ0 is greater than or equal to JZ1, JZ2=JZ0-JZ1; when JZ0 is less than JZ1, JZ2=(JZ0-JZ1)+360; the calculation and analysis module calculates the position of the mobile device on the circular path relative to the origin: S0=S1*(JZ2 / 360), S1 is the circumference of the circular path; the calculation and analysis module transmits the positioning calculation results to the display and storage module;

[0042] The mileage recording unit transmits the recorded total mileage L to the mileage judgment module, and the mileage judgment module judges whether the total mileage L of the mobile device after leaving the origin is greater than the preset total mileage threshold L0, and transmits the judgment result to the calculation and analysis module; the calculation and analysis module controls the operation of the mobile device and the alarm unit according to the mileage judgment result, and transmits the mileage judgment result to the storage module.

[0043] Furthermore, the system also includes an origin reset switch arranged at the origin, and the calculation and analysis module controls the operation of the origin reset switch, and the origin reset switch resets the Z-axis angle of the three-axis angle gyroscope to an initially set angle.

[0044] The embodiments described above are only descriptions of the preferred modes of the present invention and are not intended to limit the scope of the present invention. Without departing from the design spirit of the present invention, various deformations, modifications, and substitutions made to the technical solutions of the present invention by ordinary technicians in this field should all fall within the protection scope determined by the claims of the present invention.

Claims

1. A method for positioning a circular trolley. Features: Set the three-axis angular gyroscope on the mobile device, set the origin on the circular path, and perform the following steps: S1. When the mobile device passes through the origin, the Z-axis angle JZ1 of the three-axis gyroscope is recorded; S2, as the mobile device moves along the circular path, the Z-axis angle JZ0 of the three-axis gyroscope on the mobile device is recorded; S3, the mobile device moves along the circular path, and the angular deviation JZ2 of the mobile device relative to the zero point is calculated, JZ2 = JZ0-JZ1; S4. The position of the mobile device on the circular path relative to the origin: S0 = S1*(JZ2 / 360), where S1 is the circumference of the circular path.

2. A method for positioning a circular trolley according to claim 1, Features: An origin reset switch is provided at the origin on the circular path, and the origin reset switch resets the Z-axis angle of the three-axis angle gyroscope to an initially set angle.

3. A method for positioning a circular trolley according to claim 1, Features: In step S3, when JZ0 is greater than or equal to JZ1, JZ2=JZ0-JZ1; When JZ0 is less than JZ1, JZ2=(JZ0-JZ1)+360.

4. A method for positioning a circular trolley according to claim 1, Features: The Z-axis angle of the three-axis angular gyroscope at the origin is set to 0°, JZ2 = JZ0 - JZ1.

5. A method for positioning a circular trolley according to claim 1, Features: When the mobile device moves on the circular path, the total mileage L of the mobile device after leaving the origin is recorded in real time. When the total mileage L is greater than the preset total mileage threshold L0, the mobile device is controlled to return to the origin.

6. A positioning system corresponding to the circular trolley positioning method according to any one of claims 1 to 5, Features: It includes a three-axis angle gyroscope, a microprocessor, and a display, wherein the three-axis angle gyroscope is communicatively connected to the microprocessor, and the microprocessor is communicatively connected to the display; The three-axis angle gyroscope is arranged on the mobile device, and when the mobile device moves along the circular path, the Z-axis angle JZ0 measured by the three-axis angle gyroscope is transmitted to the microprocessor in real time; The microprocessor receives the Z-axis angle JZ0 measured by the three-axis angle gyroscope in real time, calculates the position of the mobile device on the circular path relative to the origin in real time, and transmits the calculation result to the display for display.

7. The positioning system according to claim 6, Features: The system also includes a mileage recording unit and an alarm unit. The mileage recording unit records in real time the total mileage L of the mobile device after it leaves the origin, and transmits the total mileage L to the microprocessor for analysis. When the total mileage L is greater than a preset total mileage threshold L0, the microprocessor controls the mobile device to return to the origin and controls the alarm unit to sound an alarm.

8. The positioning system according to claim 7, Features: The microprocessor includes an angle judgment module, a mileage judgment module, a calculation and analysis module, and a storage module. The angle judgment module and the mileage judgment module are in communication connection with the calculation and analysis module, and the calculation and analysis module is in communication connection with the storage module. The angle judgment module judges the size between JZ0 and JZ1, calculates the angle deviation JZ2, and transmits the calculated angle deviation JZ2 to the calculation and analysis module; when JZ0 is greater than or equal to JZ1, JZ2=JZ0-JZ1; When JZ0 is less than JZ1, JZ2=(JZ0-JZ1)+360; the calculation and analysis module calculates the position of the mobile device on the circular path relative to the origin: S0=S1*(JZ2 / 360), where S1 is the circumference of the circular path; The calculation and analysis module transmits the positioning calculation results to the display and storage module; The mileage recording unit transmits the recorded total mileage L to the mileage judgment module, and the mileage judgment module judges whether the total mileage L of the mobile device after leaving the origin is greater than the preset total mileage threshold L0, and transmits the judgment result to the calculation and analysis module; The calculation and analysis module controls the operation of the mobile device and the alarm unit according to the mileage determination result, and transmits the mileage determination result to the storage module.

9. The positioning system according to claim 8, Features: The system also includes an origin reset switch arranged at the origin, the calculation and analysis module controls the operation of the origin reset switch, and the origin reset switch resets the Z-axis angle of the three-axis angle gyroscope to an initially set angle.