Motor self-checking system and method of infusion pump

Abstract

The invention provides a motor self-checking system and method for an infusion pump. A drive control subsystem drives a motor to operate, sets the target rotating direction of the motor, controls the rotating speed of the motor and controls the working state of a power supply of the motor; the state detection subsystem detects whether the motor is abnormal or not based on a driving signal of motor operation, a target rotation direction, a power supply working state of the motor and two paths of level signals; when the state detection subsystem detects that the motor is abnormal, an abnormal signal representing that the motor is abnormal is sent to the driving control subsystem; and the driving control subsystem controls the motor to stop running when receiving the abnormal signal. The infusion pump motor abnormity detection method can relieve the problem of low infusion pump motor abnormity detection efficiency in the prior art.

Description

Technical Field

[0001] The present invention relates to the technical field of infusion pump detection, and in particular to a motor self-detection system and method for an infusion pump. Background Art

[0002] During the infusion / injection process of the infusion pump, it is usually necessary to perform real-time detection of the rotation direction, overcurrent, undercurrent, etc. of the infusion pump motor. If an abnormal motor state is detected, an abnormal operation alarm is triggered, the motor stops running, and an audible and visual prompt is generated. However, in the prior art, if the infusion / injection flow rate of the infusion pump is low, it takes a long time to detect the abnormal motor state, which is inefficient. Summary of the invention

[0003] In view of this, an object of the present invention is to provide a motor self-detection system and method for an infusion pump, so as to alleviate the problem of low efficiency of abnormality detection of the infusion pump motor in the prior art.

[0004] In a first aspect, an embodiment of the present invention provides a motor self-test system for an infusion pump, wherein the output shaft of the motor of the infusion pump is connected to a synchronous wheel, and the motor self-test system includes a drive control subsystem, a state detection subsystem, a code disc assembly and an optical coupling assembly; the code disc assembly includes two identical code discs coaxially connected to the synchronous wheel, each code disc edge has a plurality of teeth evenly distributed along the circumferential direction, and the axial projections of the teeth of different code discs do not overlap; the optical coupling assembly includes two optical couplers arranged in a one-to-one correspondence with the two code discs; the synchronous wheel is driven to rotate by the motor to drive the two code discs to rotate synchronously, so that each code disc cuts the optical path of the corresponding optical coupler through the teeth distributed thereon, thereby obtaining two different level signals; the drive control The subsystem is used to drive the motor to operate, set the target rotation direction of the motor, control the speed of the motor, and control the power supply working state of the motor; the state detection subsystem is used to detect whether the motor is abnormal based on the drive signal of the motor operation, the target rotation direction, the power supply working state of the motor and two-way level signals, and when the motor abnormality is detected, an abnormal signal representing the motor abnormality is sent to the drive control subsystem; the drive control subsystem is also used to control the motor to stop operating when receiving the abnormal signal; wherein the motor abnormality includes at least one of the following: abnormal actual rotation direction of the motor, abnormal actual speed of the motor, and abnormal actual power supply control of the motor.

[0005] In a second aspect, an embodiment of the present invention further provides a motor self-test method for an infusion pump, and the motor self-test method is applied to the motor self-test system of the infusion pump described in the first aspect above; the motor self-test method comprises: the drive control subsystem drives the motor to operate, sets the target rotation direction of the motor, controls the rotation speed of the motor, and controls the power supply working state of the motor; the state detection subsystem detects whether the motor is abnormal based on the drive signal of the motor operation, the target rotation direction, the power supply working state of the motor and two level signals; when the state detection subsystem detects that the motor is abnormal, it sends an abnormal signal representing the motor abnormality to the drive control subsystem; wherein the motor abnormality comprises at least one of the following: abnormal actual rotation direction of the motor, abnormal actual rotation speed of the motor, and abnormal actual power supply control of the motor; when the drive control subsystem receives the abnormal signal, it controls the motor to stop operating.

[0006] The embodiment of the present invention provides a motor self-checking system and method for an infusion pump, wherein the drive control subsystem drives the motor to operate, sets the target rotation direction of the motor, controls the motor speed, and controls the power supply working state of the motor; the state detection subsystem detects whether the motor is abnormal based on the drive signal of the motor operation, the target rotation direction, the power supply working state of the motor, and two level signals; the state detection subsystem sends an abnormal signal representing the motor abnormality to the drive control subsystem when the motor abnormality is detected; the drive control subsystem controls the motor to stop operating when receiving the abnormal signal. Using the above technology, on the basis of driving the motor to operate, setting the motor rotation direction, controlling the motor speed, and controlling the power supply working state of the motor, the optical paths of the two optical couplers can be cut by two code disks coaxially connected to the synchronous wheel to obtain two level signals, and then the drive signal of the motor operation, the set motor rotation direction, the controlled motor power supply working state, and the two level signals are used to realize the rapid detection of the infusion pump motor, so as to control the infusion pump motor to stop operating when an abnormality is detected, thereby improving the efficiency of abnormal detection of the infusion pump motor.

