Zero error compensation method for servo turntable
Through the cooperation of the microcontroller and the Hall switch, the compensation signal is generated by the induction magnet and the Hall induction switch, the error problem of servo motor when measuring the target axis position is solved, and the double improvement of accuracy and cost is achieved. It is suitable for different servo rotary table devices.
Patent Information
- Application Number
- CN202410946271.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-16
- Publication Date
- 2024-11-26
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
When measuring the actual position of the target shaft, there are transmission errors between reducer and gears, high encoder costs and structural space limitations, making it difficult to install data gears and encoders, resulting in accumulated errors and affecting accuracy and cost.
The microcontroller and Hall switch are used to compensate the zero point of the servo rotary table in real time, and the compensation signal is generated through the induction magnet and Hall induction switch, and the servo motor is controlled for zero compensation, simplifying the mechanical structure, reducing costs and improving accuracy.
It realizes error compensation, simplifies the mechanical structure of the servo turntable, reduces costs, ensures accuracy within the range, and is suitable for 24-hour operation equipment.
Smart Images

Figure CN119030405A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of servo motor control, and in particular relates to a servo turntable zero point error compensation method. Background Art
[0002] When the servo motor is in use, there are three main methods to measure the actual position of the target shaft: 1. Calculate the reduction ratio and transmission ratio between the reducer connected to the servo motor, the gear connected to the reducer, and the gears that transmit to each other through the servo motor encoder to convert the actual position of the target shaft; 2. Directly install an encoder on the target shaft to calculate the actual position of the target shaft; 3. Install a data gear to connect to the gear on the target shaft, and then install an encoder on the data gear shaft to calculate the actual position of the target shaft through the transmission ratio of the two gears.
[0003] The prior art has the following disadvantages: 1. There is an error between the reducer and the gear transmission, there is an error between the forward and reverse tooth gaps of the gears, and the reduction ratio is a non-integer; 2. The unit price of the encoder is high, and the cost is even higher when there are multiple target axes; 3. Due to structural space limitations, it is inconvenient to install data gears and encoders in most cases, and there is still an error between the data gear and the target axis gear transmission, and the cost is high. For this reason, we propose a servo turntable zero point error compensation method, which uses a single-chip microcomputer and a Hall switch to compensate for the servo turntable zero point, reduce errors and cumulative errors, and has a simple mechanical structure, guaranteed accuracy within the range, low price, and easy assembly. Summary of the invention
[0004] The purpose of the present invention is to provide a servo turntable zero point error compensation method, which uses a single-chip microcomputer and a Hall switch to compensate the servo turntable zero point, reduce the error and cumulative error, has a simple mechanical structure, guaranteed accuracy within the measuring range, low price, and easy assembly.
[0005] The technical solution adopted by the present invention is as follows:
[0006] A servo turntable zero point error compensation method, characterized in that it comprises the following steps:
[0007] Step 1: Set a zero point error compensation device on the servo turntable device;
[0008] Step 2: Setting a zero-point error compensation system in the zero-point error compensation device;
[0009] Step 3: Connecting the zero point error compensation system to the control system of the servo turntable;
[0010] Step 4: The zero-point error compensation system obtains the rotation angle of the output shaft of the servo turntable device in real time, and compares the rotation angle with the real angle. If the rotation angle of the output shaft exceeds the error range, the zero-point error compensation system generates a compensation signal and sends the compensation signal to the control system of the servo turntable device;
[0011] Step 5: The control system of the servo turntable controls the servo turntable device to perform zero point compensation according to the received compensation signal.
[0012] Preferably, the servo turntable device comprises a mounting plate, a servo motor and a reducer are arranged on the mounting plate, an output end of the servo motor and the reducer are adapted to each other, and a first connecting flange is arranged at an output end of the reducer.
[0013] Preferably, the zero-point error compensation device comprises a support frame mounted on the mounting plate by bolts, a mounting rod is connected to the support frame by bolts, a bearing is connected to the mounting rod, and a control chip is provided at the lower part of the mounting rod.
[0014] Preferably, a target shaft is movably provided inside the bearing, a second connecting flange is provided at one end of the target shaft, the second connecting flange is connected to the first connecting flange by bolts, and a third connecting flange is provided at the other end of the target shaft.
[0015] Preferably, a rectangular mounting groove is provided on the target shaft, an induction magnet is provided in the rectangular mounting groove, a Hall induction switch is provided on the mounting rod, and the Hall induction switch is located directly below the induction magnet.
[0016] Preferably, when the target axis returns to the initial zero position, the error compensation system generates a pulse signal through the induction magnet and the Hall induction switch, and the control chip calculates whether the target axis has deviation according to the pulse signal and generates a compensation signal.
[0017] Preferably, the servo motor is provided with a motor controller, and the control chip is electrically connected to the motor controller.
[0018] Preferably, the control chip sends the compensation signal to the motor controller, and the motor controller controls the servo motor to rotate to complete zero point compensation.
[0019] The technical effects achieved by the present invention are:
[0020] In the present invention, the error compensation device as a mechanism can be installed on different servo turntable devices. Specifically, the original equipment to be driven is installed on the first connecting flange. Now the second connecting flange of the error compensation device is installed on the first connecting flange by bolts. After the error compensation device is fixed, the equipment to be driven is installed on the third connecting flange, and then the zero-point error compensation system is adjusted, so that the error compensation device can adapt to different servo turntable devices.
[0021] In the present invention, the mechanical structure is simple, the accuracy within the measuring range is guaranteed; the price is low, the assembly is easy; the compensation is performed during the movement, and the device is convenient to use for 24-hour operation. BRIEF DESCRIPTION OF THE DRAWINGS
[0022] Figure 1 It is an operation flow chart of a servo turntable zero-point error compensation method of the present invention;
[0023] Figure 2 It is a working schematic diagram of a Hall induction switch in a servo turntable zero-point error compensation method of the present invention;
[0024] Figure 3 It is a front view of the connection structure between the servo turntable device and the error compensation device in a servo turntable zero-point error compensation method of the present invention;
[0025] Figure 4 It is a schematic diagram of the connection structure between a servo turntable device and an error compensation device in a servo turntable zero-point error compensation method of the present invention;
[0026] Figure 5 The present invention Figure 4 Enlarged view of point A in the middle.
[0027] In the accompanying drawings, the components represented by the reference numerals are listed as follows:
[0028] 1. Servo turntable device; 2. Error compensation device; 101. Mounting plate; 102. Servo motor; 104. Reducer; 105. First connecting flange; 106. Motor controller; 201. Support frame; 202. Mounting rod; 203. Bearing; 204. Control chip; 205. Target axis; 206. Second connecting flange; 207. Third connecting flange; 208. Induction magnet; 209. Hall induction switch. DETAILED DESCRIPTION
[0029] In order to make the purpose and advantages of the present invention more clearly understood, the present invention is specifically described below in conjunction with embodiments. It should be understood that the following text is only used to describe one or several specific embodiments of the present invention, and does not strictly limit the scope of protection of the specific claims of the present invention.
[0030] like Figure 1 As shown, a servo turntable zero point error compensation method is characterized by comprising the following steps:
[0031] Step 1: Setting a zero point error compensation device 2 on a servo turntable device 1;
[0032] Step 2: Setting a zero point error compensation system in the zero point error compensation device 2;
[0033] Step 3: Connect the zero point error compensation system to the control system of the servo turntable;
[0034] Step 4: The zero-point error compensation system obtains the rotation angle of the output shaft of the servo turntable device 1 in real time, and compares the rotation angle with the real angle. If the output shaft rotation angle exceeds the error range, the zero-point error compensation system generates a compensation signal and sends the compensation signal to the control system of the servo turntable device 1;
[0035] Step 5: The control system of the servo turntable controls the servo turntable device 1 to perform zero point compensation according to the received compensation signal.
[0036] like Figure 3-5 As shown, the servo turntable device 1 includes a mounting plate 101 , on which a servo motor 102 and a reducer 104 are disposed. The output end of the servo motor 102 is adapted to the reducer 104 , and the output end of the reducer 104 is provided with a first connecting flange 105 .
[0037] like Figure 3-5 As shown, the zero-point error compensation device 2 includes a support frame 201 mounted on the mounting plate 101 by bolts, a mounting rod 202 is connected to the support frame 201 by bolts, a bearing 203 is connected to the mounting rod 202, and a control chip 204 is provided at the lower part of the mounting rod 202.
[0038] like Figure 3-5 As shown, in the present invention, the mounting plate 101 and the support frame 201 are used to stably support the bearing 203. In the present invention, by providing the bearing 203, the rotation of the target axis 205 is made more stable.
[0039] like Figure 3-5 As shown, a target shaft 205 is movably provided inside the bearing 203 , a second connecting flange 206 is provided at one end of the target shaft 205 , the second connecting flange 206 is connected to the first connecting flange 105 by bolts, and a third connecting flange 207 is provided at the other end of the target shaft 205 .
[0040] like Figure 3-5 As shown, a rectangular mounting groove is provided on the target shaft 205 , an induction magnet 208 is provided in the rectangular mounting groove, and a Hall induction switch 209 is provided on the mounting rod 202 , and the Hall induction switch 209 is located directly below the induction magnet 208 .
[0041] like Figure 3-5 As shown, in the present invention, the mounting plate 101 and the support frame 201 are used to stably support the bearing 203, and further stabilize the rotation of the target shaft 205, so that the rotation of the target shaft 205 is more stable.
[0042] like Figure 3-5 As shown, when the target axis 205 returns to the initial zero position, the error compensation system generates a pulse signal through the induction magnet 208 and the Hall induction switch 209. The control chip 204 calculates whether the target axis 205 has deviation according to the pulse signal and generates a compensation signal.
[0043] like Figure 3-5 As shown, the servo motor 102 is provided with a motor controller 106 , and the control chip 204 is electrically connected to the motor controller 106 .
[0044] The control chip 204 sends the compensation signal to the motor controller 106 , and the motor controller 106 controls the servo motor 102 to rotate to complete the zero point compensation.
[0045] like Figure 2 As shown, in actual use of the present invention, for example, in actual work, the rotation of the target axis 205 has an optimal path, which is divided into two situations: counterclockwise rotation and clockwise rotation.
[0046] like Figure 2 As shown, in the present invention, when the target shaft rotates counterclockwise, the C end of the induction magnet 208 first triggers the B end of the induction probe of the Hall induction switch 209, and the single-chip microcomputer in the control chip 204 immediately captures the rising edge of the pulse signal. Because the induction probe is at a fixed position on the outside, the induction magnet on the target shaft rotates to this position each time, and the encoder angle position data at the rising edge of the pulse signal captured by the single-chip microcomputer is a fixed value; considering the actual error, the present invention sets the compensation error range of ±0.2°.
[0047] like Figure 2 As shown, in the present invention, when the target shaft rotates clockwise, the Y end of the induction magnet 208 first triggers the X end of the induction probe of the Hall induction switch 209, and the single-chip microcomputer in the control chip 204 immediately captures the rising edge of the pulse signal. Because the induction probe is at a fixed position on the outside, the induction magnet on the target shaft rotates to this position each time, and the encoder angle position data at the rising edge of the pulse signal captured by the single-chip microcomputer is a fixed value; considering the actual error, the present invention sets the compensation error range of ±0.2°.
[0048] like Figure 2As shown, in the present invention, it is assumed that the width of the sensing probe is 20 mm, the angle position of the A end is 137.66°, and the angle position of the B end is 135.66°; when the target shaft rotates counterclockwise, that is, V>0.5 (taking into account the speed fluctuation when the servo system stops), the angle position of the sensing magnet C end triggered to the sensing probe B end should be 135.66°, and when |△-135.66°|>0.2°, the program instructions automatically compensate the current position of the encoder to 135.66°.
[0049] like Figure 2 As shown, in the present invention, it is assumed that the width of the sensing probe is 20 mm, the angle position of the A end is 137.66°, and the angle position of the B end is 135.66°.
[0050] When the target axis rotates clockwise, that is, V<0.5; taking into account the speed fluctuation when the servo system stops, the angle position triggered by the D end of the induction magnet to the A end of the induction probe should be 137.66°. When |△-137.66°|>0.2°, the program instructions automatically compensate the current position of the encoder to 137.66°.
[0051] In summary, the present invention can compensate for the target axis 205 regardless of whether it rotates clockwise or counterclockwise.
[0052] In actual use of the present invention, the error compensation device 2 as a mechanism can be installed on different servo turntable devices 1. Specifically, the original equipment to be driven is installed on the first connecting flange 105. Now the second connecting flange 206 of the error compensation device 2 is installed on the first connecting flange 105 by bolts. After the error compensation device 2 is fixed, the equipment to be driven is installed on the third connecting flange 207, and then the zero-point error compensation system is adjusted, so that the error compensation device 2 can adapt to different servo turntable devices 1.
[0053] The above is only a preferred embodiment of the present invention. It should be noted that, for those skilled in the art, several improvements and modifications can be made without departing from the principles of the present invention, and these improvements and modifications should also be considered as the protection scope of the present invention. The structures, devices and operating methods not specifically described and explained in the present invention shall be implemented according to the conventional means in the art unless otherwise specified and limited.
Claims
1. A servo turntable zero point error compensation method, characterized in that: The following steps are involved: Step 1: Setting a zero point error compensation device (2) on the servo turntable device (1); Step 2: Setting a zero point error compensation system in the zero point error compensation device (2); Step 3: Connecting the zero point error compensation system to the control system of the servo turntable; Step 4: The zero-point error compensation system acquires the rotation angle of the output shaft of the servo turntable device (1) in real time, and compares the rotation angle with the real angle. If the rotation angle of the output shaft exceeds the error range, the zero-point error compensation system generates a compensation signal, and sends the compensation signal to the control system of the servo turntable device (1); Step 5: The control system of the servo turntable controls the servo turntable device (1) to perform zero point compensation according to the received compensation signal.
2. A servo turntable zero point error compensation method according to claim 1, characterized in that: The servo turntable device (1) comprises a mounting plate (101), on which a servo motor (102) and a reducer (104) are arranged, the output end of the servo motor (102) and the reducer (104) are adapted to each other, and the output end of the reducer (104) is provided with a first connecting flange (105).
3. A servo turntable zero point error compensation method according to claim 2, characterized in that: The zero-point error compensation device (2) comprises a support frame (201) mounted on the mounting plate (101) by means of bolts, a mounting rod (202) being connected to the support frame (201) by means of bolts, a bearing (203) being connected to the mounting rod (202), and a control chip (204) being provided at the lower part of the mounting rod (202).
4. A servo turntable zero point error compensation method according to claim 3, characterized in that: A target shaft (205) is movably provided inside the bearing (203), a second connecting flange (206) is provided at one end of the target shaft (205), the second connecting flange (206) is connected to the first connecting flange (105) by bolts, and a third connecting flange (207) is provided at the other end of the target shaft (205).
5. A servo turntable zero point error compensation method according to claim 4, characterized in that: The target shaft (205) is provided with a rectangular installation groove, an induction magnet (208) is provided in the rectangular installation groove, and a Hall induction switch (209) is provided on the installation rod (202), and the Hall induction switch (209) is located directly below the induction magnet (208).
6. A servo turntable zero point error compensation method according to claim 5, characterized in that: When the target axis (205) returns to the initial zero position, the error compensation system generates a pulse signal through the induction magnet (208) and the Hall induction switch (209), and the control chip (204) calculates whether the target axis (205) has a deviation based on the pulse signal and generates a compensation signal.
7. A servo turntable zero point error compensation method according to claim 6, characterized in that: The servo motor (102) is provided with a motor controller (106), and the control chip (204) is electrically connected to the motor controller (106).
8. A servo turntable zero point error compensation method according to claim 7, characterized in that: The control chip (204) sends the compensation signal to the motor controller (106), and the motor controller (106) controls the servo motor (102) to rotate to complete zero point compensation.
Citation Information
Cited By
Signal magnetic ring detection equipment capable of ensuring zero deflection angle of motor and detection method of signal magnetic ring detection equipment
CN119665803A
