An automatic positioning and calibration system for enclosed rotary cutting needles
By combining a DC motor encoder and a photoelectric sensor, automatic detection and calibration of the enclosed rotary cutting needle are achieved, solving the problem of inaccurate positioning of the rotary cutting needle and improving the accuracy and reliability of its use.
Patent Information
- Application Number
- CN202410016547.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-01-05
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2044-01-05
AI Technical Summary
Existing closed-loop cutting needles are difficult to use in breast biopsy and cutting systems to achieve high-precision self-examination and positioning, leading to failure.
By employing a DC motor encoder and motor drive module, combined with photoelectric sensors and software algorithms, the automatic detection and calibration of the rotary cutting needle is achieved. The position calibration is performed by rotating the outer and inner needle tubes, and the speed and position are calculated using the encoder. Combined with the motor overcurrent and overload detection functions, precise positioning is achieved.
It achieves automatic detection and high-precision calibration of the rotary cutting needle, ensuring that the rotary cutting needle is in the correct position before use, thus improving the reliability and accuracy of the rotary cutting needle.
Smart Images

Figure CN117717398B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of medical device technology, and in particular to an automatic positioning and calibration system for a closed rotary cutting needle. Background Technology
[0002] In the use of breast biopsy and rotary cutting systems, the self-testing and positioning of the closed rotary cutting needle is a key technology that determines whether the product can be used normally. In some applications of closed rotary cutting needle products, the calibration and positioning technology of the closed rotary cutting needle cannot meet the high-precision positioning requirements, which will cause the rotary cutting needle to fail to be calibrated once during use. Summary of the Invention
[0003] To overcome the shortcomings of the prior art, this invention discloses an automatic positioning and calibration system for a closed rotary cutting needle. This invention facilitates automatic detection and calibration positioning of the rotary cutting needle by medical personnel. Before use, both the inner and outer needle tubes are in random positions. During self-testing, the rotary cutting needle calibration technology is used to rotate the outer tube of the rotary cutting needle to a reference position with the blade slot facing directly upwards. Utilizing the speed detection and position calculation functions of the DC motor encoder, combined with the motor overcurrent and overload detection functions of the motor drive module, the automatic detection and calibration positioning function of the rotary cutting needle can be effectively achieved through hardware driving and matching software algorithms.
[0004] To achieve the aforementioned objective, the present invention employs the following technical solution: An automatic positioning and calibration system for a closed rotary cutting needle includes the following steps: S1. Assemble the drive handle and the rotary cutting mechanism together; S2. The assembly and testing of the rotary cutting mechanism is performed by aligning the infrared phototube on the OP2 sensor in the photoelectric sensor group 11 with the identification module. S3. The rotary cutting motor inside the drive handle drives the outer needle tube on the rotary cutting mechanism to rotate; S4. During the rotation of the outer needle tube, the infrared phototube on the OP1 sensor in the photoelectric sensor group 11 is aligned with the black barcode on the rotary cutting needle body of the rotary cutting mechanism, and the signal is collected to find the midpoint of the outer tube on the outer needle tube and align the midpoint of the outer tube with the positioning mark on the rotary cutting needle body. S5. When the midpoint of the outer tube is aligned with the positioning mark, the sampling knife groove on the outer needle tube is in a positive upward position. When the outer needle tube is inserted into human tissue, the orientation of the sampling knife groove can be determined based on the midpoint of the outer tube. S6. The inner needle tube is moved by the feed motor in the drive handle, and the limit position of the inner needle tube is determined by the limit current of the feed motor. S7. Position the origin limit marker and the vertex limit marker by counting the encoder inside the drive handle; S8. After the outer and inner needle tubes are positioned, calibration begins. S9. Start the feed motor to drive the inner needle tube to retract slowly from any axial position to the origin limit mark (PWM duty cycle adjusted to 35%). When the inner needle tube retracts, the feed motor's current is stable because there is no running resistance. When it returns to the origin limit mark, the feed motor encounters resistance. This is because after passing the origin limit mark, the limit spring inside the outer needle tube is compressed, and the running resistance increases continuously. The feed motor current sampling waveform will collect a slowly rising waveform. When the voltage waveform reaches the threshold of the origin limit resistance, the feed motor stops running, records the current position as the starting position, clears the code counter, restarts the feed motor, starts the code counter, and moves the inner needle tube forward to 1 / 2 of the tool groove length and stops feeding. Record the current code count. S10. Position the midpoint of the outer needle tube. Align the midpoint of the outer needle tube with the positioning mark by rotating the outer needle tube (Note: The midpoint of the outer needle tube and the outer needle tube form a whole and can rotate synchronously. The positioning mark is a fixed position on the rotary cutting needle body). When the rotary cutting motor rotates for positioning, it needs to be identified by the black barcode on the rotary cutting needle body. There are three sets of black barcodes to determine the running position of the outer needle tube. When rotating for positioning, rotate to the left less than one turn to collect the middle black barcode as the starting signal. After finding the black barcode on one side, rotate the outer needle tube again to find the black barcode on the other side. Then rotate in the opposite direction to return to the midpoint position of the outer needle tube. The standard stroke is about 3500-4500. S11. Locate the center position of the inner needle tube's rotary cutting mechanism. Align the center line of the inner needle tube's blade with the positioning mark by rotating the inner needle tube. After aligning the midpoint of the outer tube with the positioning mark, start the rotary cutting motor on the inner needle tube for midpoint positioning. To prevent excessive speed and torque when rotating to the limit block, which could impact the internal limit block, set the rotary cutting motor's control duty cycle to a low-speed state of 35%. First, slowly rotate the inner needle tube to the left. When it reaches the left limit block, a sudden increase in the rotary cutting motor current will be detected. When the current reaches the left limit threshold, the motor will stop rotating to the left, the code count value will be reset to zero, and the current position will be used as the starting position of the left limit block. Then, slowly rotate the inner needle tube from the left limit starting position. The machine slowly rotates to the right while simultaneously starting the encoder to count. When it reaches the right limit block, a sudden increase in current is detected in the rotary cutting motor. When the current reaches the right threshold limit, the rotary cutting motor stops rotating to the right. At this point, the encoder count is approximately JS=7000. This can be understood as the count value of the entire rotation stroke of the rotary cutting motor as the inner tube rotates from the left limit block position to the right limit block position. After obtaining the total stroke count, this stroke count needs to be verified. Set JS=0 and rotate the rotary cutting motor from the current position (right limit block position) to the left limit block position, simultaneously collecting the JS count. During the inner needle tube rotary cutting stroke calibration stage, the motor is deflected to the leftmost position, and the encoder... The encoder signal count is cleared to zero, then the encoder deflects to the far right, recording the encoder signal count as stroke 1. After clearing the encoder signal count, the encoder deflects to the far left, recording the encoder signal count as stroke 2. Then the encoder deflects to the middle position, ending the stroke. The inner needle tube rotary cutting stroke = (stroke 1 + stroke 2) / 2. Simultaneously, the rotary cutting motor's operating current is detected. When the count value reaches 7000, the current amplitude is recorded to see if it matches the first reading. If they match, the left and right rotary cutting encoding count is correct, and this count value, along with the positions of the left and right limits, can be recorded. If the current amplitude recorded this time does not match the first reading, there is still an error in the rotary encoding count, which can be further divided into 2. The analysis considers two scenarios. In the first scenario, the rotation count reaches 7000, but the limit current does not rise, indicating a negative deviation in the previous limit count, requiring an increase in the code count. In the second scenario, the rotation count has not yet reached 7000, but the limit current has already risen, indicating a positive deviation in the previous limit count, requiring a decrease in the code count. Through actual testing, the positive and negative deviations are generally around 10. Therefore, the first calibration can be performed by increasing or decreasing the code count by 10. After calibration, the entire stroke count is divided by 2, which is the midpoint position of the left and right swing of the rotary cutting needle. At this point, rotating the inner tube of the rotary cutting needle from the left position to the position where the code count is halfway is the midpoint position of the inner tube during cutting. S12. After the inner needle tube finds its midpoint, it enters the axial travel calibration stage. This involves determining the starting and ending positions of the inner needle tube by detecting the current at the origin and apex limit markers and counting the encoder position. During the detection process, the axial travel count JSZ is first cleared to zero. The feed motor is then started, and the inner needle tube (from the current 1 / 2 slot position) is moved axially to the origin limit marker. Simultaneously, the origin limit current is detected. When the inner needle tube moves to the origin position, the origin limit current rises under the action of the limit spring. When the origin limit current threshold is reached, the motor stops, the encoder signal count is cleared to zero, and the feed motor is restarted to drive the inner needle tube to slowly move upward to the origin limit marker position. Under the action of the apex limit, the voltage amplitude collected by the current sensor suddenly rises. When this voltage is greater than the apex limit threshold, it can be considered that the inner needle tube has reached the top position, and the feed motor stops running. The current recorded encoder signal count is [number], representing the axial travel of the inner needle tube from the origin and apex limit markers.
[0005] The number of black barcodes in S10 is three groups, with the black barcodes on both sides being narrow bars and the black barcode in the middle being a wide bar, and the wide bar being twice the width of the narrow bar.
[0006] In S11, both the left and right limiting blocks are located on the blade holder on the rotary cutting needle body, and the left and right limiting blocks are located on both sides of the positioning mark.
[0007] The drive handle has a groove on the side near the rotary cutting device, and a photoelectric sensor group and a drive handle gear group are installed in the groove. The rotary cutting mechanism is connected to a rotary cutting needle body. One end of the rotary cutting needle body is equipped with a rotary cutting needle gear group. A black barcode is engraved on the rotary cutting needle body. An identification module is installed on one side of the black barcode. The rotary cutting needle gear group is positioned and meshed with the drive handle gear group. The black barcode and the identification module are positioned corresponding to the photoelectric sensor group.
[0008] An outer needle tube is rotatably connected to the body of the rotary cutting needle. One end of the outer needle tube is connected to the rotary cutting needle gear set. The connection points between the outer needle tube and the rotary cutting needle body are respectively provided with the midpoint of the outer tube and a positioning mark. An inner needle tube is rotatably connected to the body of the outer needle tube, and one end of the inner needle tube is connected to the rotary cutting needle gear set. The blade of the inner needle tube is located in the sampling groove of the outer needle tube.
[0009] The drive handle is equipped with a cable outlet and drive motors arranged at equal intervals. The power input terminal of the drive motor is electrically connected to the power output terminal of the cable outlet, and the drive end of the drive motor is connected to the gear set of the drive handle.
[0010] The photoelectric sensor group consists of OP sensors and OP sensors. The position of the OP sensors corresponds to the position of the black barcode, and the position of the OP sensors corresponds to the position of the recognition module.
[0011] The drive handle gear set consists of an inner tube turning gear, an inner tube feed gear, and an outer tube positioning gear, and the inner tube turning gear, the inner tube feed gear, and the outer tube positioning gear are respectively connected to different drive motors inside the drive handle. The rotary cutting needle gear set consists of an inner tube rotary cutting gear, an inner tube feed gear, and an outer tube positioning gear. The inner tube can be driven forward and backward by the inner tube feed gear, or it can be driven to perform rotary cutting by the inner tube rotary cutting gear. The inner tube rotary cutting gear is positioned in a corresponding manner to the inner tube rotary cutting gear, the inner tube feed gear is positioned in a corresponding manner to the inner tube feed gear, and the outer tube positioning gear is positioned in a corresponding manner to the outer tube positioning gear. All three sets of gears are meshed together.
[0012] A limit spring is installed on one end of the inner needle tube that is connected to the feed motor, and one end of the limit spring is connected to the mounting end of the feed motor.
[0013] Due to the adoption of the above technical solution, the present invention has the following beneficial effects: The present invention discloses an automatic positioning and calibration system for a closed rotary cutting needle, which facilitates automatic detection and calibration positioning of the rotary cutting needle by medical personnel. Before use, the inner and outer needle tubes are in random positions. During self-testing, the rotary cutting needle calibration technology is used to rotate the outer tube of the rotary cutting needle to the reference position with the blade groove facing directly upward. Utilizing the speed detection and position calculation functions of the DC motor encoder, combined with the motor overcurrent and overload detection functions of the motor drive module, the automatic detection and calibration positioning function of the rotary cutting needle can be effectively realized through hardware driving and matching software algorithms. Attached Figure Description
[0014] Figure 1 This is a three-dimensional structural diagram of the present invention; Figure 2 This is a schematic diagram of the drive handle structure of the present invention; Figure 3 This is a schematic diagram of the rotary cutting needle structure of the present invention; Figure 4 This is a block diagram illustrating the control principle of the drive handle motor of the present invention; Figure 5 This is a waveform diagram of the motor encoder output of the present invention; Figure 6 This is a diagram showing the forward rotation encoding output of the motor according to the present invention; Figure 7 This is a diagram showing the motor reversal encoding output of the present invention; Figure 8 This is a block diagram of the current detection of the DRV8874 of the present invention; Figure 9 This is a waveform diagram of the inner tube of the rotary cutting needle of the present invention retracting to the original position limit. Figure 10 This is a waveform diagram of the inner tube of the rotary cutting needle of the present invention when it reaches the top limit. Figure 11 This is a flowchart illustrating the positioning process of the outer tube center of the rotary cutting needle according to the present invention. Figure 12 This is a flowchart illustrating the positioning of the center of the inner tube of the rotary cutting needle according to the present invention. Figure 13 This is a flowchart illustrating the positioning of the origin and apex of the inner tube of the rotary cutting needle according to the present invention. 1. Drive handle; 2. Drive handle gear set; 201. Inner tube rotary cutting gear; 202. Inner tube feed gear; 203. Outer tube positioning gear; 3. OP2 sensor; 4. OP1 sensor; 5. Black barcode; 6. Identification module; 7. Rotary cutting needle body; 8. Rotary cutting needle gear set; 801. Rotary cutting needle inner tube rotary cutting gear; 802. Rotary cutting needle inner tube feed gear; 803. Rotary cutting needle outer tube positioning gear; 9. Rotary cutting mechanism; 10. Cable exit; 11. Photoelectric sensor; 12. Positioning mark; 13. Outer needle tube; 14. Inner needle tube; 15. Outer tube midpoint; 16. Sampling knife groove; 17. Vertex limit mark; 18. Origin limit mark; Implementation
[0015] The present invention will be explained in detail through the following embodiments. The purpose of disclosing the present invention is to protect all technical improvements within the scope of the present invention.
[0016] Combined with appendix Figures 1-13 The aforementioned enclosed rotary cutting needle automatic positioning and calibration includes the following steps: S1. Assemble the drive handle 1 and the rotary cutting mechanism 9 together; S2. The assembly and testing of the rotary cutting mechanism 9 is performed by aligning the infrared phototube on the OP2 sensor 3 in the photoelectric sensor group 11 with the identification module 6. S3. The outer needle tube 13 on the rotary cutting mechanism 9 is rotated by the rotary cutting motor in the drive handle 1; S4. During the rotation process, the outer needle tube 13 aligns the infrared phototube on the OP1 sensor 4 in the photoelectric sensor group 11 with the black barcode 5 on the rotary cutting needle body 7 on the rotary cutting mechanism 9 and collects the signal to find the midpoint 15 of the outer tube on the outer needle tube 13 and align the midpoint 15 of the outer tube with the positioning mark 12 on the rotary cutting needle body 7. S5. When the midpoint 15 of the outer tube is aligned with the positioning mark 12, the sampling knife groove 16 on the outer needle tube 13 is in a positive upward position. When the outer needle tube 13 is inserted into human tissue, the orientation of the sampling knife groove 16 can be determined based on the midpoint 15 of the outer tube on the outer needle tube 13. S6. The inner needle tube 14 is moved by the infeed motor in the drive handle 1, and the limit position of the inner needle tube 14 is determined by the limit current of the infeed motor. S7. The origin limit marker 18 and the vertex limit marker 17 are positioned by the encoder count inside the drive handle 1. Before the motor starts, the encoder interrupt counter is cleared to zero, and then the feed motor is started. After the feed motor rotates, the encoder signal input to the compiler interrupt of the MUC is interrupted. In the interrupt code, the encoder interrupt counter is incremented. When the encoder interrupt count value reaches 80% of the designed stroke, the PWM is reduced to achieve deceleration. At the same time, the feedback current is also detected in this interrupt. When the current feedback exceeds the set value, the machine stops and reports an error; when the encoder interrupt count value reaches the stroke setting value, the machine stops normally. After the positions of S8, outer needle tube 13 and inner needle tube 14 are determined, calibration begins; S9. Start the feed motor to drive the inner needle tube 14 from any axial position to the origin limit mark 18 at low speed. The PWM duty cycle is adjusted to 35%. When the inner needle tube 14 retracts, the feed motor's current is stable because there is no running resistance. When it returns to the origin limit mark 18, the feed motor encounters resistance. This is because after passing the origin limit mark 18, as the limit spring inside the outer needle tube 13 is compressed, the running resistance increases continuously. The feed motor current sampling waveform will collect a slowly rising waveform. When the voltage waveform reaches the threshold of the origin limit resistance, the feed motor stops running, records the current position as the starting position, clears the code counter, restarts the feed motor, starts the code counter, and moves the inner needle tube forward to 1 / 2 of the tool groove length and stops feeding. Record the current code count. S10. Position the midpoint of the outer needle tube 13. Align the midpoint 15 of the outer tube with the positioning mark 12 by rotating the outer needle tube 13. Explanation: The midpoint 15 of the outer tube and the outer needle tube 14 form a whole and can rotate synchronously. The positioning mark 12 is a fixed position on the rotary cutting needle body 7. When the rotary cutting motor rotates for positioning, it needs to be identified by the black barcode 5 on the rotary cutting needle body 7. There are three sets of black barcodes 5 to determine the running position of the outer needle tube 13. When performing rotational positioning, rotate to the left less than one turn to collect the middle black barcode 5 as the starting signal. After finding the black barcode 5 on one side, rotate the outer needle tube 13 again to find the black barcode 5 on the other side. Then rotate in the opposite direction to return to the midpoint position of the outer needle tube 13. The standard stroke is about 3500-4500. S11. Locate the center position of the inner needle tube 14. Align the center line of the inner needle tube 14 cutter head with the positioning mark 12 by rotating the inner needle tube 14. After aligning the midpoint 15 of the outer tube with the positioning mark 12, start the rotary cutting motor on the inner needle tube 14 for midpoint positioning. To prevent excessive speed and torque when rotating to the limit block, which could impact the internal limit block, set the control duty cycle of the rotary cutting motor to a low-speed state of 35%. First, slowly rotate the inner needle tube 14 to the left. When it reaches the left limit block, a sudden increase in the current of the rotary cutting motor will be detected. When the current reaches the left limit threshold, the motor will stop rotating to the left, the code count value will be cleared, and the current position will be taken as the starting position of the left limit block. Then, the inner needle... Tube 14 slowly rotates from the left limit starting position to the right, while the encoder starts counting. When it rotates to the right limit block, a sudden increase in current is detected in the rotary cutting motor. When the current reaches the right threshold limit, the rotary cutting motor stops rotating clockwise. At this time, the encoder count value is approximately JS=7000, which can be understood as the count value of the entire rotation stroke of the rotary cutting motor as the inner tube rotates from the left limit block position to the right limit block position. After obtaining the total stroke count, this stroke count needs to be verified. Set JS=0, and rotate the rotary cutting motor from the current right limit block position to the left limit block position, while simultaneously collecting the JS count. This is the calibration stage for the inner needle tube 14 rotary cutting stroke, rotating to the left... Deflect to the far left, clear the encoder signal count to zero, then deflect to the far right, recording the encoder signal count as stroke 1. After clearing the encoder signal count, deflect to the far left again, recording the encoder signal count as stroke 2. Then deflect to the middle position to end. The inner needle tube 14 rotary cutting stroke = stroke 1 + stroke 2 / 2. Simultaneously, the rotary cutting motor's operating current is detected. When the count value is 7000, record whether the acquired current amplitude matches the first one. If they match, it indicates that the left and right rotary cutting encoding count acquisition is correct. This count value and the positions of the left and right limits can be recorded. If the current amplitude recorded this time does not match the first one, there is still an error in the rotary encoding count. The analysis can be divided into two cases. In the first case, the rotation count reaches 7000, but the limit current does not rise, indicating that there is a negative deviation in the previous limit count, and the code count needs to be increased. In the second case, the rotation count has not yet reached 7000, but the limit current has already risen, indicating that there is a positive deviation in the previous limit count, and the code count needs to be reduced. Through actual testing, the positive and negative deviations are basically around 10. Therefore, the first calibration can be performed by increasing 10 codes and decreasing 10 codes. After the calibration is completed, the total stroke count is divided by 2, which is the midpoint position of the left and right swing of the rotary cutting needle. At this time, rotating the inner tube of the rotary cutting needle from the left position to the position of half the code count is the midpoint position of the inner tube during cutting. After the inner needle tube 14 finds its midpoint position (S12), it enters the axial travel calibration stage. This involves determining the starting and ending positions of the inner needle tube 14 by detecting the current at the origin limit marker 18 and the apex limit marker 17, and by using the encoder position count. During the detection process, the axial travel count JSZ is first cleared to zero. The feed motor is then started, moving the inner needle tube 14 axially from its current 1 / 2 slot position to the origin limit marker 18. Simultaneously, the origin limit current is detected. When the inner needle tube 14 moves to the origin position, the origin limit current rises under the action of the limit spring. When the origin limit current threshold is reached, the motor stops, the encoder signal count is cleared to zero, and the feed motor is restarted to drive the inner needle tube. 14. Slowly move upwards to the position of the origin limit marker 18. Under the action of the apex limit, the voltage amplitude collected by the current sensor suddenly increases. When this voltage is greater than the apex limit threshold, it can be considered that the inner needle tube 13 has reached the top position, and the feed motor stops running. The current recorded encoder signal count is the axial travel of the inner needle tube 13 from the origin limit marker 18 and the apex limit marker 17. Regarding overcurrent detection: During the rotary cutting needle calibration process, it is necessary to use encoder counting to calculate the running position, and it is also necessary to detect the change in current when the motor encounters resistance as the basis for judging when the motor has reached the limit position. In order to simplify the current detection, all handle motor drives use current sensing. The motor driver chip (DRV8874) can achieve motor drive and feedback current detection functions with simple external circuitry. Drive current feedback analysis: The IPROPI pin of the DRV8874 outputs an analog current proportional to the current flowing through the low-side power MOSFET in the H-bridge and regulated by AIPROPI. This current is measured by the internal current mirror architecture of the driver chip. Connecting the IPROPI pin to an external resistor RIPROPI generates a proportional voltage VIPROPI on the IPROPI pin using the analog current output. This allows a standard analog-to-digital converter (ADC) to use the load current as the input current. The voltage drop across the IPROPI resistor is measured. The value of the IPROPI resistor is adjusted according to the expected load current in the application to utilize the full range of the controller's ADC. At the same time, by setting the maximum shutdown current of the current chopping threshold (ITRIP), overload detection and protection functions for the motor can be implemented at the hardware level. When the motor drive current > ITRIP, the chip will automatically shut down the drive output. ITRIP(A) x AIPROPI(μA / A) = VVREF(V) / RIPROPI(Ω). Generally, AIPROPI = 1000μA / A is taken. If the maximum overload current threshold of the motor is selected as 3A, VVREF(V) = 3 is selected.When the current sampling resistor is 1K and the current is 0V, the maximum shutdown current is: ITRIP(A) = VVREF(V) / RIPROPI(Ω) / AIPROPI(μA / A) = 3A. After obtaining the reference voltage using the above method, refer to... Figure 12 Set the 2-origin limit voltage threshold value, refer to... Figure 13 The methods for setting the 5-vertex limit voltage threshold, the left limit voltage threshold, and the right limit voltage threshold are similar.
[0017] All motors within the drive handle 1 are DC motors. During motor operation, the motor speed and current position can be calculated by detecting the encoder pulse signals. To accurately acquire the encoder signals, hardware decoding is performed using the encoder module within the MCU / STM32F446. Using a quadrature encoder, position measurement (returning the CNT value) or directional speed value (returning the change in CNT value) can be achieved. The faster the motor rotates, the higher the sampling frequency; frequency represents motor speed. The design of A and B quadrature signals helps to resist noise. Figure 8 It can be seen that when phase A rises, phase B has different levels during forward and reverse rotation. Therefore, all edges of phases A and B are used as the clock for the counter. When an edge changes, the counter increments or decrements. An incremental output photoelectric encoder is used, with the encoder outputting square wave signals in phases A and B. Because the MCU / STM32 used has a built-in hardware encoder interface, the forward and reverse rotation of the motor can be determined by the sampling sequence of phases A and B of the encoder. The DC motor selected for the project uses a dual-output encoder with phases A and B, and the number of pulses per revolution is P=10 / n. From measuring the encoder output signal, it can be seen that when the motor rotates forward ( Figure 6 Phase A leads Phase B by 90 degrees. When the motor reverses ( Figure 7 Phase A lags Phase B by 90 degrees, making full use of the encoder's AB phase output characteristics. This can eliminate the impact of motor jitter on normal counting during motor operation and braking.
[0018] In S10, there are three sets of black barcodes 5, with the black barcodes 5 on both sides being narrow bars and the black barcode 5 in the middle being a wide bar, and the wide bar being twice the width of the narrow bar.
[0019] In S11, the left limiting block and the right limiting block are both located on the knife holder on the rotary cutting needle body 7, and the left limiting block and the right limiting block are located on both sides of the positioning mark 12.
[0020] The drive handle 1 has a groove on the side near the rotary cutting device (9), and a photoelectric sensor group 11 and a drive handle gear group 2 are respectively installed in the groove. The rotary cutting mechanism 9 is connected to a rotary cutting needle body 7. One end of the rotary cutting needle body 7 is equipped with a rotary cutting needle gear group 8. A black barcode 5 is engraved on the rotary cutting needle body 7. An identification module 6 is installed on one side of the black barcode 5. The rotary cutting needle gear group 8 is positioned and meshed with the drive handle gear group 2. The black barcode 5 and the identification module 6 are positioned corresponding to the photoelectric sensor group 11.
[0021] An outer needle tube 13 is rotatably connected inside the rotary cutting needle body 7. One end of the outer needle tube 13 located inside the rotary cutting needle body 7 is connected to the rotary cutting needle gear set 7. The connection points of the outer needle tube 13 and the rotary cutting needle body 7 with the outer needle tube 13 are respectively provided with an outer tube midpoint 15 and a positioning mark 12. An inner needle tube 14 is rotatably connected inside the outer needle tube 13, and one end of the inner needle tube 14 located inside the rotary cutting needle body 7 is connected to the rotary cutting needle gear set 7. The blade part of the inner needle tube 14 is located in the sampling blade groove 16 of the outer needle tube (13).
[0022] The drive handle 1 is equipped with a cable outlet 10 and drive motors arranged at equal intervals. The power input terminal of the drive motor is electrically connected to the power output terminal of the cable outlet 10, and the drive end of the drive motor is connected to the gear set 2 of the drive handle.
[0023] The photoelectric sensor group 11 consists of OP2 sensor 3 and OP1 sensor 4. The position of OP1 sensor 4 corresponds to the position of the black barcode 5, and the position of OP2 sensor 3 corresponds to the position of the identification module 6.
[0024] The drive handle gear set 2 consists of an inner tube turning gear 201, an inner tube feed gear 202, and an outer tube positioning gear 203, and the inner tube turning gear 201, the inner tube feed gear 202, and the outer tube positioning gear 203 are respectively connected to different drive motors in the drive handle 1. The rotary cutting needle gear set 8 consists of a rotary cutting needle inner tube rotary cutting gear 801, a rotary cutting needle inner tube feed gear 802, and a rotary cutting needle outer tube positioning gear 803. The inner needle tube 14 can be driven forward and backward by the rotary cutting needle inner tube feed gear 802, and can also be driven by the rotary cutting needle inner tube rotary cutting gear 801 for rotary cutting operation. The rotary cutting needle inner tube rotary cutting gear 801 is positioned corresponding to the inner tube rotary cutting gear 201, the rotary cutting needle inner tube feed gear 802 is positioned corresponding to the inner tube feed gear 202, and the rotary cutting needle outer tube positioning gear 803 is positioned corresponding to the outer tube positioning gear 203. All three sets of gears are meshed.
[0025] A limit spring is installed on one end of the inner needle tube 4 that is connected to the feed motor, and one end of the limit spring is connected to the mounting end of the feed motor.
[0026] The aforementioned enclosed rotary cutting needle automatic positioning and calibration system operates as follows: During use, the feed motor drives the inner needle tube 14 to slowly retract from any axial position towards the origin limit marker 18 (PWM duty cycle adjusted to 35%). When the inner needle tube 14 retracts, there is no running resistance, and the feed motor's current is stable. However, upon reaching the origin limit marker 18, the feed motor encounters resistance. This is because after passing the origin limit marker 18, the limiting spring inside the outer needle tube 13 is compressed, increasing the running resistance. The feed motor current sampling waveform will then show a slowly rising waveform. When the voltage waveform reaches the threshold of the origin limit resistance, the feed motor stops running, and the current position is recorded as the starting position and encoded. After the counter is reset to zero, the feed motor is restarted, and the coding counter is started simultaneously. The inner needle tube is moved forward to the position of 1 / 2 of the blade groove length and the feed stops. The current coding count is recorded. The midpoint of the outer needle tube 13 is located. The midpoint 15 of the outer tube is aligned with the positioning mark 12 by rotating the outer needle tube 13 (Note: the midpoint 15 of the outer tube and the outer needle tube 14 form a whole and can rotate synchronously. The positioning mark 12 is a fixed position on the rotary cutting needle body 7). When the rotary cutting motor rotates for positioning, it needs to be identified by the black barcode 5 on the rotary cutting needle body 7. There are three sets of black barcodes 5 to determine the running position of the outer needle tube 13. When performing rotational positioning, the middle black barcode 5 is collected as the starting signal after rotating less than one revolution to the left. The rotation is then used to find the middle black barcode 5. After marking the black barcode 5 on one side, rotate the outer needle tube 13 to confirm the black barcode 5 on the other side. Then, rotate it in the opposite direction to return to the midpoint position of the outer needle tube 13. The standard stroke is approximately 3500-4500 degrees. Locate the cutting center position of the inner needle tube 14. Align the center line of the inner needle tube 14's blade position with the positioning mark 12 by rotating the inner needle tube 14. After aligning the midpoint 15 of the outer tube with the positioning mark 12, start the rotary cutting motor on the inner needle tube 14 for midpoint positioning. To prevent excessive speed and torque when rotating to the limit block, which could impact the internal limit block, set the control duty cycle of the rotary cutting motor to a low-speed state of 35%. First, slowly rotate the inner needle tube 14 to the left. When it reaches the left limit block, the rotary cutting motor's electrical activity will be detected. The current suddenly increases. When the current reaches the left limit threshold, the motor stops rotating counterclockwise, the encoder count is reset to zero, and the current position is taken as the starting position of the left limit block. The inner needle tube 14 then slowly rotates from the left limit starting position to the right, while the encoder starts counting. When it rotates to the right limit block, a sudden increase in current is detected in the rotary cutting motor. When the current reaches the right limit threshold, the rotary cutting motor stops rotating clockwise. At this time, the encoder count value is approximately JS=7000. This can be understood as the count value of the entire rotation stroke of the rotary cutting motor as the inner tube rotates from the left limit block position to the right limit block. After obtaining the total stroke count, this stroke count needs to be verified. Set JS=0.Rotate the rotary cutting motor from its current position (right limit block position) to the left limit block position, simultaneously collecting JS count data. During the inner needle tube 14 rotary cutting stroke calibration phase, deflect to the far left to reset the encoder signal count to zero, then deflect to the far right and record the encoder signal count as stroke 1. After resetting the encoder signal count to zero, deflect to the far left again and record the encoder signal count as stroke 2. Then deflect to the middle position to end the calibration. The inner needle tube 14 rotary cutting stroke = (stroke 1 + stroke 2) / 2. Simultaneously, detect the rotary cutting motor's operating current. When the count value reaches 7000, record whether the collected current amplitude matches the first reading. If they match, it indicates that this... If the rotational coding count is correctly acquired, record this count value along with the positions of the left and right limit switches. If the current amplitude recorded this time does not match the first time, indicating an error in the rotational coding count, it can be analyzed in two scenarios: First, if the rotational count reaches 7000 but the limit current does not rise, it indicates a negative deviation in the previous limit count, requiring an increase in the coding count. Second, if the rotational count has not yet reached 7000 but the limit current has already risen, it indicates a positive deviation in the previous limit count, requiring a decrease in the coding count. Actual testing shows that the positive and negative deviations are generally around 10, so the first calibration can be performed by increasing by 10. The coding and reduction of 10 codes are used for correction. After correction, the total stroke count is divided by 2, which is the midpoint position of the left and right swing of the rotary cutting needle. At this time, the inner tube of the rotary cutting needle is rotated from the left position to the position of half the code count, which is the midpoint position of the inner tube during rotary cutting. After the inner needle tube 14 finds the midpoint position, it enters the axial stroke calibration stage of the inner needle tube 14. That is, the starting position and the apex position of the inner needle tube 14 are determined by the current detection of the origin limit mark 18 and the apex limit mark 17 and the encoder position count. During the detection process, the axial stroke count JSZ is first cleared to zero, the feed motor is started, and the inner needle tube 14 (from the current 1 / 2 cutter groove position) is axially moved to the origin limit mark 18. Simultaneously, the origin limit current is detected. When the inner needle tube 14 moves to the origin position, the origin limit current rises under the action of the limit spring. When it reaches the origin limit current threshold, the motor stops, the encoder signal count is cleared, and the feed motor restarts to drive the inner needle tube 14 to slowly move upward to the origin limit mark 18. Under the action of the apex limit, the voltage amplitude collected by the current sensor suddenly rises. When this voltage is greater than the apex limit threshold, it can be considered that the inner needle tube 13 has reached the top position, and the feed motor stops running. The current recorded encoder signal count is [number], and the axial travel of the inner needle tube 13 from the origin limit mark 18 and the apex limit mark 17 is [number].
[0027] The parts of this invention not described in detail are prior art. Although the invention has been specifically shown and introduced in conjunction with preferred embodiments, there are many methods and approaches to implement this technical solution. The above description is only a preferred embodiment of the invention. However, those skilled in the art should understand that various changes in form and detail can be made to the invention without departing from the spirit and scope of the invention as defined in the appended claims, and all such changes are within the scope of protection of the invention.
Claims
1. A closed type automatic positioning and calibration device for a rotary cutting needle, comprising a driving handle (1) and a rotary cutting mechanism (9), characterized in that: The drive handle (1) has a groove on the side near the rotary cutting mechanism (9), and a photoelectric sensor group (11) and a drive handle gear group (2) are installed in the groove respectively. The rotary cutting mechanism (9) is connected to a rotary cutting needle body (7). One end of the rotary cutting needle body (7) is equipped with a rotary cutting needle gear group (8). A black barcode (5) is engraved on the rotary cutting needle body (7). An identification module (6) is installed on one side of the black barcode (5). The rotary cutting needle gear group (8) and the drive handle gear group (2) are positioned and meshed. The black barcode (5) and the identification module (6) are positioned corresponding to the photoelectric sensor group (11). There are three sets of black barcodes (5), with the black barcodes (5) on both sides being narrow bars and the black barcode (5) in the middle being a wide bar, and the wide bar being twice the width of the narrow bar; An outer needle tube (13) is rotatably connected inside the rotary cutting needle body (7). One end of the outer needle tube (13) inside the rotary cutting needle body (7) is connected to the rotary cutting needle gear set (8). The connection between the outer needle tube (13) and the rotary cutting needle body (7) and the outer needle tube (13) is respectively provided with the outer tube midpoint (15) and the positioning mark (12). An inner needle tube (14) is rotatably connected inside the outer needle tube (13). One end of the inner needle tube (14) inside the rotary cutting needle body (7) is connected to the rotary cutting needle gear set (8). The blade part of the inner needle tube (14) is located in the sampling blade groove (16) of the outer needle tube (13). The rotary cutting needle gear set (8) consists of a rotary cutting needle inner tube rotary cutting gear (801), a rotary cutting needle inner tube feed gear (802), and a rotary cutting needle outer tube positioning gear (803). The inner needle tube (14) can be driven to move forward and backward by the rotary cutting needle inner tube feed gear (802), or it can be driven to perform rotary cutting by the rotary cutting needle inner tube rotary cutting gear (801).
2. The closed loop automatic positioning and calibration device for a rotary cutting needle of claim 1, wherein: The drive handle (1) is provided with a cable outlet (10) and drive motors arranged at equal intervals. The power input end of the drive motor is electrically connected to the power output end of the cable outlet (10), and the drive end of the drive motor is connected to the gear set (2) of the drive handle.
3. The closed loop automatic positioning and calibration device for a rotary cutting needle of claim 1, wherein: The photoelectric sensor group (11) consists of OP2 sensor (3) and OP1 sensor (4). The position of OP1 sensor (4) corresponds to the position of the black barcode (5), and the position of OP2 sensor (3) corresponds to the position of the identification module (6).
4. The closed loop automatic positioning and calibration device for a rotary cutting needle of claim 1, wherein: The drive handle gear set (2) consists of an inner tube rotary cutting gear (201), an inner tube feed gear (202), and an outer tube positioning gear (203), and the inner tube rotary cutting gear (201), the inner tube feed gear (202), and the outer tube positioning gear (203) are respectively connected to different drive motors in the drive handle (1).
5. The closed loop automatic positioning and calibration device for a rotary cutting needle of claim 1, wherein: The inner tube rotary cutting gear (801) of the rotary cutting needle corresponds to the inner tube rotary cutting gear (201), the inner tube feed gear (802) of the rotary cutting needle corresponds to the inner tube feed gear (202), and the outer tube positioning gear (803) of the rotary cutting needle corresponds to the outer tube positioning gear (203). All three sets of gears are meshed.
6. The closed loop automatic positioning and calibration device for a rotary cutting needle of claim 1, wherein: A limit spring is installed on one end of the inner needle tube (14) that is connected to the feed motor, and one end of the limit spring is connected to the mounting end of the feed motor.
Citation Information
Patent Citations
Mammary gland rotary cutting biopsy system
CN115607199A