[0007] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by practicing the present invention. The purpose and other advantages of the present invention are realized and obtained by the structures particularly pointed out in the description, claims and drawings.

[0008] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, preferred embodiments are given below and described in detail with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0009] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0010] Figure 1 It is a structural schematic diagram of a motor self-test system of an infusion pump according to an embodiment of the present invention;

[0011] Figure 2 This is an example diagram of the three-dimensional structure of the toothed code disk in an embodiment of the present invention;

[0012] Figure 3 1 is an example diagram of the encoding waveforms of the A-phase signal and the B-phase signal when the stepping motor rotates forward and reverse in an embodiment of the present invention;

[0013] Figure 4 A connection block diagram of a motor self-test system of an infusion pump according to an embodiment of the present invention;

[0014] Figure 5 This is a working flow chart of a motor self-test system of an infusion pump in an embodiment of the present invention;

[0015] Figure 6 The figure is a flow chart of a motor self-test method for an infusion pump according to an embodiment of the present invention. DETAILED DESCRIPTION

[0016] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution of the present invention will be clearly and completely described in combination with the embodiments below. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0017] To facilitate understanding of this embodiment, firstly, a motor self-test system of an infusion pump disclosed in an embodiment of the present invention is described in detail, see Figure 1 As shown, the output shaft of the motor 20 of the infusion pump 10 is connected to a synchronous wheel 30 , and the motor self-test system may include a drive control subsystem 40 , a state detection subsystem 50 , a code disk assembly 60 and an optical coupling assembly 70 .

[0018] See also Figure 1 and Figure 2As shown, the code disc assembly 60 may include two identical code discs 61 coaxially connected to the synchronous wheel 30, and the edge of each code disc 61 has a plurality of teeth 61 evenly distributed along the circumferential direction, and the axial projections of the teeth 611 of different code discs 61 do not overlap; the optical coupling assembly 70 may include two optical couplings 71 arranged in a one-to-one correspondence with the two code discs 61; the synchronous wheel 30 may be driven to rotate by the motor 20 to drive the two code discs 61 to rotate synchronously, so that each code disc 61 cuts the optical path of the corresponding optical coupling 71 through the teeth 611 distributed thereon, thereby obtaining two different level signals.

[0019] Exemplarily, for a certain optocoupler 71, it has a corresponding light emitting end and a light receiving end. The optocoupler 71 emits light to the light receiving end through the light emitting end to form an optical path between the light emitting end and the light receiving end. Since the optocoupler 71 is arranged corresponding to one of the code disks 61, the synchronous wheel 30 can be driven by the motor 20 to rotate to drive the code disk 61 corresponding to the optocoupler 71 to rotate synchronously, so that the code disk 61 forms a corresponding light blocking area through each tooth 611 distributed thereon to cut the optical path of the optocoupler 71 through the light blocking area. Each time the light path passes through a light blocking area, it will be cut once and a high-level signal will be output accordingly. Each time the light path passes through a gap between two adjacent teeth, a low-level signal will be output accordingly, and so on, thereby outputting a level signal with high and low levels.

[0020] See also Figure 1 As shown, the drive control subsystem 40 can be used to drive the motor 20 to operate, set the target rotation direction of the motor 20 , control the speed of the motor 20 , and control the power supply working state of the motor 20 .

[0021] The target rotation direction may be forward (eg, the output shaft of the motor 20 rotates clockwise) or reverse (eg, the output shaft of the motor 20 rotates counterclockwise), and the power supply of the motor 20 may have two working states: on and off.

[0022] See also Figure 1 As shown, the state detection subsystem 50 can be used to detect whether the motor 20 is abnormal based on the driving signal of the motor 20, the target rotation direction, the power supply working state of the motor 20 and the two-way level signal.

[0023] The driving signal may be a control signal sent by the driving control subsystem 40 to the motor 20 in order to drive the motor 20 to operate. For example, the driving signal for controlling the operation of the stepper motor is a pulse signal.

