A precise parking control system for a reciprocating mechanism
By using screw transmission and motor drivers in the reciprocating mechanism, combined with the upper and lower limit position proximity switch, the position error is calculated and corrected in real time, the precise parking control of the reciprocating mechanism is achieved, and the problems of high-cost encoder and grating scale are solved. Reduces system costs and improves accuracy.
Patent Information
- Application Number
- CN202210659624.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-06-13
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2042-06-13
AI Technical Summary
The existing precision parking control system for reciprocating mechanisms relies on expensive encoders and grating scales, resulting in high cost and complex maintenance requirements, making it difficult to achieve high-precision and economical parking control.
The screw transmission principle is used in combination with the motor driver, and by installing the upper limit and lower limit position proximity switches in the reciprocating mechanism, the motor position is calculated in real time and error correction is performed, and accurate parking control is achieved using integral and proportional adjustment algorithms.
The production and use cost of the system is reduced, the accumulation of position errors is avoided, and the precise parking control of the reciprocating mechanism is realized. Only a low-cost proximity switch can achieve similar effects as conventional systems.
Smart Images

Figure CN115079736B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of motion mechanisms, in particular to a precise parking control system for a reciprocating motion mechanism. Background Art
[0002] Reciprocating motion mechanism is a kind of motion mechanism commonly used in the field of industrial production. According to the requirements of the production equipment process, there are usually up and down lifting type and left and right translation type reciprocating motion mechanism, etc. The motor driver drives the motor to move forward and reverse, and the motor drives the reciprocating motion mechanism to move up and down within the upper and lower limit range. Suppose we define the ascending direction as the forward and reverse direction, and the descending direction as the reverse direction. Usually, after the system receives the start signal, the motion mechanism continues to run in the positive direction. When the mechanism moves to the upper limit position, the mechanism slows down and stops, and then continues to run in the reverse direction until the lower limit position, slows down and stops, and then continues to run in the positive direction, and so on. The system requires that each time the mechanism stops near the limit position, there should be no deviation at the limit position. In order to meet the requirements of precise stopping, conventional control systems usually use high-precision servo systems. By adding encoders to the motor shaft to collect the precise position of the motion mechanism, the servo system then accurately controls the parking position of the structure. Alternatively, a grating ruler is added to the mechanism to accurately measure the position of the reciprocating mechanism. The controller collects the grating ruler signal to obtain the position information, and then controls the motor driver to accurately control the parking position of the mechanism according to the position information. Although the above two methods can achieve the effect of precise parking control, the existing disadvantages are also very obvious. The cost and use cost of the encoder and grating ruler are at a high level, and their subsequent maintenance and maintenance are also relatively complicated. Summary of the invention
[0003] 1. Technical issues to be resolved
[0004] The present invention provides a precise parking control system for a reciprocating mechanism, which solves the problems raised in the above-mentioned background technology.
[0005] (II) Technical solution
[0006] The present invention provides the following technical solution: a reciprocating motion mechanism precise parking control system, comprising a support frame, a reciprocating motion mechanism is sleeved on the inner side of the middle part of the support frame, an upper limit position proximity switch is fixedly sleeved on the inner side of the top of the support frame, and a lower limit position proximity switch is fixedly sleeved on the inner side of the bottom of the support frame.
[0007] Preferably, the reciprocating motion mechanism is composed of a screw rod, a screw sleeve, a mobile platform, a motor, a motor driver and motor driver software, and one end of the screw rod is threadedly connected to the inner side of the screw sleeve, the surface of the screw sleeve is fixedly connected to the surface of the mobile platform, and both ends of the screw rod are sleeved on the inner side of the support frame through bearings, one end of which extends to the inner side of the bottom of the support frame and is fixedly connected to the transmission end of the motor, a support is fixedly installed between the motor inside the reciprocating motion mechanism and the inner wall of the bottom of the support frame, and the motor and the motor driver are electrically connected through a wire.
[0008] Preferably, the inner side of the mobile platform inside the reciprocating motion mechanism is engaged with the middle part of the support frame, and the mobile platform is equipped with movable wheels.
[0009] Preferably, the upper limit position proximity switch is symmetrical with the lower limit position proximity switch, and the front of the upper limit position proximity switch and the front of the lower limit position proximity switch are both in the same horizontal plane with the front of the support frame, and the upper limit position proximity switch and the lower limit position proximity switch adopt the same model.
[0010] An operating method for a reciprocating mechanism precise parking control system comprises the following operating steps:
[0011] S1. Estimation of mechanism location
[0012] The reciprocating mechanism uses the screw transmission principle to move up and down. When the motor driver inside the reciprocating mechanism is running, the motor control software of the motor driver will calculate the motor speed w(t) inside the reciprocating mechanism in real time. By integrating the speed w(t), the current position estimate θ(t) of the mechanism can be obtained. The unit of θ(t) is angular radians. The specific calculation formula is as follows:
[0013] S2. Error Correction
[0014] Assume that the lower limit position is close to the switch, which is defined as the starting position 0 of the reciprocating mechanism; the upper limit position is close to the switch, which is defined as the maximum position θm of the reciprocating mechanism, that is, the maximum stroke of the reciprocating mechanism. In order to eliminate the long-term cumulative error of the integral operation, the current position estimate θ(t) is corrected each time the mobile platform inside the reciprocating mechanism moves to the two limit positions. For example, when the mobile platform inside the reciprocating mechanism moves to the lower limit position close to the switch position under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor, the lower limit position close to the switch outputs a valid signal. After the motor driver receives the signal , the current position estimate θ(t) is forced to be corrected to 0; then, when the mobile platform inside the reciprocating mechanism moves to the position of the upper limit position proximity switch under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor, the upper limit position proximity switch outputs a valid signal. After the motor driver receives the signal, it forces the current position estimate θ(t) to be corrected to the maximum position θm. As a result, the integral cumulative error is corrected within each single motion stroke, and the error within a single motion stroke is very small and can be ignored, avoiding the accumulation of position errors after multiple reciprocating motions. The position value θ(t) can accurately represent the actual position of the mechanism;
[0015] S3, Position self-learning before formal use
[0016] In order to obtain the maximum stroke θm of the mechanism, a position self-learning needs to be performed during the equipment debugging stage. The specific operation is that after the installation and debugging of the overall equipment is completed, a start signal is sent to the motor driver inside the reciprocating mechanism. The mobile platform inside the reciprocating mechanism runs without load under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor. After ensuring at least ten reciprocating motion cycles, it stops running. The motor driver software records the position estimation value θ(ti) from the lower limit position proximity switch to the upper limit position proximity switch each time, and then takes the average value of all θ(ti) for filtering, and memorizes the average value as the maximum stroke θm;
[0017] S4, precise stop position control
[0018] According to S1, S2, and S3, the real-time position value of the reciprocating mechanism at any time is θ(t). The motor speed inside the reciprocating mechanism is adjusted in real time according to the error between θ(t) and θm. The calculation formula is: θerr=θm-θ(t) and w(tn)=P*θerr. As shown in the above formula, P is the proportional adjustment gain, w(tn) is the motor target speed inside the reciprocating mechanism calculated by the control algorithm, and the motor driver inside the reciprocating mechanism controls the motor speed to be equal to w(tn) in real time. It can be seen that, in theory, when θerr=0, the speed inside the reciprocating mechanism also decelerates to 0, and the reciprocating mechanism just stops at the upper limit position close to the switch. At this time, θ(t) has no error. If θ(t) has a negative error, the reciprocating mechanism has moved to the upper limit position close to the switch but θerr is still greater than 0. Since the error of the position estimation value θ(t) within a single stroke is very small, at this time, w(tn) is not 0 but is already very small, that is, at this time, the reciprocating mechanism The motor speed is already very low, and the motor driver inside the reciprocating mechanism can immediately control the motor to stop and lock, ensuring that the reciprocating mechanism still stops accurately at the upper limit position close to the switch, and at the same time correcting θ(t) = θm. If θ(t) has a positive error, then θerr is equal to 0 when the reciprocating mechanism has not yet moved to the upper limit position close to the switch. Since the error of the position estimation value θ(t) within a single stroke is very small, the distance between the reciprocating mechanism and the upper limit is already very small. At this time, the motor driver inside the reciprocating mechanism controls the motor inside the reciprocating mechanism to continue running at the minimum speed until it reaches the upper limit position close to the switch, and then the motor driver inside the reciprocating mechanism controls the motor inside the reciprocating mechanism to stop immediately and lock, and the reciprocating mechanism stops accurately at the upper limit position close to the switch, and at the same time correcting θ(t) = θm. When descending, θerr = 0-θ(t). The principle of the precise parking control algorithm is similar to that of the ascending movement.
[0019] (III) Beneficial effects
[0020] The present invention has the following beneficial effects:
[0021] The reciprocating mechanism precise parking control system calculates the motor position in real time by utilizing the motor driver and motor estimated speed inside the reciprocating mechanism, and then adds an extreme position proximity switch at both ends of the reciprocating mechanism for position error correction. After comprehensive use, the reciprocating mechanism can be precisely parked. Compared with conventional control systems, expensive encoders and grating rulers are omitted, and only two low-cost proximity switches are required, thereby reducing the manufacturing and use costs of the system. BRIEF DESCRIPTION OF THE DRAWINGS
[0022] Figure 1 It is a principle flow chart of the reciprocating motion mechanism of the present invention;
[0023] Figure 2 It is a front view schematic diagram of the structure of the present invention.
[0024] In the figure: 1. Support frame; 2. Reciprocating motion mechanism; 3. Upper limit position proximity switch; 4. Lower limit position proximity switch. 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. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0026] See also Figure 1-2 A reciprocating mechanism precise parking control system comprises a support frame 1, a reciprocating mechanism 2 is sleeved on the inner side of the middle part of the support frame 1, the reciprocating mechanism 2 is composed of a screw rod, a screw sleeve, a mobile platform, a motor, a motor driver and a motor driver software, and one end of the screw rod is threadedly connected to the inner side of the screw sleeve, the surface of the screw sleeve is fixedly connected to the surface of the mobile platform, and both ends of the screw rod are sleeved on the inner side of the support frame 1 through a bearing, one end of which extends to the inner side of the bottom of the support frame 1 and is fixedly connected to the driving end of the motor, a support is fixedly installed between the motor inside the reciprocating mechanism 2 and the inner wall of the bottom of the support frame 1, and the motor The machine is electrically connected to the motor driver through a wire, the inner side of the mobile platform inside the reciprocating motion mechanism 2 is clamped with the middle part of the support frame 1, and the mobile platforms are equipped with movable wheels, and the upper limit position proximity switch 3 is fixedly sleeved on the inner side of the top of the support frame 1, and the lower limit position proximity switch 4 is fixedly sleeved on the inner side of the bottom of the support frame 1, the upper limit position proximity switch 3 is symmetrical to the lower limit position proximity switch 4, and the front of the upper limit position proximity switch 3 and the front of the lower limit position proximity switch 4 are both in the same horizontal plane with the front of the support frame 1, and the upper limit position proximity switch 3 and the lower limit position proximity switch 4 adopt the same model.
[0027] An operating method for a reciprocating mechanism precise parking control system comprises the following operating steps:
[0028] S1. Estimation of mechanism location
[0029] The reciprocating mechanism 2 specifically adopts the screw transmission principle to move up and down. When the motor driver inside the reciprocating mechanism 2 is running, the motor control software of the motor driver will calculate the motor speed w(t) inside the reciprocating mechanism 2 in real time. The current position estimate θ(t) of the mechanism can be obtained by integrating the speed w(t). The unit of θ(t) is angular radians. The specific calculation formula is as follows:
[0030] S2. Error Correction
[0031] Assume that the lower limit position is close to switch 4, which is defined as the starting position 0 of the reciprocating mechanism 2; the upper limit position is close to switch 3, which is defined as the maximum position θm of the reciprocating mechanism 2, that is, the maximum stroke of the reciprocating mechanism 2. In order to eliminate the long-term accumulated error of the integral operation, the current position estimate θ(t) is corrected each time the mobile platform inside the reciprocating mechanism 2 moves to the two limit positions. For example, when the mobile platform inside the reciprocating mechanism 2 moves to the position of the lower limit position proximity switch 4 under the action of the screw transmission structure composed of the screw rod, the screw sleeve and the motor, the lower limit position proximity switch 4 outputs a valid signal, and after the motor driver receives the signal, it forces the current position estimate θ(t) to be corrected to 0; and then when the mobile platform inside the reciprocating mechanism 2 moves to the position of the upper limit position proximity switch 3 under the action of the screw transmission structure composed of the screw rod, the screw sleeve and the motor, the upper limit position proximity switch 3 outputs a valid signal, and after the motor driver receives the signal, it forces the current position estimate θ(t) to be corrected to the maximum position θm, thereby, the integral cumulative error is corrected within each single motion stroke, and the error within a single motion stroke is very small and can be ignored, thereby avoiding the increasing accumulation of position errors after multiple reciprocating motions, and the position value θ(t) can accurately represent the actual position of the mechanism;
[0032] S3, Position self-learning before formal use
[0033] In order to obtain the maximum stroke θm of the mechanism, a position self-learning needs to be performed during the equipment debugging stage. The specific operation is that after the installation and debugging of the entire equipment is completed, a start signal is sent to the motor driver inside the reciprocating mechanism 2. The mobile platform inside the reciprocating mechanism 2 runs without load under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor. After ensuring at least ten reciprocating motion cycles, it stops running. The motor driver software records the position estimation value θ(ti) from the lower limit position proximity switch 4 to the upper limit position proximity switch 3 each time, and then takes the average value of all θ(ti) for filtering, and memorizes the average value as the maximum stroke θm;
[0034] S4, precise stop position control
[0035] According to S1, S2, and S3, the real-time position value of the reciprocating mechanism 2 at any time is θ(t). The motor speed inside the reciprocating mechanism 2 is adjusted in real time according to the error between θ(t) and θm. The calculation formula is: θerr=θm-θ(t) and w(tn)=P*θerr. As shown in the above formula, P is the proportional adjustment gain, w(tn) is the motor target speed inside the reciprocating mechanism 2 calculated by the control algorithm, and the motor driver inside the reciprocating mechanism 2 controls the motor speed to be equal to w(tn) in real time. It can be seen that, theoretically, when θerr=0, the internal speed of the reciprocating mechanism 2 also decelerates to 0, and the reciprocating mechanism 2 just stops at the upper limit position close to the switch 3. At this time, θ(t) has no error. If θ(t) has a negative error, the reciprocating mechanism 2 has moved to the upper limit position close to the switch 3 but θerr is still greater than 0. Since the error of the position estimation value θ(t) within a single stroke is very small, at this time, w(tn) is not 0 but is very small, that is, the motor speed inside the reciprocating mechanism 2 is already very low. The motor driver inside the reciprocating mechanism 2 can immediately control the motor to stop and lock, ensuring that the reciprocating mechanism 2 still stops accurately at the upper limit position close to the switch 3, and at the same time corrects θ(t) = θm. If θ(t) has a positive error, θerr is equal to 0 before the reciprocating mechanism 2 moves to the upper limit position near switch 3. Since the error of the position estimation value θ(t) within a single stroke is very small, the distance between the reciprocating mechanism 2 and the upper limit position is also very small. At this time, the motor driver inside the reciprocating mechanism 2 controls the motor inside the reciprocating mechanism 2 to continue running at the minimum speed until it reaches the position of the upper limit position near switch 3. Then the motor driver inside the reciprocating mechanism 2 controls the motor inside the reciprocating mechanism 2 to stop immediately and lock. The reciprocating mechanism 2 stops precisely at the position of the upper limit position near switch 3, and θ(t) = θm is corrected at the same time. When the descending movement is in progress, θerr = 0-θ(t), and the principle of the precise parking control algorithm is similar to that of the ascending movement.
[0036] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device.
[0037] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.
Claims
1. A precise parking control system for a reciprocating mechanism, characterized in that: The invention comprises a support frame (1), wherein a reciprocating mechanism (2) is sleeved on the inner side of the middle part of the support frame (1), and an upper limit position proximity switch (3) is fixedly sleeved on the inner side of the top of the support frame (1), and a lower limit position proximity switch (4) is fixedly sleeved on the inner side of the bottom of the support frame (1). The reciprocating mechanism (2) is composed of a screw rod, a screw sleeve, a mobile platform, a motor, a motor driver and motor driver software, and one end of the screw rod is threadedly connected to the inner side of the screw sleeve, and the surface of the screw sleeve is fixedly connected to the surface of the mobile platform, and both ends of the screw rod are sleeved on the inner side of the support frame (1) through a bearing, and one end of the screw rod extends to the inner side of the bottom of the support frame (1) and is fixedly connected to the transmission end of the motor. A support is fixedly installed between the motor inside the reciprocating mechanism (2) and the inner wall of the bottom of the support frame (1), and the motor and the motor driver are electrically connected through a wire. The inner side of the mobile platform inside the reciprocating mechanism (2) is clamped with the middle part of the support frame (1), and the mobile platform is equipped with movable wheels. The upper limit position proximity switch (3) and the lower limit position proximity switch (4) are symmetrical, and the front of the upper limit position proximity switch (3) and the front of the lower limit position proximity switch (4) are both in the same horizontal plane as the front of the support frame (1), and the upper limit position proximity switch (3) and the lower limit position proximity switch (4) are of the same model; The steps are as follows: S1. Estimation of mechanism location When the motor driver inside the reciprocating mechanism (2) is running, the motor control software of the motor driver will calculate the motor speed w(t) inside the reciprocating mechanism (2) in real time. By integrating the speed w(t), the estimated value θ(t) of the current position of the mechanism can be obtained. The unit of θ(t) is angular radians. ; S2. Error Correction Assume that the lower limit position is close to the switch (4), which is defined as the starting position 0 of the reciprocating mechanism (2); the upper limit position is close to the switch (3), which is defined as the maximum position θm of the reciprocating mechanism (2), that is, the maximum stroke of the reciprocating mechanism (2). In order to eliminate the long-term cumulative error of the integral operation, each time the mobile platform inside the reciprocating mechanism (2) moves to the two limit positions, the current position estimate θ(t) is corrected. When the mobile platform inside the reciprocating mechanism (2) moves to the lower limit position close to the switch (4) under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor, the lower limit position is corrected. The limit position proximity switch (4) outputs a valid signal, and after the motor driver receives the signal, it compulsorily corrects the current position estimate θ(t) to 0; then, when the mobile platform inside the reciprocating motion mechanism (2) moves to the position of the upper limit position proximity switch (3) under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor, the upper limit position proximity switch (3) outputs a valid signal, and after the motor driver receives the signal, it compulsorily corrects the current position estimate θ(t) to the maximum position θm, thereby, the integral cumulative error is corrected within each single motion stroke, and the position value θ(t) can accurately represent the actual position of the mechanism; S3, Position self-learning before formal use In order to obtain the maximum stroke θm of the mechanism, a position self-learning needs to be performed during the equipment debugging stage. The specific operation is that after the installation and debugging of the entire equipment is completed, a start signal is sent to the motor driver inside the reciprocating mechanism (2). The mobile platform inside the reciprocating mechanism (2) runs without load under the action of the screw transmission structure composed of the screw, the screw sleeve and the motor. After ensuring at least ten reciprocating motion cycles, it stops running. The motor driver software records the position estimation value θ(ti) from the lower limit position proximity switch (4) to the upper limit position proximity switch (3) each time, and then takes the average value of all θ(ti) for filtering, and memorizes the average value as the maximum stroke θm; S4, precise stop position control According to S1, S2, and S3, the real-time position value of the reciprocating mechanism (2) at any time is θ(t). The motor speed inside the reciprocating mechanism (2) is adjusted in real time according to the error between θ(t) and θm. The calculation formula is: θerr = θm - θ(t) and w(tn) = P* θerr. P is the proportional gain, w(tn) is the motor target speed inside the reciprocating mechanism (2) calculated by the control algorithm, and the motor driver inside the reciprocating mechanism (2) controls the motor speed to be equal to w(tn) in real time. Theoretically, when θerr=0, the internal speed of the reciprocating mechanism (2) also decelerates to 0, and the reciprocating mechanism (2) just stops at the upper limit position close to the switch (3). At this time, θ(t) has no error. If θ(t) has a negative error, the reciprocating mechanism (2) has moved to the upper limit position close to the switch (3) but θerr is still greater than 0. The motor driver inside the reciprocating mechanism (2) can immediately control the motor to stop and lock, ensuring that the reciprocating mechanism (2) still stops accurately. At the position of the upper limit position proximity switch (3), θ(t)=θm is corrected at the same time. If θ(t) has a positive error, θerr is equal to 0 before the reciprocating mechanism (2) moves to the upper limit position proximity switch (3). At this time, the motor driver inside the reciprocating mechanism (2) controls the motor inside the reciprocating mechanism (2) to continue running at the minimum speed until the position of the upper limit position proximity switch (3) is reached. Then, the motor driver inside the reciprocating mechanism (2) controls the motor inside the reciprocating mechanism (2) to stop immediately and lock. The reciprocating mechanism (2) stops precisely at the position of the upper limit position proximity switch (3), and θ(t)=θm is corrected at the same time. When descending, θerr = 0 - θ(t).
