CN112684741A - Three-axis turntable overspeed protection system and method - Google Patents
Three-axis turntable overspeed protection system and method Download PDFInfo
- Publication number
- CN112684741A CN112684741A CN202011521169.3A CN202011521169A CN112684741A CN 112684741 A CN112684741 A CN 112684741A CN 202011521169 A CN202011521169 A CN 202011521169A CN 112684741 A CN112684741 A CN 112684741A
- Authority
- CN
- China
- Prior art keywords
- rotating shaft
- overspeed protection
- signal
- speed
- frame rotating
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
- Gyroscopes (AREA)
Abstract
The invention relates to a three-axis turntable overspeed protection system and a method thereof, the protection system comprises a first rate gyroscope, a second rate gyroscope, a direct current tachometer and a first signal converter, the first speed gyroscope and the second speed gyroscope respectively acquire speed information of the middle frame rotating shaft and the outer frame rotating shaft, the direct current speed measuring machine is arranged at the shaft end of the inner frame rotating shaft and is used for acquiring speed information of the inner frame rotating shaft, the first signal converter is connected with the first speed gyroscope and the second speed gyroscope, the second signal converter is connected with the direct current speed measuring machine, the FPGA decoder is respectively connected with the first signal converter, the second signal converter and the upper computer, and the driver is connected with the FPGA decoder. The invention can improve the real-time performance and accuracy of the turntable overspeed protection, and increase the adaptive range of the overspeed protection and the reliability of the system.
Description
Technical Field
The invention relates to the technical field of motion control, in particular to a three-axis turntable overspeed protection system and a three-axis turntable overspeed protection method.
Background
The turntable is used as main equipment for inertial navigation testing, and needs to have an accurate rotating speed control function in the movement process, but once the rotating speed is out of control, the condition of equipment overspeed and even 'runaway' can occur, and unpredictable risks are brought to experiments and testing products.
The most important of the overspeed protection technology is to perform overspeed judgment and treatment after overspeed in real time. In the related technology, the overspeed protection of the rotary table mainly depends on the angular position feedback value of a sensor to carry out differential operation, the instantaneous speed is calculated and compared with the instruction speed to carry out error judgment, the processing measure is to disconnect the servo closed-loop control, and the rotary table is freely decelerated to stop.
Although the overspeed protection method can meet the test requirements of most products, the following problems still exist for certain inertial navigation products with strict requirements on the rotating speed: the redundancy protection is lacked, all data sources are all based on the angular position encoder, once the encoder fails and the reading is abnormal, the speed judgment is invalid, and the protection effect cannot be achieved; the real-time performance of the actual speed is low, the accuracy is low, the noise is large, the interference is brought to speed judgment, the actual speed is obtained by carrying out differential calculation on a position value, the differential calculation has certain hysteresis, the differential calculation can introduce large noise, the calculated value has large fluctuation and low accuracy, the misjudgment is easy to carry out if the judgment condition is strictly set, and the protection effect cannot be realized if the condition is wide; the speed out-of-tolerance threshold is fixed, and the same control effect cannot be achieved in different speed ranges; all judgments are software processing, and the safety is not enough.
Disclosure of Invention
The embodiment of the invention provides a triaxial turntable overspeed protection system, which can improve the real-time performance and accuracy of turntable overspeed protection, and increase the application range of overspeed protection and the reliability of the system.
The embodiment of the invention also provides a three-axis turntable overspeed protection method.
In a first aspect, an embodiment of the present invention provides an overspeed protection system for a three-axis turntable, where the turntable includes an inner frame rotating shaft, an outer frame rotating shaft, and a middle frame rotating shaft, and the protection system includes: the device comprises a middle frame rotating shaft, a first speed gyroscope, a second speed gyroscope and a controller, wherein the middle frame rotating shaft is arranged on the outer frame rotating shaft; the direct current speed measuring machine is connected with the inner frame rotating shaft and arranged at the shaft end of the inner frame rotating shaft, and the direct current speed measuring machine is used for acquiring the speed information of the inner frame rotating shaft and generating a voltage analog signal; the first signal converter is connected with the first rate gyroscope and the second rate gyroscope and is used for converting differential digital signals generated by the first rate gyroscope and the second rate gyroscope into a first single-ended digital signal; the second signal converter is connected with the direct current tachometer and used for converting a voltage analog signal generated by the direct current tachometer into a second single-ended digital signal; the FPGA decoder is respectively connected with the first signal converter and the second signal converter and is suitable for being connected with an upper computer; and the driver is connected with the FPGA decoder and used for driving the inner frame rotating shaft, the outer frame rotating shaft and the middle frame rotating shaft to rotate.
Preferably, the first signal converter is a differential single-ended converter, and the second signal converter is a high-precision AD converter
Preferably, the three-axis rotary table overspeed protection system further comprises a controller, wherein the controller is connected with the FPGA decoder and is used for closed-loop control of the rotary table.
Preferably, the three-axis rotary table overspeed protection system further comprises a relay, the relay is respectively connected with the driver and the FPGA decoder, and the relay is used for controlling the driver to be turned on or turned off.
In a second aspect, an embodiment of the present invention provides a three-axis turntable overspeed protection method, including the three-axis overspeed protection system described in any one of the first aspects, where the overspeed protection method includes the following steps:
s1: the first signal converter converts differential digital signals generated by the first rate gyroscope and the second rate gyroscope into a first single-ended digital signal and transmits the first single-ended digital signal to the FPGA decoder, and the second signal converter converts a voltage analog signal generated by the direct current tachometer into a second single-ended digital signal and transmits the second single-ended digital signal to the FPGA decoder;
s2: the FPGA decoder decodes the first single-ended digital signal and the second single-ended digital signal to obtain a real-time rotating speed value V1 of the rotary table rotating shaft;
s3: the FPGA decoder reads a preset rotating speed value V0 of the rotary table rotating shaft sent by the upper computer;
s4: comparing the difference Err between the real-time rotating speed value V1 and the preset rotating speed value V0 with a preset threshold value M by the FPGA decoder;
s5: if Err is larger than or equal to M, entering an overspeed protection step, and if Err is smaller than M, repeating the steps S1-S4.
Preferably, the preset threshold M ═ Km × V0, where Km is an overspeed coefficient, and M ═ 1,2,3 …, N, where N is the speed segment number.
Preferably, the step of overspeed protection is that the FPGA decoder outputs two paths of signals, one path of signal is transmitted to the controller to close the turntable closed-loop control, the other path of signal is transmitted to the relay to close the relay, and then the driver is closed.
In summary, the invention has the following beneficial effects:
1. the rate gyroscopes are arranged on the middle frame rotating shaft and the outer frame rotating shaft, and the direct current speed measuring machine is arranged on the inner frame rotating shaft, so that speed coupling among three-axis motions is avoided, the complexity of a protection mechanism is reduced, the accuracy is improved, the real-time performance and the accuracy of actual speed reading are improved, and out-of-control system caused by controller jitter, external interference, feedback angle position sensor faults and the like can be avoided.
2. Different overspeed coefficients are set according to different speed ranges, so that the size of an overspeed judgment threshold value is changed, and the adaptive range of overspeed protection is improved.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings needed to be used in the embodiments of the present invention will be briefly described below, and it is obvious that the drawings described below are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings based on these drawings without creative efforts.
Fig. 1 is a schematic flow chart of a three-axis turntable overspeed protection method according to an embodiment of the present invention.
Detailed Description
The embodiments of the present invention will be described in further detail with reference to the drawings and examples. The following detailed description of the embodiments and the accompanying drawings are provided to illustrate the principles of the invention and are not intended to limit the scope of the invention, i.e., the invention is not limited to the embodiments described, but covers any modifications, alterations, and improvements in the parts, components, and connections without departing from the spirit of the invention.
It should be noted that the embodiments and features of the embodiments in the present application may be combined with each other without conflict. The present application will be described in detail below with reference to the embodiments with reference to the attached drawings.
The embodiment of the invention provides a three-axis turntable overspeed protection system, wherein a turntable comprises an inner frame rotating shaft, an outer frame rotating shaft and a middle frame rotating shaft, and the three-axis turntable overspeed protection system comprises a first rate gyroscope, a second rate gyroscope, a direct current tachometer, a first signal converter, a second signal converter, an FPGA decoder and a driver.
The first rate gyroscope is connected with the middle frame rotating shaft and arranged at the shaft end of the middle frame rotating shaft, the second rate gyroscope is connected with the outer frame rotating shaft and arranged at the shaft end of the outer frame rotating shaft, the first rate gyroscope is used for collecting speed information of the middle frame rotating shaft and generating a differential digital signal, and the second rate gyroscope is used for collecting speed information of the outer frame rotating shaft and generating a differential digital signal. Specifically, the differential digital signals generated by the first rate gyroscope and the second rate gyroscope in the present application are RS422 differential digital signals. It can be understood that the present application does not specifically limit the type and type of rate gyroscope, and the rate gyroscope in the present application is an existing device, and the specific type selection can be adaptively adjusted according to actual needs.
The direct current tachometer is connected with the inner frame rotating shaft and arranged at the shaft end of the inner frame rotating shaft, and the direct current tachometer is used for acquiring the speed information of the inner frame rotating shaft and generating a voltage analog signal. It can be understood that the type of the dc tachometer is not specifically limited in the present application, and since the dc tachometer in the present application is an existing device, the specific type selection can be adaptively adjusted according to actual needs.
The first signal converter is connected with the first rate gyroscope and the second rate gyroscope and used for converting differential digital signals generated by the first rate gyroscope and the second rate gyroscope into a first single-ended digital signal. It should be understood that the type of the first signal converter is not specifically limited in this application, and since the first signal converter in this application is an existing device, the specific type can be adaptively adjusted according to actual needs.
The second signal converter is connected with the direct current tachometer and used for converting a voltage analog signal generated by the direct current tachometer into a second single-ended digital signal. It should be understood that the second signal converter is not specifically limited in the present application, and since the second signal converter in the present application is an existing device, the specific type can be adaptively adjusted according to actual needs.
The FPGA decoder is connected with the first signal converter and the second signal converter respectively and is suitable for being connected with an upper computer. It can be understood that the present application does not specifically limit the type of the FPGA decoder, and the specific type of the FPGA decoder in the present application is an existing device, and can be adaptively adjusted according to actual needs.
The driver is connected with the FPGA decoder and used for driving the inner frame rotating shaft, the outer frame rotating shaft and the middle frame rotating shaft to rotate. It should be understood that the present application does not specifically limit the type of the driver, and for example, the driver may be a dc servo driver, and since the driver in the present application is an existing device, the specific type may be adaptively adjusted according to actual needs.
According to the overspeed protection system of the three-axis turntable, the rate gyroscopes are arranged on the middle frame rotating shaft and the outer frame rotating shaft, the direct-current tachometer is arranged on the inner frame rotating shaft, so that the speed coupling among three-axis motions is avoided, the complexity of a protection mechanism is reduced, the accuracy is improved, the real-time performance and the accuracy of actual speed reading are improved, and the system out of control caused by controller shaking, external interference, feedback angular position sensor faults and the like can be avoided.
In some embodiments, the first signal converter is a differential-to-single-ended converter, the differential-to-single-ended converter includes a differential-to-single-ended conversion circuit therein, the second signal converter is a high-precision AD converter, and the high-precision AD converter includes a high-precision AD conversion circuit therein. It should be understood that the types of the first signal converter and the second signal converter in the present application are not limited thereto, and the differential single-ended conversion circuit and the high-precision AD conversion circuit in the present application are all prior art in the field, and are not described herein in detail.
In some embodiments, the three-axis turntable overspeed protection system further comprises a controller, the controller is connected with the FPGA decoder, and the controller is used for closed-loop control of the turntable.
In some embodiments, the three-axis turntable overspeed protection system further comprises a relay, the relay is respectively connected with the driver and the FPGA decoder, and the relay is used for controlling the driver to be turned on or off.
The three-axis turntable overspeed protection method according to the embodiment of the present invention is described below with reference to fig. 1, and includes the three-axis overspeed protection system according to the embodiment of the present invention, and the overspeed protection method includes the following steps:
s1: the first signal converter converts differential digital signals generated by the first rate gyroscope and the second rate gyroscope into first single-ended digital signals and transmits the first single-ended digital signals to the FPGA decoder, and the second signal converter converts voltage analog signals generated by the direct current tachometer into second single-ended digital signals and transmits the second single-ended digital signals to the FPGA decoder.
S2: and the FPGA decoder decodes the first single-ended digital signal and the second single-ended digital signal to obtain a real-time rotating speed value V1 of the rotary table rotating shaft.
S3: the FPGA decoder reads a preset rotating speed value V0 of the rotary table rotating shaft sent by the upper computer.
S4: and the FPGA decoder compares the difference Err between the real-time rotating speed value V1 and the preset rotating speed value V0 with a preset threshold value M. Specifically, Err ═ V1-VO.
S5: if Err is larger than or equal to M, entering an overspeed protection step, and if Err is smaller than M, repeating the steps S1-S4.
In some embodiments, the preset threshold M-Km × V0, where Km is the overspeed factor, and M-1, 2,3 …, N, where N is the speed segment number.
According to the overspeed protection method of the three-axis turntable, different overspeed coefficients can be set according to different speed ranges, so that the size of an overspeed judgment threshold value is changed, and the application range of overspeed protection is widened.
In some embodiments, the overspeed protection step is that the FPGA decoder outputs two signals, one signal is transmitted to the controller to turn off the turntable closed-loop control, and the other signal is transmitted to the relay to turn off the relay, and then turn off the driver.
It should be clear that the embodiments in this specification are described in a progressive manner, and the same or similar parts in the embodiments are referred to each other, and each embodiment focuses on the differences from the other embodiments. For embodiments of the method, reference is made to the description of the apparatus embodiments in part. The present invention is not limited to the specific steps and structures described above and shown in the drawings. Also, a detailed description of known process techniques is omitted herein for the sake of brevity.
The above description is only an example of the present application and is not limited to the present application. Various modifications and alterations to this application will become apparent to those skilled in the art without departing from the scope of this invention. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included in the scope of the claims of the present application.
Claims (7)
1. The utility model provides a triaxial revolving stage overspeed protection system, the revolving stage includes inside casing pivot, frame pivot and center frame pivot, its characterized in that, protection system includes:
the device comprises a middle frame rotating shaft, a first speed gyroscope, a second speed gyroscope and a controller, wherein the middle frame rotating shaft is arranged on the outer frame rotating shaft;
the direct current speed measuring machine is connected with the inner frame rotating shaft and arranged at the shaft end of the inner frame rotating shaft, and the direct current speed measuring machine is used for acquiring the speed information of the inner frame rotating shaft and generating a voltage analog signal;
the first signal converter is connected with the first rate gyroscope and the second rate gyroscope and is used for converting differential digital signals generated by the first rate gyroscope and the second rate gyroscope into a first single-ended digital signal;
the second signal converter is connected with the direct current tachometer and used for converting a voltage analog signal generated by the direct current tachometer into a second single-ended digital signal;
the FPGA decoder is respectively connected with the first signal converter and the second signal converter and is suitable for being connected with an upper computer;
and the driver is connected with the FPGA decoder and used for driving the inner frame rotating shaft, the outer frame rotating shaft and the middle frame rotating shaft to rotate.
2. The three-axis turret overspeed protection system of claim 1, wherein said first signal converter is a differential single-ended converter and said second signal converter is a high-precision AD converter.
3. The three-axis turntable overspeed protection system of claim 1 or 2, further comprising a controller, said controller being connected to said FPGA decoder, said controller being for closed-loop control of the turntable.
4. The three-axis rotary table overspeed protection system of claim 1 or 2, further comprising relays connected to said drivers and said FPGA decoders, respectively, said relays being configured to control said drivers to turn on or off.
5. A three-axis turret overspeed protection method comprising the three-axis overspeed protection system of any of claims 1-4, characterized in that said overspeed protection method comprises the steps of:
s1: the first signal converter converts differential digital signals generated by the first rate gyroscope and the second rate gyroscope into a first single-ended digital signal and transmits the first single-ended digital signal to the FPGA decoder, and the second signal converter converts a voltage analog signal generated by the direct current tachometer into a second single-ended digital signal and transmits the second single-ended digital signal to the FPGA decoder;
s2: the FPGA decoder decodes the first single-ended digital signal and the second single-ended digital signal to obtain a real-time rotating speed value V1 of the rotary table rotating shaft;
s3: the FPGA decoder reads a preset rotating speed value V0 of the rotary table rotating shaft sent by the upper computer;
s4: comparing the difference Err between the real-time rotating speed value V1 and the preset rotating speed value V0 with a preset threshold value M by the FPGA decoder;
s5: if Err is larger than or equal to M, entering an overspeed protection step, and if Err is smaller than M, repeating the steps S1-S4.
6. The three-axis turret overspeed protection method of claim 5, wherein said preset threshold value M-Km × V0, where Km is an overspeed factor and M-1, 2,3 …, N, where N is a speed fraction.
7. The three-axis rotary table overspeed protection method according to claim 5 or 6, characterized in that the overspeed protection step is that the FPGA decoder outputs two signals, one signal is transmitted to a controller to turn off the rotary table closed-loop control, the other signal is transmitted to the relay to turn off the relay, and then the driver is turned off.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011521169.3A CN112684741B (en) | 2020-12-21 | 2020-12-21 | Three-axis turntable overspeed protection system and method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011521169.3A CN112684741B (en) | 2020-12-21 | 2020-12-21 | Three-axis turntable overspeed protection system and method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112684741A true CN112684741A (en) | 2021-04-20 |
| CN112684741B CN112684741B (en) | 2023-01-13 |
Family
ID=75450007
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011521169.3A Active CN112684741B (en) | 2020-12-21 | 2020-12-21 | Three-axis turntable overspeed protection system and method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112684741B (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113984088A (en) * | 2021-10-11 | 2022-01-28 | 北京信息科技大学 | Multi-position automatic calibration method, device and system for MEMS (micro electro mechanical System) inertial sensor |
| CN114279481A (en) * | 2021-11-25 | 2022-04-05 | 季华实验室 | Encoder rotating speed fluctuation testing system and method |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4418306A (en) * | 1981-11-06 | 1983-11-29 | The United States Of America As Represented By The Secretary Of The Navy | Directional data stabilization system |
| CN104777850A (en) * | 2015-03-30 | 2015-07-15 | 中国电子科技集团公司第三十八研究所 | High-accuracy and splittable three-axis turntable control system |
| US20160223357A1 (en) * | 2015-02-04 | 2016-08-04 | Bae Systems Information And Electronic Systems Integrations Inc. | Apparatus and method for inertial sensor calibration |
| CN106155102A (en) * | 2015-03-31 | 2016-11-23 | 北京航天计量测试技术研究所 | Turntable based on Multi-sensor Fusion is spacing, speed-limiting protection system |
| CN109405852A (en) * | 2018-12-17 | 2019-03-01 | 北京无线电测量研究所 | A kind of three Axle mould analog quantity Gyro Calibration system and methods |
| CN209541769U (en) * | 2018-12-21 | 2019-10-25 | 深圳市恒讯驰技术有限公司 | A kind of Gyro Test System and device |
-
2020
- 2020-12-21 CN CN202011521169.3A patent/CN112684741B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4418306A (en) * | 1981-11-06 | 1983-11-29 | The United States Of America As Represented By The Secretary Of The Navy | Directional data stabilization system |
| US20160223357A1 (en) * | 2015-02-04 | 2016-08-04 | Bae Systems Information And Electronic Systems Integrations Inc. | Apparatus and method for inertial sensor calibration |
| CN104777850A (en) * | 2015-03-30 | 2015-07-15 | 中国电子科技集团公司第三十八研究所 | High-accuracy and splittable three-axis turntable control system |
| CN106155102A (en) * | 2015-03-31 | 2016-11-23 | 北京航天计量测试技术研究所 | Turntable based on Multi-sensor Fusion is spacing, speed-limiting protection system |
| CN109405852A (en) * | 2018-12-17 | 2019-03-01 | 北京无线电测量研究所 | A kind of three Axle mould analog quantity Gyro Calibration system and methods |
| CN209541769U (en) * | 2018-12-21 | 2019-10-25 | 深圳市恒讯驰技术有限公司 | A kind of Gyro Test System and device |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113984088A (en) * | 2021-10-11 | 2022-01-28 | 北京信息科技大学 | Multi-position automatic calibration method, device and system for MEMS (micro electro mechanical System) inertial sensor |
| CN113984088B (en) * | 2021-10-11 | 2024-01-26 | 北京信息科技大学 | Multi-position automatic calibration method, device and system for MEMS inertial sensor |
| CN114279481A (en) * | 2021-11-25 | 2022-04-05 | 季华实验室 | Encoder rotating speed fluctuation testing system and method |
| CN114279481B (en) * | 2021-11-25 | 2023-09-19 | 季华实验室 | System and method for testing fluctuation of rotating speed of encoder |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112684741B (en) | 2023-01-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112684741B (en) | Three-axis turntable overspeed protection system and method | |
| CN107533325B (en) | Mechanical motion track measuring device | |
| US10335959B2 (en) | Joint driving apparatus and robot apparatus | |
| KR100423713B1 (en) | Servocontrol | |
| KR101528090B1 (en) | Robot and robot noise removal method | |
| KR101440702B1 (en) | Parallel drive system | |
| WO2010088251A1 (en) | Secondary position feedback control of a robot | |
| JPH0230522B2 (en) | ||
| CN108983672A (en) | A kind of control system applied to high-precision six-freedom degree optical module adjustment mechanism | |
| CN104914864A (en) | Mobile device, mobile device control system and control method | |
| De Jager | Acceleration assisted tracking control | |
| CN111464097A (en) | Method for identifying rotational inertia of permanent magnet synchronous motor offline | |
| JP2004507827A (en) | Observer-corrector control system for unmodeled dynamics systems | |
| CN104115083A (en) | Servo control device | |
| JP2005316937A (en) | Control device and its control method | |
| RU2494345C1 (en) | Multi-purpose wide-range test bench for monitoring of angular velocity metres | |
| US11691663B2 (en) | Steering control device | |
| CN106155141A (en) | Improve the rotating platform control system of turntable robustness and the adjustment method based on this system | |
| Kogelis et al. | Design of Low-Level Hardware for a Multi-Layered Control Architecture | |
| CN111076611A (en) | Testing device of high-speed rotating missile guidance system | |
| CN110941212A (en) | Control device and control method for high-speed rotating light filtering wheel in compact space structure | |
| CN109397298A (en) | A kind of parallel robot initial position scaling method | |
| CN115390512B (en) | Flexible gantry double-drive system and electromechanical combined decoupling motion control method thereof | |
| CN114488782B (en) | Turntable double-position ring control method and system based on harmonic speed reducing mechanism | |
| CN112666865B (en) | Clock synchronization turntable control system based on induction synchronizer |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |