A push rod motor stroke detection control method and a current sampling circuit thereof
By acquiring the current signal of the push rod motor in real time and extracting the ripple pulse using the centerline counting method, the angle positioning deviation problem in the stroke control of the push rod motor was solved, achieving high-precision angle control and improving the user experience of the smart bed/table.
Patent Information
- Application Number
- CN202611338917.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-31
- Publication Date
- 2026-11-17
AI Technical Summary
In existing technologies, the stroke control of push rod motors suffers from angular positioning deviations due to load changes and temperature rise effects, which affects the user experience of smart beds/tables.
The analog current signal in the working circuit of the push rod motor is acquired in real time. The ripple pulse is extracted by the centerline counting method and the displacement is converted. Combined with the closed-loop control method, accurate stroke detection is achieved.
It achieves closed-loop precise measurement of the push rod motor stroke, with high control accuracy, good repeatability, and angle control error within ±1°, adapting to environmental changes.
Smart Images

Figure CN123122322A_ABST
Abstract
Description
Technical Field
[0001] This application relates to the technical field of smart furniture, specifically to a stroke detection and control method for a push rod motor and its current sampling circuit. Background Technology
[0002] In short, a smart bed / desk is a modern smart home device that differs from ordinary beds / desks. It can electrically transform itself, sense human body posture, and automatically adjust its position. During research and development and manufacturing, precise control of the lifting angle is one of the core indicators for evaluating the product's user experience. In practice, the lifting angle is typically achieved by extending / retracting a push rod from a push rod motor.
[0003] Currently, existing technologies generally use the "open-loop time measurement method" to control the energizing time of the motor, thereby indirectly calculating and controlling the stroke position of the push rod, i.e., stroke S = nominal speed v0 × energizing time Δt. However, because the nominal speed of the DC push rod motor under no-load and load conditions is not consistent in forward (extending) and reverse (retracting) states, and the actual speed of the motor is easily affected by changes in the size of the external load and the temperature rise effect of the internal windings, the actual stroke of the motor varies significantly for each movement, even within the same preset energizing time. This difference leads to repeated positioning deviations in the bed / table angle, with deviations exceeding 5°. For smart beds, especially in fine-tuning scenarios such as reading mode and zero-gravity mode, this deviation seriously affects the user's posture comfort and product experience. Summary of the Invention
[0004] This application provides a stroke detection and control method for a push rod motor and its current sampling circuit, aiming to solve the technical problems existing in the prior art.
[0005] In accordance with the aforementioned first objective, this application provides a stroke detection and control method for a push rod motor, comprising the following steps: Real-time acquisition of analog current signals within a single ripple cycle in the working circuit of the push rod motor; The analog current signal is preprocessed, and effective digital ripple pulses within the commutation ripple characteristic frequency band are extracted. The digital ripple pulses are counted using the centerline counting method, and the real-time linear displacement of the push rod motor is calculated. The real-time linear displacement is compared with the preset target displacement to control whether the push rod motor operates.
[0006] Furthermore, the digital ripple pulses are counted using the centerline counting method, specifically: Set a hysteresis comparison threshold close to zero level to eliminate noise jitter near the zero line; When the digital ripple pulse signal changes from negative to positive and crosses the hysteresis comparison threshold, it is determined to be the rising edge of a valid ripple pulse, and the ripple count value is incremented by 1.
[0007] Furthermore, during the process of counting the digital ripple pulses using the centerline counting method, a debouncing interval is set to prevent the same ripple from being counted repeatedly. During the debouncing interval following the detection of a valid digital ripple pulse, no new crossover events will be responded to.
[0008] Furthermore, the step of calculating the real-time linear displacement of the push rod motor specifically involves: The real-time linear displacement S of the push rod is calculated using the formula S = N × (L / P). Where: L is the lead of the motor lead screw (i.e., the linear distance that the lead screw moves to push the push rod when it rotates one revolution), and P is the number of ripple pulses generated by the motor for each revolution.
[0009] Furthermore, the step of comparing the real-time linear displacement S with the preset target displacement S_target to control whether the push rod motor operates specifically includes: Calculate the displacement deviation value ΔS = S_target-S. If ΔS>0, control the push rod motor to run in the forward direction. When ΔS ≤ 0, a stop command is immediately issued to cut off the power supply to the push rod motor, completing one stroke closed-loop control.
[0010] Furthermore, the startup phase, before real-time acquisition of the current signal in the actuator motor's working circuit, also includes a shielding step to avoid false counting. Specifically: Within the first N milliseconds after the push rod motor starts, ripple counting is paused and resumed after the current enters a steady state; where the value of N is set according to the measured value of the surge duration when the push rod motor starts.
[0011] Furthermore, during the braking and deceleration phase after real-time acquisition of the current signal in the push rod motor's working circuit, it is necessary to dynamically adjust the hysteresis comparison threshold and debouncing interval parameters to ensure that ripples are identified.
[0012] Furthermore, it also includes a counting anomaly verification mechanism to ensure the accuracy and security of the calculations, specifically: During motor operation, the measured period and theoretical period of multiple consecutive ripple cycles are monitored in real time. When the deviation exceeds the preset threshold (±30%) and the deviation exceeds the time limit for K consecutive cycles (K≥3), it is determined to be a missed or miscalculated measurement and enters the abnormal processing stage. Among them, if the actual measurement period is too long, it is judged as a missed measurement, triggering supplementary calculation or recalibration; If the measured cycle is too short, it is judged as a miscalculation, triggering an alarm and shutdown. This quantitative and graded diagnosis improves the robustness and safety of the system.
[0013] In accordance with the second objective mentioned above, this application also provides a current sampling circuit for the stroke detection and control method of the aforementioned push rod motor, comprising: The differential input and filtering module is used to differentially acquire and input the analog current signal of the push rod motor in the working circuit, and to rectify and filter out the noise and interference in the differentially acquired signal. The differential amplifier module is used to amplify the input differential voltage; The output filtering and clamping protection module is used to process the amplified voltage for anomalies and interference, so that the subsequent microprocessor can perform periodic sampling of the ripple analog signal.
[0014] Furthermore, the differential input and filtering module includes resistors (R8, R10, R3, R14) and capacitors (C4, C5, C8). The positive input differential signal LAM1 ISE is input to pin 3 of the differential amplifier module U2A through resistor R8, and is connected in parallel with resistor R3 and capacitor C4 to form an RC low-pass filter. The inverted differential signal PGND is connected to pin 2 of the differential amplifier module U2A through the current limiting resistor R10, and is connected in parallel with R14 and capacitor C8 to form an RC low-pass filter. Capacitor C5 is connected across pins 2 and 3 of the differential amplifier module to filter out common-mode interference on the two differential lines.
[0015] Furthermore, the output filtering and clamping protection module includes a resistor R13, a capacitor C6, and a bidirectional TVS diode D5; The output pin 1 of the differential amplifier module U2A is connected in series with resistor R9 to form a closed-loop negative feedback. It is then connected in parallel with resistor R13 and capacitor C6 to form an RC low-pass filter, which is used to filter out noise and smooth the output signal. It is then connected in parallel with bidirectional TVS diode D5 to limit LAM1-ADV-I within the rated range during abnormal output and large interference spikes, thus protecting the subsequent microprocessor from damage.
[0016] Capacitor C1 is connected to pin 8 (+5V power supply) of the differential amplifier module 2. GND acts as a decoupling capacitor for the power supply, suppressing power supply noise.
[0017] The stroke detection and control method for the push rod motor and its current application circuit described in this application have the following advantages: The stroke detection and control method for the push rod motor described in this invention collects the analog current signal within a single ripple cycle during the operation of the push rod motor, performs preprocessing, extracts effective digital ripple pulses, counts them using the centerline counting method, calculates the real-time linear displacement of the push rod motor, and then compares the real-time linear displacement with a preset target displacement to control whether the push rod motor operates.
[0018] The above methods and processes achieve closed-loop accurate measurement of the actual stroke of the push rod motor, fundamentally overcoming the interference of motor load fluctuations and temperature rise effects on the positioning accuracy of the lifting angle.
[0019] Meanwhile, in order to provide an accurate sampled analog current signal for the stroke detection and control method of the push rod motor, a current acquisition circuit for the push rod motor during operation is also provided for adaptability. The required effective and accurate ripple pulse is extracted through filtering and shaping, so that the angle control error during the actual lifting process can be stably controlled within ±1°.
[0020] Compared with the traditional open-loop timing control method, the significant advantages of this invention are: high control accuracy and good repeatability. Moreover, the control process is a mechanical position closed loop, which is completely unaffected by the physical effects of internal temperature changes of the push rod motor and external load fluctuations, and has extremely strong environmental adaptability and robustness.
[0021] To better understand and implement this invention, the following detailed description is provided in conjunction with the accompanying drawings. Attached Figure Description
[0022] Figure 1 This is a flowchart of a stroke detection and control method for a push rod motor provided in Exemplary Embodiment 1 of this application; Figure 2 This is a flowchart of a stroke detection and control method for a push rod motor provided in Exemplary Example 2 of this application; Figure 3 This is a flowchart of a stroke detection and control method for a push rod motor provided in Exemplary Example 3 of this application; Figure 4 This is a schematic block diagram of the structure of a current sampling circuit for a stroke detection control method for a push rod motor provided in an exemplary embodiment of this application; Figure 5 for Figure 4 The circuit schematic. Detailed Implementation
[0023] To better illustrate the present invention, the invention will now be described in further detail with reference to the accompanying drawings.
[0024] It should be understood that the described embodiments are merely some, not all, of the embodiments of this application. All other embodiments obtained by those skilled in the art based on the embodiments of this application without creative effort are within the scope of protection of the embodiments of this application.
[0025] The terminology used in the embodiments of this application is for the purpose of describing particular embodiments only and is not intended to limit the embodiments of this application. The singular forms “a,” “the,” and “the” used in the embodiments of this application and the appended claims are also intended to include the plural forms unless the context clearly indicates otherwise. It should also be understood that the term “and / or” as used herein refers to and includes any or all possible combinations of one or more of the associated listed items.
[0026] In the following description, when referring to the accompanying drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with this application. Rather, they are merely examples of apparatuses and methods consistent with some aspects of this application as detailed in the appended claims. In the description of this application, it should be understood that the terms "first," "second," "third," etc., are used only to distinguish similar objects and are not necessarily used to describe a specific order or sequence, nor should they be construed as indicating or implying relative importance. Those skilled in the art can understand the specific meaning of the above terms in this application according to the specific circumstances.
[0027] Furthermore, in the description of this application, unless otherwise stated, "multiple" means two or more. "And / or" describes the relationship between related objects, indicating that three relationships can exist. For example, A and / or B can represent: A alone, A and B simultaneously, or B alone. The character " / " generally indicates that the preceding and following related objects have an "or" relationship.
[0028] Example 1: like Figure 1 As shown, this application provides a stroke detection and control method for a push rod motor through the following technical solution, including the following steps: S100: Real-time periodic acquisition of analog current signals within a single ripple cycle in the working circuit of the push rod motor; Specifically, when the push rod motor is working, its current is sampled periodically in real time. The sampled current signal is an analog current signal, and it is within a single ripple cycle.
[0029] The sampling frequency is set according to the ripple frequency at the highest motor speed. The purpose is to collect a sufficient number of data points (no less than 5 sampling points) to meet the requirements of the Nyquist sampling theorem, thereby avoiding undersampling distortion of the ripple signal and ensuring subsequent accuracy.
[0030] S200: Preprocess the analog current signal and extract the effective digital ripple pulses within the commutation ripple characteristic frequency band; Specifically, the analog current signal acquired in step S100 is filtered and shaped to effectively remove the DC component and low-frequency drift. Then, based on this, the effective digital ripple pulses of the fantasy ripple characteristic frequency band are extracted.
[0031] This step addresses the issue that the original analog current signal contains DC components, low-frequency noise, and high-frequency interference introduced by PWM speed control. A digital high-pass filter is used for processing, with its cutoff frequency set below the fundamental frequency of the motor commutation ripple. This effectively filters out the DC components and low-frequency drift while retaining the effective signal within the characteristic frequency band of the commutation ripple. This filtering step further improves the signal-to-noise ratio of the ripple signal, reduces the order requirement of the hardware filtering circuit, and saves hardware costs.
[0032] S300: The digital ripple pulses are counted using the centerline counting method, and the real-time linear displacement of the push rod motor is calculated.
[0033] The digital ripple signal processed in step S200 presents a sinusoidal waveform that fluctuates around the zero line. The ripple pulses are counted using the midline counting method (i.e., the zero-crossing detection method), as follows: S301: Sets the hysteresis comparison threshold near zero level to eliminate noise jitter near the zero line; S302: Real-time monitoring of the filtered digital ripple pulse signal: When the digital ripple pulse signal changes from negative to positive and crosses the hysteresis comparison threshold, it is determined as the rising edge of a valid ripple pulse, and the ripple count value is incremented by 1. In this process, to prevent the same ripple from being counted repeatedly, a debouncing interval (i.e., minimum pulse width limit) is set, meaning that within the debouncing interval after a valid digital ripple pulse is detected, no new crossover events will be responded to.
[0034] The midline counting method is simple to implement and requires little computation, making it suitable for real-time operation in resource-constrained microprocessors (MCUs).
[0035] S303: The steps for calculating the real-time linear displacement of the push rod motor are as follows: The real-time linear displacement S of the push rod is calculated using the formula S = N × (L / P). Where: L is the lead of the motor lead screw (i.e., the linear distance that the lead screw pushes the push rod to move when it rotates one revolution), and P is the number of ripple pulses generated by the motor for each revolution (the value of P is related to the number of pole pairs of the motor's commutator and is an inherent parameter of the motor).
[0036] S400: Compare the real-time linear displacement with the preset target displacement to control whether the push rod motor operates. Calculate the displacement deviation ΔS = S_target - S If ΔS>0, control the push rod motor to run in the forward direction; When ΔS ≤ 0, a stop command is immediately issued to cut off the power supply to the push rod motor, completing a precise stroke closed-loop control.
[0037] like Figure 4 As shown, the current sampling circuit of the stroke detection control method for the push rod motor described in this invention provides a high-precision sampling signal for the software processing of the stroke detection control method for the push rod motor. It uses a low-side / power-level current sampling front end powered by a single power supply to convert the current information in the push rod motor circuit into a low-voltage analog signal that can be acquired by the analog-to-digital converter (ADC) in the microcontroller MCU.
[0038] The current sampling circuit for the stroke detection and control method of the push rod motor includes, in sequence: a differential input and filtering module 1, a differential amplification module 2, and an output filtering and clamping protection module 3. The signal forms a differential sampling voltage along the power current direction, which is then output to the ADC of the microprocessor MCU after current limiting, filtering, attenuation, differential amplification, and clamping protection.
[0039] Specifically, the differential input and filtering module 1 is used to differentially acquire and input the analog current signal of the push rod motor in the working circuit, and to rectify and filter the noise and interference in the differentially acquired signal. The differential amplifier module 2 is used to amplify the input differential voltage; The output filtering and clamping protection module 3 is used to perform abnormal and anti-interference processing on the amplified voltage so that the subsequent microprocessor can perform periodic sampling of the ripple analog signal.
[0040] like Figure 5 As shown, the differential input and filtering module 1 includes resistors (R8, R10, R3, R14) and capacitors (C4, C5, C8). Among them, resistor R8 is connected in series with sampling line LAM1_ISEN, and resistor R10 is connected in series with sampling line PGND; the current sampling signal flows through sampling line LAM1_ISEN to sampling line PGND to form a differential sampling voltage; the current limiting resistors (R8, R10) are connected in series in the two sampling lines to limit the impact of transient large currents or noise spikes on the subsequent RC low-pass filter and improve the surge resistance of the front end.
[0041] The positive input differential signal passes through the sampling line LAM1 ISE, and is positively input to pin 3 of the differential amplifier module through the current limiting resistor R8. It is also connected in parallel with resistor R3 and capacitor C4 to form an RC low-pass filter, which is then subjected to high-frequency filtering, differential-mode filtering and attenuation / biasing. The inverted input differential signal passes through the sampling line PGND, then through the current-limiting resistor R10 and is connected to pin 2 of the differential amplifier module. It is also connected in parallel with R14 and capacitor C8 to form an RC low-pass filter. Capacitor C5 is connected between pins 2 and 3 of the differential amplifier module to filter out common-mode interference on the two differential lines and improve the signal-to-noise ratio.
[0042] The differential amplifier module 2, centered around the U2A (AIP358, one of the dual operational amplifiers with a single +5V power supply), receives the differential signal. It then forms a closed-loop negative feedback loop with resistor R9, setting a fixed gain to amplify the filtered millivolt-level current signal to a volt-level signal suitable for the ADC range in the microprocessor. This closed-loop structure suppresses errors caused by open-loop gain, temperature drift, and input offset of the operational amplifier, improving sampling accuracy and temperature stability.
[0043] The output filtering and clamping protection module 3 includes a resistor R13, a capacitor C6, and a bidirectional TVS diode D5; the output pin 1 of the differential amplifier module is connected in series with a resistor R9 to form a closed-loop negative feedback, and then connected in parallel with the resistor R13 and the capacitor C6 to form an RC low-pass filter, which is used to filter out noise and smooth the output signal; it is then connected in parallel with the bidirectional TVS diode D5 to limit LAM1-ADV-I within the rated range during abnormal output and large interference spikes, thus protecting the subsequent microprocessor from damage.
[0044] After being amplified by the differential amplifier module 2, the current signal is filtered at high frequency by the current-limiting resistor R13 and capacitor C6, and then clamped to 0-3.3V by diode D5 (usually a Zener diode or TVS). This module prevents the LAM1-AD port from exceeding the absolute maximum rating of the microcontroller's ADC due to power-on transients, power bounce, or abnormal overcurrent, playing a crucial protective role.
[0045] Example 2: like Figure 2As shown, the difference between this embodiment and embodiment 1 is that: before step S100, a shielding step S000 is added. The reason is that: at the moment of startup, the push rod motor will generate a surge current (Inrush Current) that is much larger than the steady-state operating current. The current waveform distortion is severe during this stage, and the ripple characteristics are submerged. Directly performing the centerline counting method will lead to miscounting.
[0046] The S000 procedure is as follows: within the first N milliseconds after the push rod motor starts, ripple counting is paused, and counting is resumed after the current enters a steady state; where the value of N is set according to the measured value of the surge duration when the push rod motor starts.
[0047] S100: Real-time periodic acquisition of analog current signals within a single ripple cycle in the working circuit of the push rod motor; Specifically, when the push rod motor is working, its current is sampled periodically in real time. The sampled current signal is an analog current signal, and it is within a single ripple cycle.
[0048] The sampling frequency is set according to the ripple frequency at the highest motor speed. The purpose is to collect a sufficient number of data points (no less than 5 sampling points) to meet the requirements of the Nyquist sampling theorem, thereby avoiding undersampling distortion of the ripple signal and ensuring subsequent accuracy.
[0049] S200: Preprocess the analog current signal and extract the effective digital ripple pulses within the commutation ripple characteristic frequency band; Specifically, the analog current signal acquired in step S100 is filtered and shaped to effectively remove the DC component and low-frequency drift. Then, based on this, the effective digital ripple pulses of the fantasy ripple characteristic frequency band are extracted.
[0050] This step addresses the issue that the original analog current signal contains DC components, low-frequency noise, and high-frequency interference introduced by PWM speed control. A digital high-pass filter is used for processing, with its cutoff frequency set below the fundamental frequency of the motor commutation ripple. This effectively filters out the DC components and low-frequency drift while retaining the effective signal within the characteristic frequency band of the commutation ripple. This filtering step further improves the signal-to-noise ratio of the ripple signal, reduces the order requirement of the hardware filtering circuit, and saves hardware costs.
[0051] S300: The digital ripple pulses are counted using the centerline counting method, and the real-time linear displacement of the push rod motor is calculated.
[0052] The digital ripple signal processed in step S200 presents a sinusoidal waveform that fluctuates around the zero line. The ripple pulses are counted using the midline counting method (i.e., the zero-crossing detection method), as follows: S301: Sets the hysteresis comparison threshold near zero level to eliminate noise jitter near the zero line; S302: Real-time monitoring of the filtered digital ripple pulse signal: When the digital ripple pulse signal changes from negative to positive and crosses the hysteresis comparison threshold, it is determined as the rising edge of a valid ripple pulse, and the ripple count value is incremented by 1. In this process, to prevent the same ripple from being counted repeatedly, a debouncing interval (i.e., minimum pulse width limit) is set, meaning that within the debouncing interval after a valid digital ripple pulse is detected, no new crossover events will be responded to.
[0053] The midline counting method is simple to implement and requires little computation, making it suitable for real-time operation in resource-constrained microprocessors (MCUs).
[0054] S303: The steps for calculating the real-time linear displacement of the push rod motor are as follows: The real-time linear displacement S of the push rod is calculated using the formula S = N × (L / P). Where: L is the lead of the motor lead screw (i.e., the linear distance that the lead screw pushes the push rod to move when it rotates one revolution), and P is the number of ripple pulses generated by the motor for each revolution (the value of P is related to the number of pole pairs of the motor's commutator and is an inherent parameter of the motor).
[0055] S400: Compare the real-time linear displacement with the preset target displacement to control whether the push rod motor operates. Calculate the displacement deviation value ΔS = S_target - S. If ΔS>0, control the push rod motor to run in the forward direction. When ΔS ≤ 0, a stop command is immediately issued to cut off the power supply to the push rod motor, completing a precise stroke closed-loop control.
[0056] Because the push rod motor generates a surge current much larger than the steady-state operating current at the moment of startup, the current waveform is severely distorted during this stage, and the ripple characteristics are submerged. Directly counting using the centerline counting method will lead to miscounting.
[0057] Compared with Example 1, in this embodiment, the push rod motor generates a surge current that is much larger than the steady-state operating current at the moment of startup. The current waveform is severely distorted during this stage, and the ripple characteristics are submerged. Directly counting using the centerline counting method will lead to miscounting.
[0058] Therefore, by directly adopting the shielding operation, the extraction of ripple features is more accurate, and the accuracy of subsequent counting is also improved accordingly. This improves the precision of detection and control, and further enhances user comfort and product experience when the push rod motor adjusts the angle.
[0059] Example 3: like Figure 3 As shown, the difference between this embodiment and embodiment 2 is that during the braking and deceleration phase after real-time acquisition of the current signal in the working circuit of the push rod motor, the ripple period will become longer and the amplitude will decrease. Therefore, step S5000 is added, namely, dynamically adjusting the hysteresis comparison threshold and debouncing parameters to ensure that the ripple in the low-speed phase can still be reliably identified, further improving the accuracy of counting and ensuring more accurate extraction of ripple features.
[0060] Example 4: The difference between this embodiment and embodiment 3 is that it also includes a counting anomaly verification mechanism step. Specifically, to detect the periodic consistency of the ripple pulses in real time: Throughout the entire motor operation process, the measured period and theoretical period of multiple consecutive ripple cycles are monitored in real time. When the deviation exceeds the preset threshold (±30%) and the deviation exceeds the timeout for K consecutive cycles (K≥3), it is determined to be a missed or miscalculated measurement and enters the abnormal handling stage. Among them, if the actual measurement period is too long, it is judged as a missed measurement, triggering supplementary calculation or recalibration; If the measured cycle is too short, it is judged as a miscalculation, triggering an alarm and shutdown. This quantitative and graded diagnosis improves the robustness and safety of the system.
[0061] Based on the disclosure and teachings of the foregoing specification, those skilled in the art can make changes and modifications to the above embodiments. Therefore, the present invention is not limited to the specific embodiments disclosed and described above, and some modifications and changes to the present invention should also fall within the protection scope of the claims of the present invention. Furthermore, although some specific terms are used in this specification, these terms are only for convenience of explanation and do not constitute any limitation on the present invention.
Claims
1. A method for detecting and controlling the stroke of a push rod motor, characterized in that, Includes the following steps: The analog current signal within a single ripple cycle in the working circuit of the push rod motor is acquired in real time and periodically. The analog current signal is preprocessed, and effective digital ripple pulses within the commutation ripple characteristic frequency band are extracted. The digital ripple pulses are counted using the centerline counting method, and the real-time linear displacement of the push rod motor is calculated. The real-time linear displacement S is compared with the preset target displacement S_target to control whether the push rod motor operates.
2. The stroke detection and control method for the push rod motor according to claim 1, characterized in that: The digital ripple pulses are counted using the centerline counting method, specifically: Set a hysteresis comparison threshold close to zero level; When the digital ripple pulse signal changes from negative to positive and crosses the hysteresis comparison threshold, it is determined to be the rising edge of a valid ripple pulse, and the ripple count value is incremented by 1.
3. The stroke detection and control method for the push rod motor according to claim 2, characterized in that: During the process of counting the digital ripple pulses using the centerline counting method, a debouncing interval is set; During the debouncing interval following the detection of a valid digital ripple pulse, no new crossover events will be responded to.
4. The stroke detection and control method for the push rod motor according to claim 1, characterized in that: The specific steps for calculating the real-time linear displacement of the push rod motor are as follows: The real-time linear displacement S of the push rod is calculated using the formula S = N × (L / P). Where: L is the lead of the motor lead screw, and P is the number of ripple pulses generated per revolution of the motor.
5. The stroke detection and control method for the push rod motor according to claim 1, characterized in that: The step of comparing the real-time linear displacement S with the preset target displacement S_target to control whether the push rod motor operates is as follows: Calculate the displacement deviation value ΔS = S_target-S. If ΔS>0, control the push rod motor to run in the forward direction. When ΔS ≤ 0, a stop command is immediately issued to cut off the power supply to the push rod motor, completing one stroke closed-loop control.
6. The stroke detection and control method for the push rod motor according to claim 1, characterized in that: The startup phase, before real-time acquisition of the current signal in the actuator motor's working circuit, also includes a shielding step, specifically: Within the first N milliseconds after the push rod motor starts, ripple counting is paused and resumed after the current enters a steady state; where the value of N is set according to the measured value of the surge duration when the push rod motor starts.
7. The stroke detection and control method for the push rod motor according to claim 1, characterized in that: During the braking and deceleration phase after real-time acquisition of the current signal in the working circuit of the push rod motor, it is necessary to dynamically adjust the hysteresis comparison threshold and debouncing interval parameters to ensure that the ripples are identified.
8. The stroke detection and control method for the push rod motor according to claim 1, characterized in that: It also includes steps for a counting anomaly verification mechanism, specifically: During motor operation, the measured period and theoretical period of multiple consecutive ripple cycles are monitored in real time. When the deviation exceeds the preset threshold (±30%) and the deviation exceeds the timeout for K consecutive (K≥3) cycles, it is determined to be a missed or miscalculated measurement and enters the abnormal handling stage. Among them, if the actual measurement period is too long, it is judged as a missed measurement, triggering supplementary calculation or recalibration; If the measured cycle is too short, it is judged as a miscalculation, triggering an alarm and shutdown.
9. A current sampling circuit for the stroke detection and control method of the push rod motor according to any one of claims 1 to 8, characterized in that, include: The differential input and filtering module is used to differentially acquire and input the analog current signal of the push rod motor in the working circuit, and to rectify and filter out the noise and interference in the differentially acquired signal. The differential amplifier module is used to amplify the input differential voltage; The output filtering and clamping protection module is used to process the amplified voltage for anomalies and interference, so that the subsequent microprocessor can perform periodic sampling of the ripple analog signal.
10. The current sampling circuit for the stroke detection and control method of a push rod motor according to claim 9, characterized in that, Its features are: The differential input and filtering module includes resistors (R8, R10, R3, R14) and capacitors (C4, C5, C8). The positive input differential signal LAM1 ISE is input to pin 3 of the differential amplifier module through resistor R8, and is connected in parallel with resistor R3 and capacitor C4 to form an RC low-pass filter. The inverted differential signal PGND is connected to pin 2 of the differential amplifier module through resistor R10, and is connected in parallel with R14 and capacitor C8 to form an RC low-pass filter. Capacitor C5 is connected across pins 2 and 3 of the differential amplifier module to filter out common-mode interference on the two differential lines; The output filtering and clamping protection module includes a resistor R13, a capacitor C6, and a bidirectional TVS diode D5; The output pin 1 of the differential amplifier module is connected in series with resistor R9 to form a closed-loop negative feedback. It is then connected in parallel with resistor R13 and capacitor C6 to form an RC low-pass filter, which is used to filter out noise and smooth the output signal. It is then connected in parallel with bidirectional TVS diode D5 to limit LAM1-ADV-I within the rated range.