[0024] See also Figure 1As shown, the state detection subsystem 50 can also send an abnormality signal indicating the abnormality of the motor 20 to the drive control subsystem 40 when the abnormality of the motor 20 is detected; the drive control subsystem 40 can also be used to control the motor 20 to stop running when receiving the abnormality signal. The abnormality of the motor 20 can include at least one of the following: abnormal actual rotation direction of the motor 20, abnormal actual speed of the motor 20, and abnormal actual power control of the motor 20.

[0025] An embodiment of the present invention provides a motor self-test system for an infusion pump. On the basis of driving the motor to operate, setting the motor rotation direction, controlling the motor speed, and controlling the working state of the motor power supply, the optical paths of two optical couplers can be cut by two code disks coaxially connected to the synchronous wheel to obtain two level signals, and then the driving signal of the motor operation, the set motor rotation direction, the controlled motor power supply working state, and the two level signals are used to realize rapid detection of the infusion pump motor, so as to control the infusion pump motor to stop operating when an abnormality is detected, thereby improving the efficiency of abnormality detection of the infusion pump motor.

[0026] As a possible implementation, see Figure 1 As shown, the state detection subsystem 50 can also be used to detect whether the actual rotation direction of the motor 20 is abnormal based on the target rotation direction and the changes in the two-way level signals.

[0027] By way of example, the state detection subsystem 50 may perform the following operations: capture edge change events occurring in each of the two level signals (i.e., from a high level value to a low level value, or from a low level value to a high level value), and determine the time at which each edge change event occurs; compare the time at which each of the two level signals corresponds to, to determine the phase difference between the two level signals; determine the actual rotation direction of the motor based on the phase difference; and compare the target rotation direction of the motor with the actual rotation direction to determine whether the actual rotation direction of the motor is abnormal.

[0028] For example Figure 3 As shown, Figure 3The A-phase square wave signal and the B-phase square wave signal are respectively shown when the code disk 61 cuts the optical path of the optocoupler 71 when the motor 20 rotates forward and reverse. The motor 20 can be set to rotate forward or reverse, and the upper edge and lower edge conversion events of the A-phase square wave signal and the B-phase square wave signal are captured respectively, and then the phase difference between the A-phase square wave signal and the B-phase square wave signal is determined according to the conversion time. Since the phase difference between the A-phase square wave signal and the B-phase square wave signal corresponding to the forward rotation and reverse rotation of the motor 20 is different, it is possible to determine whether the motor 20 is actually rotating forward or reverse according to the phase difference, and thus determine whether the actual rotation direction of the motor 20 is abnormal according to whether the actual rotation direction of the motor 20 is consistent with the set rotation direction, that is: if the actual rotation direction of the motor 20 is inconsistent with the set rotation direction, it is determined that the actual rotation direction of the motor 20 is abnormal, and if the actual rotation direction of the motor 20 is consistent with the set rotation direction, it is determined that the actual rotation direction of the motor 20 is normal.

[0029] As a possible implementation, see Figure 1 and Figure 2 As shown, the state detection subsystem 50 can also be used to detect whether the actual rotation speed of the motor 20 is abnormal based on the driving signal of the motor 20 and the changes of the two level signals.

[0030] By way of example, the motor 20 may be a stepper motor; the drive control subsystem 40 may send a pulse signal of a preset frequency to the motor 20 to drive the motor 20 to operate and control the speed of the motor 20; the state detection subsystem 50 may perform the following operations: counting the pulse signals received by the motor 20 to determine a first count value within a time interval between two adjacent occurrence moments; comparing the first count value with a pre-designed value corresponding to the time interval to determine whether the actual speed of the motor 20 is abnormal; wherein the pre-designed value may be determined based on a preset frequency, a time interval and the number of distributed teeth 611 on the code disk 61.

[0031] Continuing from the previous example, see Figures 1 to 3 As shown, the method for determining the above-mentioned pre-designed value may include:

[0032] Step 1, based on a preset frequency and time interval, determine a first number of pulse signals sent by the drive control subsystem 40 to the motor 20 corresponding to one rotation of the synchronization wheel 30.

[0033] In the above step 2, the first quantity can be calculated based on the preset frequency and time interval using the following formula: Plap=f*Δt; wherein Plap is the first quantity, f is the preset frequency (in Hz), and Δt is the time interval (in s).

