A control method for dynamic soft limit
By calculating the limits of the C-arm lifting and deflecting shaft in real time and adjusting the limits dynamically, the problems of increased debugging time and limited range of motion caused by hard limits are solved, and the safety and utilization of the equipment are improved.
Patent Information
- Application Number
- CN202410183139.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-02-19
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-02-19
AI Technical Summary
The existing hard limiting technology requires wiring and position adjustment, resulting in increased equipment debugging time, increased risk of mechanical collisions, and limited range of motion.
By calculating the current positions of the C-arm lifting and deflection axis in real time, and dynamically calculating the positive and negative limits, avoiding additional detection switches and lines, real-time limit adjustment is achieved, ensuring safety and maximizing the range of motion.
It reduces the wiring and commissioning time of the equipment, reduces the failure rate, improves the safety and range of motion utilization of the equipment, and avoids shaft motion collisions.
Smart Images

Figure CN118244800B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of dynamic soft limit, and in particular to a control method of dynamic soft limit. Background Art
[0002] In previous designs, hard limits (proximity switches) were used on both the C-arm's lifting axis and the C-arm's deflection axis. The proximity switches required wiring and position adjustment. When the switches failed or broke, the risk of mechanical collision would increase. In addition, the position of the hard limits was fixed. To ensure safety, the axis's motion range would be restricted excessively, and the axis's motion range could not be fully utilized.
[0003] The lifting axis and the deflection axis of the existing C-arm need to be wired and adjusted in position during use, which increases the debugging time of the lifting axis and the deflection axis of the C-arm. Summary of the invention
[0004] The object of the present invention is to provide a control method for dynamic soft limit, aiming to solve the problem that the existing hard limit requires wiring and position adjustment, which increases the debugging time of the equipment.
[0005] To achieve the above object, the present invention provides a control method for dynamic soft limit, comprising the following steps:
[0006] Get the current position of the C-arm lifting axis;
[0007] Get the current position of the C-arm deflection axis;
[0008] Based on the current position of the C-arm lifting axis, a calculation is performed to obtain the positive and negative limit of the C-arm deflection axis;
[0009] The positive and negative limit positions of the C-arm lifting axis are obtained by calculation based on the current position of the C-arm deflection axis.
[0010] Among them, the lifting axis motor feedback position of the C-arm, the number of pulses per revolution of the lifting axis servo, the gear ratio of the lifting axis reducer, the lifting axis lead and the lifting axis equivalent are obtained;
[0011] The current position of the C-arm lifting axis is obtained by calculation based on the feedback position of the lifting axis motor, the number of pulses per rotation of the lifting axis servo, the gear ratio of the lifting axis reducer, the lifting axis lead and the lifting axis equivalent.
[0012] Wherein, the obtaining of the current position of the C-arm deflection axis comprises the following steps:
[0013] Obtain the yaw axis motor feedback position of the C-arm, the number of pulses per revolution of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent;
[0014] The current position of the yaw axis is obtained by calculation based on the feedback position of the yaw axis motor, the number of pulses per rotation of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent.
[0015] Wherein, the safe motion range of the C-arm lifting axis is when the deflection angle of the C-arm is <= 90°.
[0016] Wherein, the maximum motion range of the C-arm lifting axis is when the deflection angle of the C-arm = 0°.
[0017] A control method for dynamic soft limit of the present invention comprises the following steps: obtaining the current position of a C-arm lifting shaft; obtaining the current position of a C-arm deflection shaft; calculating based on the current position of the C-arm lifting shaft to obtain the positive and negative limit of the C-arm deflection shaft; calculating based on the current position of the C-arm deflection shaft to obtain the positive and negative limit of the C-arm lifting shaft. The method calculates the positive and negative limit of the C-arm deflection shaft in real time according to the current position of the C-arm lifting shaft, and can also calculate the positive and negative limit of the C-arm lifting shaft in real time according to the current position of the C-arm deflection shaft, without the need to add additional detection switches and circuits, thereby reducing the equipment failure rate and installation and debugging time; the limit is modified in real time, which not only ensures the safety of the equipment (prevents the axis movement collision), but also maximizes the axis movement range; the control method for dynamic soft limit provided by the present invention reduces the wiring and debugging time of the equipment, is safe and reliable, and reduces the equipment failure rate; the control method for dynamic soft limit provided by the present invention can ensure the safety of the equipment, maximize the axis movement range, and improve the detection range and utilization rate of the equipment. The present invention provides a dynamic soft limit control method that can calculate the positive and negative limits of the C-arm deflection axis in real time according to the current position of the C-arm lifting axis, and can also calculate the positive and negative limits of the C-arm lifting axis in real time according to the current position of the C-arm deflection axis. The present invention provides a dynamic soft limit control method that does not require additional detection switches and circuits, reduces equipment failure rate and installation and debugging time; the limit is modified in real time, which not only ensures the safety of the equipment (prevents axis movement collision), but also maximizes the axis movement range; thereby solving the problem that the existing hard limit requires wiring and position adjustment, which increases equipment debugging time. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0019] Figure 1The present invention provides a flow chart of a dynamic soft limit control method.
[0020] Figure 2 It is a flowchart for obtaining the current position of the C-arm lifting axis.
[0021] Figure 3 It is a flowchart for obtaining the current position of the C-arm deflection axis. DETAILED DESCRIPTION
[0022] Embodiments of the present invention are described in detail below, examples of which are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are intended to be used to explain the present invention, and should not be construed as limiting the present invention.
[0023] See also Figures 1 to 3 The present invention provides a control method for dynamic soft limit, comprising the following steps:
[0024] S1 obtains the current position of the C-arm lifting axis;
[0025] S11 obtains the C-arm's lifting axis motor feedback position, the number of lifting axis servo pulses per revolution, the lifting axis reducer gear ratio, the lifting axis lead and the lifting axis equivalent;
[0026] Specifically, obtain FP1: feedback position of the C-arm lifting axis motor; PPR1: number of pulses per revolution of the C-arm lifting axis servo; GR1: gear ratio of the C-arm lifting axis reducer; HP1: lead and equivalent of the C-arm lifting axis.
[0027] S12 calculates based on the feedback position of the lifting axis motor, the number of pulses per revolution of the lifting axis servo, the gear ratio of the lifting axis reducer, the lifting axis lead and the lifting axis equivalent to obtain the current position of the C-arm lifting axis.
[0028] Specifically, the current position of the C-arm lifting axis is calculated based on the feedback position of the lifting axis motor, the number of pulses per rotation of the lifting axis servo, the gear ratio of the lifting axis reducer, the lifting axis lead and the lifting axis equivalent, as shown in the following formula:
[0029] P1=FP1*HP1 / (PPR1*GR1) (1)
[0030] Among them, P1 is the current position of the C-arm lifting axis, FP1 is the feedback position of the C-arm lifting axis motor, PPR1 is the number of pulses per revolution of the C-arm lifting axis servo, GR1 is the gear ratio of the C-arm lifting axis reducer, and HP1 is the lead and equivalent of the C-arm lifting axis.
[0031] S2 obtains the current position of the C-arm deflection axis;
[0032] S21 obtains the yaw axis motor feedback position of the C-arm, the number of pulses per revolution of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent;
[0033] Specifically, obtain FP2: feedback position of the C-arm deflection axis motor; PPR2: number of pulses per revolution of the C-arm deflection axis servo; GR2: gear ratio of the C-arm deflection axis reducer; HP2: lead and equivalent of the C-arm deflection axis.
[0034] S22 calculates based on the yaw axis motor feedback position, the number of pulses per rotation of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent to obtain the current position of the yaw axis.
[0035] Specifically, the current position of the yaw axis is obtained by calculation based on the feedback position of the yaw axis motor, the number of pulses per rotation of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent, as shown in the following formula:
[0036] α=FP2*HP2 / (PPR2*GR2) (2)
[0037] Among them, α is the current position and angle of the C-arm deflection axis, FP2 is the feedback position of the C-arm deflection axis motor, PPR2 is the number of pulses per revolution of the C-arm deflection axis servo, GR2 is the gear ratio of the C-arm deflection axis reducer, and HP2 is the lead and equivalent of the C-arm deflection axis.
[0038] S3 calculates based on the current position of the C-arm lifting axis to obtain the positive and negative limit of the C-arm deflection axis;
[0039] The safe motion range of the C-arm lifting axis is when the deflection angle of the C-arm is less than or equal to 90°.
[0040] Specifically,
[0041] The calculation of the limit position of the C-arm deflection axis is shown as follows:
[0042] ①When the current position of the lifting axis |P1|<=|A|:
[0043] C-arm deflection axis limit calculation:
[0044] Positive limit = 90°
[0045] Negative limit = -90°
[0046] ②When the current position of the lifting axis |P1|>|A|:
[0047] Calculation of limit position of deflection axis of C-arm
[0048] Positive limit = arcsin(|P1|-|A|)
[0049] = arcsin[|FP1*HP1 / (PPR1*GR1)|-|A|]
[0050] Negative limit = -arcsin(|P1|-|A|)
[0051] = - arcsin[|FP1*HP1 / (PPR1*GR1)|-|A|]
[0052] Among them, FP1: is the feedback position of the C-arm lifting axis motor, PPR1 is the number of pulses per revolution of the C-arm lifting axis servo, GR1 is the gear ratio of the C-arm lifting axis reducer, HP1 is the lead and equivalent of the C-arm lifting axis, and "||" means taking the absolute value.
[0053] S4 performs calculation based on the current position of the C-arm deflection axis to obtain the positive and negative limit of the C-arm lifting axis.
[0054] The maximum motion range of the C-arm lifting axis is when the deflection angle of the C-arm is 0°.
[0055] Specifically, the C-arm lifting axis limit calculation formula is as follows:
[0056] D = C * sin α
[0057] Positive limit = |B|-|D|=|B|-| C*sinα|
[0058] =|B|-| C*sin[FP2*HP2 / (PPR2*GR2)]|
[0059] Negative limit = -|B|-|D|=-|B|-| C*sinα|
[0060] =-|B|-| C*sin[FP2*HP2 / (PPR2*GR2)]|
[0061] Among them, “||” represents the absolute value, FP2 is the feedback position of the C-arm deflection axis motor, PPR2 is the number of pulses per revolution of the C-arm deflection axis servo, GR2 is the gear ratio of the C-arm deflection axis reducer, and HP2 is the lead and equivalent of the C-arm deflection axis.
[0062] S5 records and stores the positive and negative limit of the C-arm deflection axis and the positive and negative limit of the C-arm lifting axis.
[0063] Specifically, the positive and negative limits of the C-arm deflection axis and the positive and negative limits of the C-arm lifting axis are received, and the positive and negative limits of the C-arm deflection axis and the positive and negative limits of the C-arm lifting axis are time-stamped to obtain marking data; the size of the marking data is identified to obtain the storage length of the marking data; based on the storage length, it is determined whether the memory space is sufficient to store the marking data; if the storage length of the marking data meets the requirements, the storage position of the storage length of the marking data is confirmed; if it does not meet the requirements, the storage position of the marking data is confirmed to an adjacent memory; the marking data is stored in a target memory for preservation, so as to facilitate the later query of the historical working data of the C-arm deflection axis and the C-arm lifting axis.
[0064] A dynamic soft limit control method provided by the present invention has the following beneficial effects:
[0065] 1. A dynamic soft limit control method provided by the present invention reduces the wiring and debugging time of the equipment, is safe and reliable, and reduces the equipment failure rate;
[0066] 2. A dynamic soft limit control method provided by the present invention can not only ensure the safety of the equipment, but also maximize the movement range of the axis, thereby improving the detection range and utilization rate of the equipment.
[0067] 3. A dynamic soft limit control method provided by the present invention can calculate the positive and negative limits of the C-arm deflection axis in real time according to the current position of the C-arm lifting axis, and can also calculate the positive and negative limits of the C-arm lifting axis in real time according to the current position of the C-arm deflection axis.
[0068] 4. A dynamic soft limit control method provided by the present invention does not require additional detection switches and circuits, thereby reducing equipment failure rate and installation and debugging time; the limit is modified in real time, which not only ensures the safety of the equipment (prevents shaft movement collision) but also maximizes the shaft movement range.
[0069] What is disclosed above is only a preferred embodiment of a dynamic soft limit control method of the present invention. Of course, it cannot be used to limit the scope of rights of the present invention. Ordinary technicians in this field can understand that all or part of the processes of the above embodiments and equivalent changes made according to the claims of the present invention are still within the scope of the invention.
Claims
1. A control method for dynamic soft limit, characterized in that: The following steps are involved: Get the current position of the C-arm lifting axis; Get the current position of the C-arm deflection axis; Based on the current position of the C-arm lifting axis, a calculation is performed to obtain the positive and negative limit of the C-arm deflection axis; Calculate based on the current position of the C-arm deflection axis to obtain the positive and negative limit of the C-arm lifting axis; The method of obtaining the current position of the C-arm lifting axis includes the following steps: Get the C-arm's lifting axis motor feedback position, the number of lifting axis servo pulses per revolution, the lifting axis reducer gear ratio, the lifting axis lead and the lifting axis equivalent; The current position of the C-arm lifting axis is obtained by calculation based on the feedback position of the lifting axis motor, the number of pulses per rotation of the lifting axis servo, the gear ratio of the lifting axis reducer, the lifting axis lead and the lifting axis equivalent; The method of obtaining the current position of the C-arm deflection axis comprises the following steps: Obtain the yaw axis motor feedback position of the C-arm, the number of pulses per revolution of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent; Calculating based on the feedback position of the yaw axis motor, the number of pulses per rotation of the yaw axis servo, the gear ratio of the yaw axis reducer, the yaw axis lead and the yaw axis equivalent to obtain the current position of the yaw axis; The safe motion range of the C-arm lifting axis is when the deflection angle of the C-arm is less than or equal to 90°; Specifically, The calculation of the limit position of the C-arm deflection axis is shown as follows: ①When the current position of the lifting axis |P1|<=|A|: C-arm deflection axis limit calculation: Positive limit = 90° Negative limit = -90° ②When the current position of the lifting axis |P1|>|A|: Calculation of limit position of deflection axis of C-arm Positive limit = arcsin(|P1|-|A|) = arcsin[|FP1*HP1 / (PPR1*GR1)|-|A|] Negative limit = -arcsin(|P1|-|A|) = - arcsin[|FP1*HP1 / (PPR1*GR1)|-|A|] Among them, FP1: is the feedback position of the C-arm lifting axis motor, PPR1 is the number of pulses per revolution of the C-arm lifting axis servo, GR1 is the gear ratio of the C-arm lifting axis reducer, HP1 is the lead and equivalent of the C-arm lifting axis, "||" means taking the absolute value; The maximum motion range of the C-arm lifting axis is when the deflection angle of the C-arm is 0°; Specifically, the C-arm lifting axis limit calculation formula is as follows: D = C * sin α Positive limit = |B|-|D|=|B|-| C*sinα| =|B|-| C*sin[FP2*HP2 / (PPR2*GR2)]| Negative limit = -|B|-|D|=-|B|-| C*sinα| =-|B|-| C*sin[FP2*HP2 / (PPR2*GR2)]| Among them, "||" means taking the absolute value, FP2 is the feedback position of the C-arm deflection axis motor, PPR2 is the number of pulses per revolution of the C-arm deflection axis servo, GR2 is the gear ratio of the C-arm deflection axis reducer, and HP2 is the lead and equivalent of the C-arm deflection axis; The positive and negative limit of the C-arm deflection axis and the positive and negative limit of the C-arm lifting axis are recorded and stored.