[0034] Step 2: determine the angle difference between two adjacent teeth 611 on the code disc 61 corresponding to the center of the code disc 61 based on the number of distributed teeth 611 on the code disc 61, and determine a pre-designed value based on the first number and the angle difference.

[0035] In the above step 2, the pre-designed value can be calculated based on the first number and the angle difference using the following formula: Pthe=Plap*θ / 360°; wherein Pthe is the pre-designed value, and θ is the angle difference (in degrees).

[0036] As a possible implementation, see Figure 1 and Figure 2 As shown, the state detection subsystem 50 can also be used to detect whether the actual power control of the motor 20 is abnormal based on the power working state of the motor 20, the driving signal of the motor 20 and the changes of the two-way level signals.

[0037] For example, the drive control subsystem 40 can also control the power of the motor 20 to be turned off after sending a pulse signal of a preset frequency to the motor 20 to drive the motor 20 to run for a preset period of time; the state detection subsystem 50 can perform the following operations: when the drive control subsystem 40 sends a pulse signal of a preset frequency to the motor 20 to drive the motor 20 to run for a preset period of time and controls the power of the motor 20 to be turned off, start counting the pulse signal sent by the drive control subsystem 40 to the motor 20 to obtain a second count value in real time, and then determine whether the actual power control of the motor 20 is abnormal based on whether an edge change event occurs in the two level signals when the second count value is greater than the pre-designed value.

[0038] Continuing from the previous example, see Figures 1 to 3 As shown, the method for determining whether the actual power control of the motor 20 is abnormal can be: the drive control subsystem 40 sends a pulse signal with a preset frequency of f to the motor 20 to drive the motor 20 to run for a preset time length ΔT and control the power of the motor 20 to be turned off. At this time, the state detection subsystem 50 starts to count the pulse signal sent by the drive control subsystem 40 to the motor 20 to obtain a second count value of Pl in real time. Until Pl is greater than the pre-designed value, it is determined whether the A-phase square wave signal and the B-phase square wave signal have an upper edge and a lower edge conversion event. If the A-phase square wave signal and the B-phase square wave signal have an upper edge and a lower edge conversion event, it means that the power of the motor 20 is not actually turned off, and it can be determined that the actual power control of the motor 20 is abnormal. If the A-phase square wave signal and the B-phase square wave signal do not have an upper edge and a lower edge conversion event, it means that the power of the motor 20 is actually turned off, and it can be determined that the actual power control of the motor 20 is normal.

[0039] As a possible implementation, see Figure 1 and Figure 2As shown, the state detection subsystem 50 can also be used to: generate an alarm when an abnormality is detected in the motor 20 .

[0040] For ease of understanding, the working principle of the motor self-test system of the above-mentioned infusion pump is exemplarily described as follows by taking a specific application as an example.

[0041] See also Figure 4 As shown, the motor self-test system can be mainly divided into two subsystems, including a drive control subsystem 40 and a state detection subsystem 50. The drive control subsystem 40 is mainly responsible for setting the rotation direction of the motor 20, controlling the speed of the motor 20, and controlling the power supply of the motor 20; the state detection subsystem 50 is mainly responsible for receiving the running state of the motor 20 (including the rotation direction, speed, power supply working state, etc.), and giving a detection judgment on whether the motor 20 is abnormal.

[0042] See also Figure 4 As shown, the drive control subsystem 40 mainly includes a pulse sending module 41, a direction control module 42, a power control module 43 and a first communication module 44. The state detection subsystem 50 mainly includes a motor direction detection module 51, an overcurrent and undercurrent detection module 52, an alarm module 53 and a second communication module 54. The first communication module 44 communicates with the second communication module 54 through UART (Universal Asynchronous Receiver / Transmitter, universal asynchronous receiver and transmitter). The pulse sending module 41 communicates with the second communication module 54 through PWM (Pulse Width The stepper motor (i.e., the motor 20 at this time) drives the synchronous wheel 30 to rotate to drive the two toothed code disks 61 to rotate synchronously to cut the optical path of the optical coupler 71 and generate a level signal (i.e., the above-mentioned A-phase square wave signal and B-phase square wave signal). After that, the generated level signal can be transmitted to the motor direction detection module 51 through the I / O interface.

[0043] The motor self-check system can perform self-check and judgment from the dimensions of motor direction signal line, pulse signal line and motor power control. The specific control and judgment methods are as follows:

[0044] (I) Self-check judgment of motor direction signal line:

[0045] The motor self-test system controls the rotation direction of the motor 20 by adjusting the level of the I / O interface corresponding to the direction control module 42. For the motor direction detection, it is achieved by cutting the optical paths of the two optocouplers through two toothed code disks 61 loaded on the synchronous wheel 30 connected to the output shaft of the motor 20. When the motor 20 rotates at a fixed speed, it drives the synchronous wheel 30 to rotate. At the same time, the two toothed code disks 61 cut the optical paths of the two optocouplers 71 to convert the optical signals of the two optocouplers 71 into orthogonally encoded electrical signals (i.e., two-way level signals, i.e., the above-mentioned A-phase square wave signal and B-phase square wave signal), and send the two-way level signals to the motor direction detection module 51 through the corresponding I / O interface; the edge change event of the A-phase square wave signal corresponding to point A (corresponding to the optical path position of one of the optocouplers 71) can be captured by a timer pre-set on the motor direction detection module 51, and at each point of the A-phase square wave signal The level of the B-phase square wave signal corresponding to point B (corresponding to the optical path position of another optocoupler 71) is collected once by the edge, and the actual rotation direction of the motor 20 is determined by the phase change between points A and B. If the actual rotation direction of the motor 20 is consistent with the rotation direction of the motor 20 controlled by the direction control module 42 (such as both are forward or both are reverse), the actual rotation direction of the motor 20 is determined to be normal. If the actual rotation direction of the motor 20 is inconsistent with the rotation direction of the motor 20 controlled by the direction control module 42 (such as one is forward and the other is reverse), the actual rotation direction of the motor 20 is determined to be abnormal.

[0046] The structure of the toothed code disc 61 can be seen in Figure 2 As shown, the respective waveforms of the A-phase square wave signal and the B-phase square wave signal can be found in Figure 3 shown.

[0047] The motor self-check system rotates the motor 20 by forward / reverse driving, and detects the actual rotation direction of the motor 20 in real time through the motor direction detection module 51. If the actual rotation direction of the motor 20 is detected to be normal, the direction signal line is regarded as valid; if the actual rotation direction of the motor 20 is detected to be abnormal, the direction signal line is regarded as invalid.

[0048] (II) Self-test judgment of pulse signal line:

[0049] The motor self-checking system adjusts the speed of the motor 20 by sending a pulse signal to the motor 20 through the pulse sending module 41. It is known that a stepper motor is an electric motor that converts an electrical pulse signal into an angular displacement or a linear displacement. The speed of the stepper motor can be controlled by controlling the number of pulse signals sent to the motor 20 by the pulse sending module 41 in a unit time. Based on the above theory, when the motor self-checking system performs self-checking, the pulse sending module 41 of the drive control subsystem 40 sends a pulse signal of a fixed frequency to the motor 20 to drive the motor 20 to rotate. At the same time, the state detection subsystem 50 receives the driving pulse signal (i.e., the pulse signal sent by the pulse sending module 41 to the motor 20) in real time through the timer pre-set on the over-current and under-current detection module 52. The total number of pulses collected is Ptimer, and the collected number of pulses is judged to be over-limit in combination with the changes in the square wave signals corresponding to the two points A and B during the self-checking judgment process of the motor direction signal line, so as to judge whether the motor 20 has an overspeed / stall phenomenon. For example, the angle difference between two adjacent teeth 611 on the toothed code disk 61 corresponding to the center of the code disk 61 is 15°, then the square wave signals corresponding to points A and B respectively have an edge change event every time the toothed code disk 61 rotates 15°, and the number of pulses theoretically collected in the time interval between the occurrence of two adjacent edge change events is Pthe=Plap*15 / 360, wherein Plap is the number of pulses that the pulse sending module 41 needs to send to the motor 20 when the motor 20 rotates one circle. The above-mentioned over-limit judgment method can be: compare and judge Ptimer and Pthe. If Ptimer is not greater than Pthe and the deviation between Ptimer and Pthe is not greater than the preset deviation threshold, it means that there is no over-limit, which can be regarded as the actual speed of the motor 20 is normal, and the pulse signal line is valid. If Ptimer is greater than Pthe or the deviation between Ptimer and Pthe is greater than the preset deviation threshold, it means that the over-limit can be regarded as the actual speed of the motor 20 is abnormal (i.e., overspeed / stall, and the pulse signal line is invalid).

[0050] (III) Self-check judgment of motor power supply control:

[0051] The motor self-checking system controls the power working state of the motor 20 (i.e., controls the power on or off of the motor 20) by adjusting the level of the I / O interface corresponding to the power control module 43. When the motor self-checking system performs the motor self-checking, it will use the pulse sending module 41 to send a pulse signal of a certain frequency to the motor 20 in advance to drive the motor 20 to rotate, and then use the power control module 43 to turn off the power of the motor 20, and use the motor direction detection module 51 to determine whether the motor 20 is actually still rotating. For example, in the self-check and judgment process of the above-mentioned pulse signal line, the square wave signals corresponding to points A and B have an edge change event every time the toothed code disk 61 rotates 15°. Then, if the motor direction detection module 51 determines that the square wave signals corresponding to points A and B do not have an edge change event when the number of pulse signals sent by the pulse sending module 41 to the motor 20 has exceeded the number of pulses (i.e., Pthe) required for the pulse sending module 41 to send to the motor 20 when the toothed code disk 61 rotates 15°, then it is deemed that the power supply of the motor 20 has actually been turned off, and the motor power supply control is effective. If the motor direction detection module 51 determines that the square wave signals corresponding to points A and B still have an edge change event when the number of pulse signals sent by the pulse sending module 41 to the motor 20 has exceeded the number of pulses (i.e., Pthe) required for the pulse sending module 41 to send to the motor 20 when the toothed code disk 61 rotates 15°, then it is deemed that the power supply of the motor 20 has not actually been turned off, and the motor power supply control is invalid.

[0052] The drive control subsystem 40 and the state detection subsystem 50 can communicate using a serial port (i.e., UART) to enable the two subsystems to share the self-test status and actual working status of the motor 20. If the state detection subsystem 50 detects that the motor 20 is abnormal, the second communication module 54 shares the abnormal situation of the motor 20 in the form of an abnormal signal to the first communication module 44 via UART, so that the drive control subsystem 40 stops the rotation of the motor 20.

[0053] When an abnormality is detected in any dimension during the motor self-check process in the above three dimensions (such as detecting at least one of the following: the wrong rotation direction of the motor 20, the speed of the motor 20 exceeding the limit, and the power control failure of the motor 20), the alarm module 53 will be triggered to sound an alarm. After the alarm is triggered, the infusion pump 10 cannot be driven by the motor 20 to operate normally.

[0054] In addition, the frequency of the motor self-test by the motor self-test system can be adjusted to improve the efficiency of the motor detection.

[0055] In summary, through the motor self-test system, the motor speed, motor rotation direction and motor power control can be tested relatively quickly when the power is turned on, so as to achieve the effect of quickly detecting whether the motor is abnormal.

[0056] The self-test process of the motor self-test system is as follows Figure 5 As shown:

[0057] At the beginning of the self-check, the drive control subsystem 40 controls the motor to rotate forward, sends pulses to the motor 20, and controls the power supply to power the motor 20 to start the forward rotation of the motor 20, and receives two different level signals obtained by the two encoders 61 cutting the optical paths of the two optocouplers 71 through the corresponding I / O interface, and sends the forward rotation state of the motor 20 to the state detection subsystem 50 through the UART; the state detection subsystem 50 determines whether to start the forward rotation of the motor 20 based on the received forward rotation state;

[0058] If the forward rotation of the motor 20 is started, the state detection subsystem 50 collects pulse signals through a preset timer, and determines whether the forward rotation detection of the motor 20 is normal based on the collected pulse signals and the received two-way level signals;

[0059] If the forward rotation detection of the motor 20 is normal, the state detection subsystem 50 determines whether the forward rotation speed of the motor 20 is normal; if the forward rotation speed of the motor 20 is normal, the drive control subsystem 40 controls the forward rotation of the motor 20 to stop, and controls the motor 20 to reverse, sends pulses to the motor 20 and controls the power supply to power the motor 20 to start the reverse operation of the motor 20, and receives two different level signals obtained by the two code disks 61 cutting the two optical paths of the optical couplers 71 through the corresponding I / O interface, and sends the reverse state of the motor 20 to the state detection subsystem 50 through the UART; the state detection subsystem 50 determines whether to start the reverse operation of the motor 20 based on the received reverse state;

[0060] If the reverse operation of the motor 20 is started, the state detection subsystem 50 collects pulse signals through a preset timer, and determines whether the reverse detection of the motor 20 is normal based on the collected pulse signals and the received two-way level signals; if the reverse detection of the motor 20 is normal, the state detection subsystem 50 determines whether the reverse speed of the motor 20 is normal;

[0061] If the reverse speed of the motor 20 is normal, the drive control subsystem 40 controls the motor to reverse without stopping, and turns off the power of the motor 20, and sends the power off state of the motor 20 to the state detection subsystem 50 through the UART;

[0062] The state detection subsystem 50 determines whether the motor 20 enters the power-off state based on the received power-off state and the two-way level signal; if the motor 20 enters the power-off state, the state detection subsystem 50 determines whether the power-off state of the motor 20 is normal;

[0063] If the power-off state of the motor 20 is normal, the self-test is successful; if the forward detection of the motor 20 is abnormal, or the forward speed is abnormal, or the reverse detection is abnormal, or the reverse speed is abnormal, or the power-off state is abnormal, the self-test exits abnormally, the drive control subsystem 40 stops the operation of the motor 20, the control of the motor 20 ends, and the motor state is reset.

[0064] In addition, in actual application, the speed (i.e., rotational speed) at which the drive control subsystem 40 drives the motor 20 to rotate forward and reverse can be customized as needed, the motor self-test system can be customized as needed to perform self-test on the forward, reverse or power control of the motor 20, and the state detection subsystem 50 can be adjusted as needed to detect abnormal operation of the motor 20.

[0065] By adopting the above-mentioned motor self-test system, the motor can be driven to rotate forward / reverse at a customized motor speed and customized motor rotation direction after power-on, and rapid detection of the motor is achieved from three angles: motor rotation direction, motor speed, and motor power control, thereby improving the efficiency of motor abnormality detection of the infusion pump.

[0066] Based on the above-mentioned motor self-test system of the infusion pump, the embodiment of the present invention also provides a motor self-test method of the infusion pump, see Figure 6 As shown, the motor self-test method may include the following steps:

[0067] Step 602 , the driving control subsystem 40 drives the motor 20 to operate, sets the target rotation direction of the motor 20 , controls the rotation speed of the motor 20 , and controls the power supply working state of the motor 20 .

[0068] Step 604 , the state detection subsystem 50 detects whether the motor 20 is abnormal based on the driving signal of the motor 20 , the target rotation direction, the power supply working state of the motor 20 , and the two level signals.

[0069] Step 606 : When the state detection subsystem 50 detects that the motor 20 is abnormal, it sends an abnormality signal indicating the abnormality of the motor 20 to the drive control subsystem 40 .

[0070] Step 608 : the drive control subsystem 40 controls the motor 20 to stop running when receiving the abnormal signal.

[0071] By adopting the motor self-test method of the infusion pump, on the basis of driving the motor to operate, setting the motor rotation direction, controlling the motor speed and controlling the working state of the motor power supply, the optical paths of the two optical couplers can be cut by two code disks coaxially connected to the synchronous wheel to obtain two level signals, and then the driving signal of the motor operation, the set motor rotation direction, the controlled motor power supply working state and the two level signals are used to realize rapid detection of the infusion pump motor, so as to control the infusion pump motor to stop operating when an abnormality is detected, thereby improving the efficiency of abnormality detection of the infusion pump motor.

[0072] The motor self-test method for an infusion pump provided in an embodiment of the present invention has the same implementation principle and technical effects as those of the motor self-test system embodiment of the infusion pump described above. For the sake of brief description, for matters not mentioned in the method embodiment, reference may be made to the corresponding contents in the aforementioned system embodiment.

[0073] Unless otherwise specifically stated, the relative steps, numerical expressions and values ​​of the components and steps set forth in these embodiments do not limit the scope of the present invention.

[0074] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that is executable by a processor. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art, or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for enabling a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the methods described in each embodiment of the present invention. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.

[0075] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.

[0076] Finally, it should be noted that the above-described embodiments are only specific implementations of the present invention, which are used to illustrate the technical solutions of the present invention, rather than to limit them. The protection scope of the present invention is not limited thereto. Although the present invention is described in detail with reference to the above-described embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-described embodiments within the technical scope disclosed by the present invention, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present invention, and should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the claims.

Claims

1. A motor self-test system for an infusion pump, characterized in that: The output shaft of the motor of the infusion pump is connected with a synchronous wheel, and the motor self-test system includes a drive control subsystem, a state detection subsystem, a code disc assembly and an optical coupling assembly; the code disc assembly includes two identical code discs coaxially connected to the synchronous wheel, and each code disc edge has a plurality of teeth evenly distributed along the circumference, and the axial projections of the teeth of different code discs do not overlap; the optical coupling assembly includes two optical couplers arranged in a one-to-one correspondence with the two code discs; the synchronous wheel is driven to rotate by the motor to drive the two code discs to rotate synchronously, so that each code disc cuts the optical path of the corresponding optical coupler through the teeth distributed thereon, thereby obtaining two different level signals; The drive control subsystem is used to drive the motor to operate, set the target rotation direction of the motor, control the speed of the motor, and control the power supply working state of the motor; The state detection subsystem is used to detect whether the motor is abnormal based on the driving signal of the motor, the target rotation direction, the power supply working state of the motor and two level signals, and when the motor abnormality is detected, an abnormal signal representing the motor abnormality is sent to the drive control subsystem; the drive control subsystem is also used to control the motor to stop running when receiving the abnormal signal; wherein the motor abnormality includes at least one of the following: abnormal actual rotation direction of the motor, abnormal actual speed of the motor, and abnormal actual power supply control of the motor.

2. The motor self-test system according to claim 1, characterized in that: The state detection subsystem is also used to detect whether the actual rotation direction of the motor is abnormal based on the target rotation direction and the changes of the two-way level signals.

3. The motor self-test system according to claim 2, characterized in that: The state detection subsystem is also used to detect whether the actual rotation speed of the motor is abnormal based on the driving signal of the motor and the changes of the two-way level signals.

4. The motor self-test system according to claim 3, characterized in that: The state detection subsystem is also used to detect whether the actual power control of the motor is abnormal based on the power supply working state of the motor, the driving signal of the motor operation and the changes of the two-way level signals.

5. The motor self-test system according to claim 4, characterized in that: The state detection subsystem is also used to: capture the edge change events occurring in the two level signals respectively, and determine the occurrence time of each edge change event; compare the occurrence time corresponding to the two level signals respectively, so as to determine the phase difference between the two level signals; determining the actual rotation direction of the motor according to the phase difference; The target rotation direction of the motor is compared with the actual rotation direction to determine whether the actual rotation direction of the motor is abnormal.

6. The motor self-test system according to claim 5, characterized in that: The motor adopts a stepper motor; the drive control subsystem is also used to send a pulse signal of a preset frequency to the motor to drive the motor to operate and control the speed of the motor; the state detection subsystem is also used to: count the pulse signals received by the motor to determine the first count value within the time interval between two adjacent occurrence moments; compare the first count value with the pre-designed value corresponding to the time interval to determine whether the actual speed of the motor is abnormal; wherein the preset count value is determined based on the preset frequency, the time interval and the number of distributed teeth on the code disk.

7. The motor self-test system according to claim 6, characterized in that: The drive control subsystem is also used to: control the power of the motor to be turned off after sending a pulse signal of a preset frequency to the motor to drive the motor to operate for a preset period of time; the state detection subsystem is also used to: when the drive control subsystem sends a pulse signal of a preset frequency to the motor to drive the motor to operate for a preset period of time and controls the power of the motor to be turned off, start counting the pulse signal sent by the drive control subsystem to the motor to obtain a second count value in real time, and then determine whether the actual power control of the motor is abnormal based on whether an edge change event occurs in the two level signals when the second count value is greater than a pre-designed value.

8. The motor self-test system according to claim 6, characterized in that: The determination of the pre-designed value includes: Based on the preset frequency and the time interval, determining that one rotation of the synchronous wheel corresponds to a first number of pulse signals sent by the drive control subsystem to the motor; The angle difference between two adjacent teeth on the code disk and the center of the code disk is determined based on the number of distributed teeth on the code disk, and the pre-designed value is determined based on the first number and the angle difference.

9. The motor self-test system according to claim 1, characterized in that: The state detection subsystem is also used to: issue an alarm when an abnormality is detected in the motor.

10. A motor self-test method for an infusion pump, characterized in that: The motor self-test method is applied to the motor self-test system according to any one of claims 1 to 9; the motor self-test method comprises: The drive control subsystem drives the motor to operate, sets the target rotation direction of the motor, controls the speed of the motor, and controls the power supply working state of the motor; The state detection subsystem detects whether the motor is abnormal based on the driving signal of the motor, the target rotation direction, the power supply working state of the motor and two level signals; The state detection subsystem sends an abnormality signal indicating the abnormality of the motor to the drive control subsystem when detecting the abnormality of the motor; wherein the abnormality of the motor includes at least one of the following: abnormality in the actual rotation direction of the motor, abnormality in the actual speed of the motor, and abnormality in the actual power supply control of the motor; The drive control subsystem controls the motor to stop running when receiving the abnormal signal.

Images