Motor safety control circuit, motor safety control method and mobile equipment
The two motor stops and brakes of the differential wheel set are synchronized by the torque shutdown in the motor safety control circuit, which solves the problem of synchronous control of mobile devices in abnormal situations, and improves control efficiency and safety.
Patent Information
- Application Number
- CN202411106747.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-15
AI Technical Summary
When mobile devices face collision risks or abnormal situations, how to safely and efficiently control mobile devices to stop in time, especially the two motors of differential wheel sets are synchronously stopped and held on the brakes to avoid equipment damage.
A motor safety control circuit is designed, including a power supply, a safety controller, a safety driver and a torque shutdown. The two motors in the differential wheel set are synchronized to control the stop and brake of the two motors in the differential wheel set to ensure the safety of the mobile device. stop.
It realizes rapid response in abnormal situations, synchronously controls motor stop and brake hold, improves the control efficiency of mobile devices, and ensures the safety and stability of the equipment.
Smart Images

Figure CN118971676A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of motor motion control, and in particular to a motor safety control circuit, a motor safety control method and a mobile device. Background Art
[0002] As a power source, motors are widely used in all walks of life, bringing great convenience to production and life. For mobile devices driven by motors, how to control the safe stop of the mobile device when the mobile device faces abnormal situations such as collision risks is a crucial issue. For example, when an obstacle invades the driving area of the mobile device or the speed of the mobile device is abnormal, the mobile device needs to stop in time to avoid collision and thus avoid damage to the device.
[0003] In order to improve the steering capability of the device, a differential wheel set can be configured in the mobile device, and two motors can be used to drive a driving wheel so that the driving wheel can turn in all directions. For mobile devices equipped with differential wheels, how to safely and efficiently control the mobile device to stop in time when the mobile device faces abnormal situations such as collision risks is an urgent problem to be solved. Summary of the invention
[0004] The purpose of the embodiments of the present application is to provide a motor safety control circuit, a motor safety control method and a mobile device, so that when the mobile device is in an abnormal situation, the two motors in the differential wheel set are synchronously controlled to stop and brake through a torque breaker, so as to safely and efficiently control the mobile device to stop. The specific technical solution is as follows:
[0005] In a first aspect, an embodiment of the present application provides a motor safety control circuit, the motor safety control circuit comprising a power supply, a safety controller, a safety driver and a motor, the motor is provided with a motor brake, the safety driver is provided with a torque breaker, wherein:
[0006] The safety driver is electrically connected to the power supply, the safety controller, the motor and the motor brake respectively; the motor is used to drive the mobile device to move; the mobile device includes a differential wheel set, two motors in the differential wheel set are electrically connected to the torque breaker respectively, and the motor brake electrically connected to each motor is electrically connected to the torque breaker respectively;
[0007] The safety controller is used to output a shutoff signal to the torque breaker when the mobile device is in an abnormal situation;
[0008] The torque breaker is used to receive a shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop, and open the motor brake.
[0009] Optionally, the safety driver includes a motor winding drive and a motor brake drive, the motor winding drive is electrically connected to the motor, and the motor brake drive is electrically connected to the motor brake;
[0010] The torque breaker is specifically used to turn off the power supply of the motor and the motor brake to which the torque breaker is electrically connected when receiving the shutdown signal sent by the safety controller;
[0011] The safety driver is used to send a winding closing signal to the motor winding driver when receiving the shutdown signal, so that the motor winding driver closes the motor winding, and send a brake driving signal to the motor brake driver, so that the motor brake driver opens the motor brake.
[0012] Optionally, the shutdown signal is I / O data.
[0013] Optionally, the motor is further provided with a motor encoder, and the motor encoder is electrically connected to the safety driver;
[0014] The motor encoder is used to detect speed information of the motor and send the speed information to the safety driver;
[0015] The safety driver is specifically used to receive the speed information sent by the motor encoder, and when it is determined that the mobile device is in an abnormal situation based on the speed information, output a shutdown signal to the torque breaker, so that the torque breaker controls the motor electrically connected to the torque breaker to stop and turns on the motor brake of each motor;
[0016] The safety driver is further used to send the speed information to the safety controller;
[0017] The safety controller is further configured to receive the speed information and output a shutdown signal to the torque breaker when determining that the mobile device is in an abnormal condition based on the speed information;
[0018] The torque breaker is also used to receive the shutdown signal sent by the safety controller, determine whether the motor electrically connected to the torque breaker has stopped and the motor brake is turned on; if not, control the motor electrically connected to the torque breaker to stop and turn on the motor brake.
[0019] Optionally, the mobile device includes at least one differential wheel set, the number of the safety drives is the same as the number of the differential wheel sets, and the two motors in each differential wheel set are electrically connected to one safety drive.
[0020] Optionally, the motor safety control circuit further includes a safety input device, and the safety input device is electrically connected to the safety controller;
[0021] The safety input device is used to send a safety signal to the safety controller when an obstacle is detected around the mobile device or a stop instruction triggered by an external trigger is obtained;
[0022] The safety controller is specifically configured to receive the safety signal sent by the safety input device, and output a shutdown signal to the torque breaker when determining that the mobile device is in an abnormal situation based on the safety signal.
[0023] Optionally, the torque breaker includes a high-side control switch, and the safety driver further includes a low-side control switch;
[0024] The power supply is electrically connected to the motor via the high-side control switch, the low-side control switch is electrically connected to the motor, and the low-side control switch is grounded;
[0025] The safety driver is specifically configured to disconnect the high-side control switch and / or close the low-side control switch to control the motor to stop when receiving a shutdown signal.
[0026] Optionally, the power supply is electrically connected to the motor brake via the high-side control switch, the low-side control switch is electrically connected to the motor brake, and the low-side control switch is grounded;
[0027] The safety driver is specifically configured to disconnect the high-side control switch and / or the low-side control switch and activate the motor brake when receiving a shutdown signal.
[0028] Optionally, the safety driver includes a first master controller, a first slave controller, a first input interface, a second input interface, a high-side control switch, a motor winding drive, and a motor brake drive, the first master controller and the second slave controller are electrically connected to the first input interface, the second input interface, the high-side control switch, the motor winding drive, and the motor brake drive, respectively, and the first master controller is electrically connected to the first slave controller; the torque breaker includes the first master controller, the first slave controller, and the high-side control switch;
[0029] The first master controller is used to obtain the shutdown signal input by the safety controller through the first input interface and the second input interface, and determine whether the shutdown signal obtained through the first input interface is consistent with the shutdown signal obtained through the second input interface. If they are consistent, send the shutdown signal to the first slave controller;
[0030] The first slave controller is used to obtain the shutdown signal input by the safety controller through the first input interface and the second input interface, and determine whether the shutdown signal obtained through the first input interface is consistent with the shutdown signal obtained through the second input interface. If they are consistent, send the shutdown signal to the first master controller;
[0031] The first master controller is further configured to determine whether the shutdown signal obtained from the safety controller input is the same as the shutdown signal sent by the first slave controller, and if they are the same, output a disconnection instruction to the high-side control switch to disconnect the high-side control switch, so that the motor electrically connected to the high-side control switch stops and turns on the motor brake, output a winding closing signal to the motor winding drive to make the motor winding drive turn off the motor winding, and output a brake driving signal to the motor brake drive to make the motor brake drive turn on the motor brake;
[0032] The first slave controller is further used to determine whether the shutdown signal obtained by the safety controller input is the same as the shutdown signal sent by the first master controller. If they are the same, the disconnection instruction, the winding closing signal and the brake drive signal output by the first master controller are obtained, and the disconnection instruction, the winding closing signal and the brake drive signal determined based on the obtained shutdown signal input by the safety controller and the shutdown signal sent by the first master controller are respectively consistent with the disconnection instruction, the winding closing signal and the brake drive signal obtained by the first master controller output. If there are inconsistent signals, an alarm signal is output to the high-side control switch, the motor winding drive and the motor brake drive, so that the high-side control switch shields the disconnection instruction output by the first master controller, the motor winding drive shields the winding closing signal output by the first master controller, and the motor brake drive shields the brake drive signal output by the first master controller.
[0033] Optionally, the safety driver includes a first master controller, a first slave controller, a third input interface, a high-side control switch, a motor winding drive, and a motor brake drive, the first master controller and the first slave controller are electrically connected to the third input interface, the high-side control switch, the motor winding drive, and the motor brake drive, respectively, and the first master controller and the first slave controller are electrically connected; the torque breaker includes the first master controller, the first slave controller, and the high-side control switch;
[0034] The first master controller is configured to obtain speed information input externally through the third input interface, determine whether the mobile device is in an abnormal state based on the speed information, obtain a first determination result, and send the first determination result to the first slave controller;
[0035] The first slave controller is configured to obtain speed information input externally through the third input interface, determine whether the mobile device is in an abnormal state based on the speed information, obtain a second determination result, and send the second determination result to the first master controller;
[0036] The first main controller is further configured to determine whether the first determination result is the same as the second determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output a disconnection instruction to the high-side control switch to disconnect the high-side control switch, so that the motor electrically connected to the high-side control switch stops and turns on the motor brake, output a winding closing signal to the motor winding drive to cause the motor winding drive to close the motor winding, and output a brake driving signal to the motor brake drive to cause the motor brake drive to turn on the motor brake;
[0037] The first slave controller is also used to determine whether the first judgment result is the same as the second judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, the disconnection instruction, the winding closing signal and the brake drive signal output by the first main controller are obtained, and the disconnection instruction, the winding closing signal and the brake drive signal determined based on the first judgment result and the second judgment result are respectively consistent with the disconnection instruction, the winding closing signal and the brake drive signal output by the first main controller. If they are inconsistent, an alarm signal is output to the high-side control switch, the motor winding drive and the motor brake drive, so that the high-side control switch shields the disconnection instruction output by the first main controller, the motor winding drive shields the winding closing signal output by the first main controller, and the motor brake drive shields the brake drive signal output by the first main controller.
[0038] Optionally, the safety controller includes an input module, a processing module and an output module, the processing module is electrically connected to the input module, the safety driver and the output module respectively, and the output module is electrically connected to the safety driver;
[0039] The input module is used to obtain an external input safety signal and send the safety signal to the processing module;
[0040] The processing module is configured to receive the safety signal and the speed information sent by the safety driver, and send a control signal to the output module when it is determined that the mobile device is in an abnormal condition based on the safety signal or the speed information;
[0041] The output module is used to receive the control signal sent by the processing module, and when it is determined that the control signal instructs the mobile device to stop, output a shutdown signal to the torque breaker, so that when the torque breaker receives the shutdown signal, it controls the motor electrically connected to the torque breaker to stop and turns on the motor brake.
[0042] Optionally, the input module includes a second master controller, a second slave controller, a fourth input interface and a first output interface, the second master controller and the second slave controller are electrically connected to the fourth input interface and the first output interface respectively, and the second master controller is electrically connected to the second slave controller;
[0043] The second master controller is used to obtain an external input safety signal through the fourth input interface, and send the safety signal to the second slave controller;
[0044] The second slave controller is used to obtain an external input safety signal through the fourth input interface, and send the safety signal to the second master controller;
[0045] The second master controller is further configured to determine whether the acquired external input safety signal is the same as the safety signal sent by the second slave controller; if they are the same, output the safety signal to the processing module through the first output interface;
[0046] The second slave controller is also used to determine whether the acquired external input safety signal is the same as the safety signal sent by the second main controller; if they are the same, obtain the safety signal output by the second main controller, and determine whether the acquired external input safety signal is consistent with the acquired safety signal output by the second main controller; if they are inconsistent, output an alarm signal to the processing module through the first output interface, so that the processing module shields the safety signal output by the second main controller.
[0047] Optionally, the processing module includes a third master controller, a third slave controller, a fifth input interface and a second output interface, the third master controller and the third slave controller are electrically connected to the fifth input interface and the second output interface respectively, and the third master controller is electrically connected to the third slave controller;
[0048] The third master controller is configured to obtain the safety signal input by the input module through the fifth input interface, determine whether the mobile device is in an abnormal situation based on the safety signal, obtain a third determination result, and send the third determination result to the third slave controller;
[0049] The third slave controller is configured to obtain the safety signal input by the input module through the fifth input interface, determine whether the mobile device is in an abnormal situation based on the safety signal, obtain a fourth determination result, and send the fourth determination result to the third master controller;
[0050] The third main controller is further configured to determine whether the third determination result is the same as the fourth determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output a control signal to the output module through the second output interface;
[0051] The third slave controller is also used to determine whether the third judgment result is the same as the fourth judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, the control signal output by the third main controller is obtained, and it is determined whether the control signal determined based on the third judgment result and the fourth judgment result is consistent with the control signal output by the obtained third main controller. If they are inconsistent, an alarm signal is output to the output module through the third output interface, so that the output module shields the control signal output by the third main controller.
[0052] Optionally, the processing module includes a third master controller, a third slave controller, a sixth input interface, a seventh input interface and a second output interface, and the third master controller and the third slave controller are electrically connected to the sixth input interface, the seventh input interface and the second output interface respectively;
[0053] The third master controller is used to obtain the speed information sent by the security driver through the sixth input interface and the seventh input interface, and determine whether the speed information obtained through the sixth input interface is consistent with the speed information obtained through the seventh input interface, and if they are consistent, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a fifth judgment result, and send the fifth judgment result to the third slave controller;
[0054] The third slave controller is used to obtain the speed information sent by the security driver through the sixth input interface and the seventh input interface, and determine whether the speed information obtained through the sixth input interface is consistent with the speed information obtained through the seventh input interface. If they are consistent, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a sixth judgment result, and send the sixth judgment result to the third master controller;
[0055] The third main controller is further configured to determine whether the fifth determination result is the same as the sixth determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output the control signal to the output module through the second output interface;
[0056] The third slave controller is also used to determine whether the fifth judgment result is the same as the sixth judgment result; if they are the same and the judgment result indicates that the mobile device is in an abnormal situation, obtain the control signal output by the third main controller, and determine whether the control signal determined based on the fifth judgment result and the sixth judgment result is consistent with the control signal output by the acquired third main controller; if they are inconsistent, output an alarm signal to the output module through the second output interface, so that the output module shields the control signal output by the third main controller.
[0057] Optionally, the output module includes a fourth master controller, a fourth slave controller, an eighth input interface, a third output interface and a fourth output interface, the fourth master controller and the fourth slave controller are electrically connected to the eighth input interface, the third output interface and the fourth output interface respectively, the fourth master controller is electrically connected to the fourth slave controller; the third output interface and the fourth output interface are electrically connected to different torque breakers;
[0058] The fourth master controller is used to obtain the control signal input by the processing module through the eighth input interface, and send the control signal to the fourth slave controller;
[0059] The fourth slave controller is used to obtain the control signal input by the processing module through the seventh input interface, and send the control signal to the fourth master controller;
[0060] The fourth main controller is further used to determine whether the control signal input by the processing module is the same as the control signal sent by the fourth slave controller; if they are the same, output a shutdown signal to the torque breaker through the third output interface and the fourth output interface respectively, so that the torque breaker controls the motor electrically connected to the torque breaker to stop and turn on the motor brake based on the shutdown signal;
[0061] The fourth slave controller is also used to determine whether the control signal obtained by the processing module input is the same as the control signal sent by the fourth main controller; if they are the same, obtain the shutdown signal output by the fourth main controller, and determine whether the shutdown signal output by the fourth main controller through the third output interface is consistent with the shutdown signal output through the fourth output interface, and whether the shutdown signal determined based on the control signal is consistent with the shutdown signal obtained by the fourth main controller; if there is an inconsistency, output an alarm signal through the third output interface and the fourth output interface respectively, so that the torque breaker shields the shutdown signal.
[0062] In a second aspect, an embodiment of the present application provides a motor safety control method, the method being applied to a torque breaker in a safety driver in a motor safety control circuit according to any one of the first aspects, the motor being used to drive a mobile device to move; the mobile device comprising a differential wheel set, two motors in the differential wheel set being electrically connected to the torque breaker respectively, and a motor brake electrically connected to each motor being electrically connected to the torque breaker respectively; the method comprising:
[0063] Receive a shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop, and open the motor brake, wherein the shutdown signal is output by the safety controller in the motor safety control circuit to the torque breaker when the mobile device is in an abnormal situation.
[0064] In a third aspect, an embodiment of the present application provides a mobile device, comprising the motor safety control circuit described in any one of the first aspects and at least one differential wheel set.
[0065] In a fourth aspect, an embodiment of the present application further provides a computer program product comprising instructions, which, when executed on a computer, enables the computer to execute any of the motor safety control methods described above.
[0066] Beneficial effects of the embodiments of the present application:
[0067] In the solution provided by the embodiment of the present application, the motor safety control circuit includes a power supply, a safety controller, a safety driver and a motor, the motor is provided with a motor brake, and the safety driver is provided with a torque breaker, wherein: the safety driver is electrically connected to the power supply, the safety controller, the motor and the motor brake respectively; the motor is used to drive the mobile device to move; the mobile device includes a differential wheel set, the two motors in the differential wheel set are electrically connected to the torque breaker in the safety driver respectively, and the motor brake electrically connected to each motor is electrically connected to the torque breaker respectively; the safety controller is used to output a shutdown signal to the torque breaker when the mobile device is in an abnormal situation; the torque breaker is used to receive the shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop and open the motor brake. Since the two motors of the differential wheel set in the mobile device and the motor brake electrically connected to each motor are electrically connected to the torque breaker, in this way, when the mobile device is in an abnormal situation, the two motors of the differential wheel set can be synchronously controlled to stop and the motor brake can be synchronously opened through the torque breaker, so that by synchronously controlling each motor to stop and brake, the driving wheel of the mobile device is controlled to stop moving, and then the mobile device is controlled to stop safely. And the torque cut-off device can respond quickly and instantly control each motor to stop and open the motor brake, thereby improving the control efficiency of the mobile device. Of course, implementing any product or method of the present application does not necessarily need to achieve all the advantages described above at the same time. BRIEF DESCRIPTION OF THE DRAWINGS
[0068] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application, and for ordinary technicians in this field, other embodiments can also be obtained based on these drawings.
[0069] Figure 1 A schematic diagram of the structure of a motor safety control circuit provided in an embodiment of the present application;
[0070] Figure 2 Based on Figure 1 A schematic structural diagram of a torque breaker of the illustrated embodiment;
[0071] Figure 3 Based on Figure 1 A schematic structural diagram of a motor safety control circuit according to the illustrated embodiment;
[0072] Figure 4(a) is based on Figure 1 A schematic diagram of the structure of another motor safety control circuit of the illustrated embodiment;
[0073] FIG4( b ) is a schematic diagram of a process of controlling a motor based on speed information of the embodiment shown in FIG4( a );
[0074] Figure 5 Based on Figure 1 A schematic diagram of the structure of a safety signal control motor including multiple safety drivers in the illustrated embodiment;
[0075] Figure 6(a) is based on Figure 1 A schematic structural diagram of another motor safety control circuit of the illustrated embodiment;
[0076] FIG6( b ) is a schematic diagram of a motor control process based on the motor safety control circuit shown in FIG6( a );
[0077] Figure 7(a) is based on Figure 1 A schematic structural diagram of a safety driver and a motor brake connection method in the illustrated embodiment;
[0078] FIG. 7( b ) is a schematic diagram of the structure of a motor control circuit based on the connection mode shown in FIG. 7( a );
[0079] Figure 8(a) is based on Figure 1 A schematic structural diagram of a safety driver and a motor connection method in the illustrated embodiment;
[0080] FIG8( b ) is another schematic diagram of the structure of the motor control circuit based on the connection mode shown in FIG8( a );
[0081] Fig. 9 Based on Figure 1 A schematic structural diagram of a safety driver of the illustrated embodiment;
[0082] Fig.10 Based on Figure 1 Another schematic diagram of the structure of the safety driver of the illustrated embodiment;
[0083] Fig.11 Based on Figure 1 A schematic diagram of the structure of a control circuit including a multi-module safety controller according to the illustrated embodiment;
[0084] Fig.12 Based on Fig.11 A schematic diagram of the structure of the input module of the illustrated embodiment;
[0085] Fig.13 Based on Fig.11 A schematic diagram of the structure of the processing module of the illustrated embodiment;
[0086] Fig.14 Based on Fig.11 Another structural schematic diagram of the processing module of the illustrated embodiment;
[0087] Fig.15 Based on Fig.11A schematic diagram of the structure of the output module of the illustrated embodiment;
[0088] Fig.16 Based on Figure 1 A schematic diagram of the specific structure of a motor safety control circuit in the illustrated embodiment;
[0089] Fig.17 Based on Fig.16 A schematic diagram of the internal structure of the safety driver of the illustrated embodiment;
[0090] in, Figure 1-Figure 17 The corresponding relationship between the component names and the corresponding reference numerals is as follows:
[0091] 101 power supply, 102 safety controller, 103 safety driver, 104 motor, 105 motor brake, 106 torque cut-off device, 1031 motor winding drive, 1032 motor brake drive, 107 motor encoder, 108 safety input device, 109 high-side control switch, 110 low-side control switch, 111 first master controller, 112 first slave controller, 121 first input interface, 122 second input interface, 123 third input interface, 1021 input module, 1022 processing module, 1023 output module, 113 second master controller, 114 second slave controller, 124 fourth input interface, 131 first output interface, 115 third master controller, 116 third slave controller, 125 fifth input interface, 132 second output interface, 126 sixth input interface, 127 seventh input interface, 117 fourth master controller, 118 fourth slave controller, 128 eighth input interface, 133 third output interface, 134 fourth output interface. DETAILED DESCRIPTION
[0092] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field based on the present application belong to the scope of protection of the present application.
[0093] In order to safely and efficiently control a mobile device to stop in time when the mobile device faces abnormal situations such as collision risks, an embodiment of the present application provides a motor safety control circuit, a motor control method and a mobile device. The following first introduces a motor safety control circuit provided in an embodiment of the present application.
[0094] The motor safety control circuit provided in the embodiment of the present application can be applied to a mobile device with a differential wheel set, for example, a mobile intelligent robot with a differential wheel set, a mobile transport device with a differential wheel set, etc., which is not specifically limited here. For the sake of clarity, it is referred to as a mobile device below.
[0095] Each differential wheel set includes two motors and a driving wheel, and the driving wheel is driven to move by the two motors in the differential wheel set.
[0096] like Figure 1 As shown, a motor safety control circuit includes a power supply 101, a safety controller 102, a safety driver 103 and a motor 104, wherein the motor 104 is provided with a motor brake 105, and the safety driver 103 is provided with a torque breaker 106, wherein:
[0097] The safety driver 103 is electrically connected to the power supply 101, the safety controller 102, the motor 104 and the motor brake 105 respectively; the motor 104 is used to drive the mobile device to move; the mobile device includes a differential wheel set, and the two motors 104 in the differential wheel set are electrically connected to the torque breaker 106 respectively, and the motor brake 105 electrically connected to each motor 104 is electrically connected to the torque breaker 106 respectively;
[0098] The safety controller 102 is used to output a shutoff signal to the torque breaker 106 when the mobile device is in an abnormal situation;
[0099] The torque breaker 106 is used to receive a shutdown signal input from the safety controller 102 , control the motor 104 electrically connected to the torque breaker 106 to stop, and open the motor brake 105 .
[0100] In the solution provided by the embodiment of the present application, the motor safety control circuit includes a power supply, a safety controller, a safety driver and a motor, the motor is provided with a motor brake, and the safety driver is provided with a torque breaker, wherein: the safety driver is electrically connected to the power supply, the safety controller, the motor and the motor brake respectively; the motor is used to drive the mobile device to move; the mobile device includes a differential wheel set, the two motors in the differential wheel set are electrically connected to the torque breaker in the safety driver respectively, and the motor brake electrically connected to each motor is electrically connected to the torque breaker respectively; the safety controller is used to output a shutdown signal to the torque breaker when the mobile device is in an abnormal situation; the torque breaker is used to receive the shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop and open the motor brake. Since the two motors of the differential wheel set in the mobile device and the motor brake electrically connected to each motor are electrically connected to the torque breaker, in this way, when the mobile device is in an abnormal situation, the two motors of the differential wheel set can be synchronously controlled to stop and the motor brake can be synchronously opened through the torque breaker, so that by synchronously controlling each motor to stop and brake, the driving wheel of the mobile device is controlled to stop moving, and then the mobile device is controlled to stop safely. In addition, the torque cut-off device can respond quickly and instantly control each motor to stop and open the motor brake, thereby improving the control efficiency of the mobile equipment.
[0101] The mobile device is driven to move by the motor 104, and the motor 104 is driven and controlled by the safety driver 103. When the mobile device is in a normal state, the motor 104 needs to maintain normal movement to ensure the normal operation of the mobile device. In this case, the electrical connection path between the power supply 101 and the safety driver 103 is closed, so that the safety driver 103 can convert the electric energy provided by the power supply 101 into electric energy for driving the motor 104 to move, and provide electric energy to the motor 104 through its electrical connection with the motor 104, and then the safety driver 103 controls the movement of the motor 104, so that the mobile device moves with the movement of the motor 104.
[0102] The function of the motor brake 105 is to lock the position of the motor 104 when the motor 104 stops, so as to prevent the motor 104 from moving due to external force. Therefore, when the motor 104 is working normally, the motor brake 105 does not need to work, that is, the motor brake 105 is in a closed state. Therefore, when the mobile device is in a normal state, the safety driver 103 can close the motor brake 105 through its electrical connection with the motor brake 105.
[0103] For example, when the motor 104 operates normally, the safety driver 103 can provide electric energy to the motor brake 105 through the electrical connection with the motor brake 105 , and control the motor brake 105 to close.
[0104] The safe torque off function (Safe Torque Off, STO) is a function that cuts off the safety circuit directly connected to the power device and prohibits the circuit from providing current to the motor 104 and the motor brake 105. Since there is no current, the motor 104 cannot generate torque, so the motor stops. Compared with the method of directly disconnecting the power supply, the safe torque off function disconnects the power supply to avoid damage to the driver. Based on this, in order to improve the safety of motor braking, a safe torque off function can be added to the safety driver. In addition, the safe torque off function is implemented by a switch in the processor of the safety driver and the motor power supply circuit. The switch is located between the power supply and the motor, and the power supply circuit of the motor can be disconnected by turning off the switch.
[0105] The processor of the safety drive can be connected to a switch for controlling the on / off of the power supply circuit, and the combination of the processor of the safety drive and the switch for controlling the on / off of the power supply circuit can be used as a torque cut-off device for realizing the safe torque cut-off function inside the safety drive. Figure 2 As shown, the safety driver controls two motors in a one-to-two manner. The safety driver converts the power supply into a power supply, and supplies power to motor 1, motor brake 1, motor 2, and motor brake 2. A switch for controlling the on-off of the circuit is provided in the power supply circuit of the power supply. The switch and the processor of the safety driver form a torque breaker, wherein the processor receives a shutdown signal and controls the switch to be disconnected, thereby realizing the control process of shutting off the power supply of the motor and the motor brake through the torque breaker.
[0106] In order to receive a shutdown signal sent by the safety processor to instruct the torque breaker to shut off the power supply when the mobile device is in an abnormal situation, the safety driver can be provided with an interface for receiving the shutdown signal, hereinafter referred to as an STO interface.
[0107] When the mobile device is in a normal state, in order to keep the motor 104 working normally, the torque breaker 106 does not need to work, that is, the switch in the torque breaker 106 is in a closed state. Therefore, when the mobile device is in a normal state, the safety controller 102 does not need to output a shutdown signal to the torque breaker 106, and the switch in the torque breaker 106 is in a closed state.
[0108] When the mobile device is in an abnormal situation such as an obstacle invading the driving area of the mobile device, the speed information of the mobile device is abnormal, the emergency stop button for controlling the emergency stop of the mobile device is triggered, the mobile device needs to stop moving to avoid collision or damage. In this case, it is necessary to control the motor 104 used to drive the mobile device to move to brake to control the mobile device to stop.
[0109] Since the electric energy that the motor 104 relies on to move is first provided by the power supply 101 to the safety driver 103, and then the safety driver 103 converts the electric energy provided by the power supply 101 and provides it to the motor 104. Based on this, when the safety controller 102 detects that the mobile device is in an abnormal situation, it can perform signaling interaction with the safety driver 103 so that the safety driver 103 controls the motor 104 to brake.
[0110] Among them, the method of detecting whether the mobile device is in an abnormal situation can be based on the specific type of the pre-set abnormal situation, and the existing detection algorithm can be selected for detection, which is not specifically limited here. For example, for the abnormal situation that an obstacle invades the driving area of the mobile device, the existing path planning algorithm and obstacle detection algorithm can be combined to determine whether the obstacle invades the driving area of the mobile device to determine whether the mobile device is in an abnormal situation. For the abnormal situation that the speed of the mobile device is abnormal, the moving speed of the mobile device can be monitored, and whether the mobile device is in an abnormal situation can be determined by judging whether the moving speed exceeds a preset threshold, etc.
[0111] When it is necessary to control the motor 104 to stop, the safety driver 103 can directly cut off the power or send a motor winding closing signal to control the motor 104 to stop. However, the direct power-off method may cause damage to the equipment. Based on this, in order to improve the efficiency and safety of motor braking, the torque cut-off device 106 in the safety driver 103 can be used to open the safety circuit directly connected to the power device, prohibit the output circuit from sending current to the motor 104, and shut down the torque of the motor 104 to achieve the braking of the motor 104. In addition, since the motor brake 105 is also connected to the safety circuit, when the safety circuit is opened, the power supply of the motor brake 105 is also cut off, and the motor brake 105 is started. Among them, the power supply of the motor 104 and the motor brake 105 is the power supply inside the safety driver 103, and the power supply is mainly used to convert the electric energy of the power supply 101 to power the motor 104 and the motor brake 105.
[0112] Furthermore, since the mobile device is equipped with a differential wheel set, one driving wheel in the differential wheel set is driven by two motors 104. When the mobile device is controlled to stop, the two motors 104 of the driving wheel need to be braked at the same time to control the driving wheel to stop. If the two motors cannot be braked at the same time, the driving wheel will continue to move under the drive of the unbraked motor 104, causing the mobile device to continue to move and be damaged. Based on this, in order to control each motor 104 of each differential wheel set, each motor 104 in the differential wheel set can be electrically connected to the torque cutoff 106 in the safety driver 103.
[0113] Furthermore, in order to prevent the motor 104 from moving again under the action of external force after stopping, the motor brake 105 electrically connected to each motor 104 can also be electrically connected to the torque breaker 106. The torque breaker 106 is located in the common part of the power supply circuit of the motor and the motor brake. When the power supply circuit is disconnected by the torque breaker, the power supply of the motor 104 and the motor brake 105 can be cut off at the same time. The motor will stop when the power is off, and the motor brake will automatically open when the power is off. Therefore, the torque breaker can simultaneously control each motor powered by the power supply circuit to stop and open the motor brake by cutting off the power supply circuit.
[0114] In one implementation, the motor brake 105 and the motor 104 share a common power supply, and the torque breaker 106 can disconnect the common part of the power supply circuit of the motor brake 105 and the power supply circuit of the motor 104, thereby shutting off the power supply of the motor 104 and the power supply of the motor brake 105 to which the motor 104 is electrically connected.
[0115] In this way, when the mobile device is in an abnormal situation, the safety controller 102 can output a shutdown signal to the torque breaker 106 in the safety driver 103, and the torque breaker 106 can receive the shutdown signal input by the safety controller 102. Then, the torque breaker 106 opens the safety circuit connected to the power device, and shuts off the power supply of the motor 104 electrically connected to the torque breaker 106, and the power supply of the motor brake 105 electrically connected to the motor, thereby controlling the motor 104 electrically connected to the torque breaker 106 to stop, and opening the motor brake 105.
[0116] In one embodiment, the safety driver 103 also includes a motor winding drive 1031 and a motor brake drive 1032. The torque breaker 106 can receive a shutdown signal input by the safety controller 102, and control the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake 105. At the same time, in order to avoid the failure of the torque breaker 106 to brake the mobile device, the safety driver 103 can send a winding closing signal to the motor winding drive 1031 of each motor 104 when receiving the shutdown signal, and send a brake driving signal to the motor brake drive, so that the motor winding drive 1031 closes the motor winding, and the motor brake drive opens the motor brake 105, and controls the motor 104 to stop and lock.
[0117] In the solution provided by the embodiment of the present application, since the two motors of the differential wheel set in the mobile device and the motor brake electrically connected to each motor are electrically connected to the torque breaker, when the mobile device is in an abnormal situation, the two motors of the differential wheel set can be synchronously controlled to stop and the motor brake can be synchronously opened through the torque breaker, thereby controlling the driving wheels of the mobile device to stop moving by synchronously controlling each motor to stop and hold the brake, thereby controlling the mobile device to stop safely. In addition, the torque breaker can quickly respond to instantly control each motor to stop and open the motor brake, thereby improving the control efficiency of the mobile device.
[0118] As an implementation method of the embodiment of the present application, the safety driver 103 includes a motor winding driver 1031 and a motor brake driver 1032, the motor winding driver 1031 is electrically connected to the motor 104, and the motor brake driver 1032 is electrically connected to the motor brake 105;
[0119] The torque breaker 106 is specifically used to turn off the power supply of the motor 104 and the motor brake 105 electrically connected to the torque breaker 106 when receiving the shutdown signal sent by the safety controller 102;
[0120] The safety driver 103 is specifically used to send a winding closing signal to the motor winding driver 1031 when receiving a shutdown signal, so that the motor winding driver 1031 closes the motor winding, and sends a brake driving signal to the motor brake driver 1032, so that the motor brake driver 1032 opens the motor brake.
[0121] like Figure 3 As shown, the safety driver 103 is electrically connected to the power supply 101 and the safety controller 102 respectively, and the safety driver 103 includes a torque breaker 106, two motor winding drives 1031, namely, motor winding drive A and motor winding drive B, and two motor brake drives 1032, namely, motor brake drive A and motor brake drive B, and the safety driver 103 is electrically connected to two motors 104 to achieve one-to-two control. The torque breaker 106 is electrically connected to the motor 1, the motor brake 1, the motor 2, and the motor brake 2 respectively, the motor brake drive A is electrically connected to the motor brake 1 electrically connected to the motor 1, and the motor winding drive A is electrically connected to the motor 1; the motor brake drive B is electrically connected to the motor brake 2 electrically connected to the motor 2, and the motor winding drive B is electrically connected to the motor 2. Among them, the motor winding drive 1031 controls the start and stop of the motor 104 by controlling the motor winding, and the motor brake drive 1032 controls the opening and closing of the motor brake 105.
[0122] Therefore, when the mobile device is in an abnormal situation, the safety controller 102 can send a shutdown signal to the torque breaker 106. When the torque breaker 106 receives the shutdown signal sent by the safety controller 102, it can turn off the power supply of the motor 104 electrically connected to the torque breaker 106, so that the motor 104 electrically connected to the torque breaker 106 cannot generate torque, and turn off the power supply of the motor brake 105 electrically connected to the motor 104, so that the motor brake 105 is opened. Among them, the power supply of the motor 104 and the motor brake 105 is the power supply inside the safety driver 103.
[0123] In order to achieve a more stable motor braking effect and avoid the inability to brake the motor 104 due to the failure of the torque breaker to respond, the safety driver 103 can also send a winding closing signal to the motor winding drive 1031 when receiving the shutdown signal sent by the safety controller 102, so that the motor winding drive 1031 closes the motor winding, and sends a brake drive signal to the motor brake drive 1032, so that the motor brake drive 1032 opens the motor brake 105, thereby further realizing the braking and braking of the motor 104.
[0124] In the solution provided in the embodiment of the present application, the safety driver may include a motor winding drive and a motor brake drive. In this way, when the mobile device is in an abnormal situation, the torque breaker can disconnect the power supply of the motor and the motor brake to which the torque breaker is electrically connected when receiving the shutdown signal sent by the safety controller, thereby controlling the motor to brake and hold the brake. In order to improve the braking accuracy, the safety driver can also send a winding closing signal to the motor winding drive and a brake driving signal to the motor brake drive when receiving the shutdown signal, thereby closing the motor winding drive and opening the motor brake drive, thereby controlling the motor to stop and opening the motor brake, so that the motor brakes and the brake is locked, thereby controlling the mobile device to stop.
[0125] As an implementation of an embodiment of the present application, the shutdown signal is I / O data.
[0126] The data exchanged between the safety controller 102 and the safety driver 103 may include communication data and I / O (Input / Output) data. Among them, the I / O data is data transmitted through the connection channel (interface) with IO-Link between the safety controller 102 and the safety driver 103. IO-Link is a point-to-point, serial digital interface protocol, rather than a communication protocol such as a bus protocol. When the safety controller 102 and the safety driver 103 exchange I / O data, the receiving I / O data end does not need to use the communication protocol to perform data security verification on the received I / O data, so that the transmission speed of I / O data between the safety controller 102 and the safety driver 103 is faster.
[0127] In one embodiment, when the mobile device is in a normal state, the control instructions exchanged between the security controller 102 and the security driver 103 are communication data, and when the mobile device is in an abnormal state, the shutdown signal exchanged between the security controller 102 and the security driver 103 is I / O data.
[0128] When the mobile device is in an abnormal situation, it is hoped that the mobile device can be immediately controlled to stop to avoid damage to the mobile device. Since the stopping of the mobile device is achieved by controlling the braking of the motor 104, and the braking of the motor 104 and the opening of the motor brake are achieved by the torque breaker 106, in order to increase the control speed, the shutdown signal sent by the safety controller 102 to the torque breaker 106 is I / O data.
[0129] When the mobile device is detected to be in an abnormal situation, the safety controller 102 can send a shutdown signal to the safety driver 103 through the STO interface connected to the safety driver 103. Since the shutdown signal is I / O data, there is no need to use various communication protocols to verify the I / O data. The shutdown signal can be quickly transmitted to the torque breaker 106, and then the torque breaker 106 can also quickly respond to the shutdown signal sent by the safety controller 102, control the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake 105, and then control the mobile device to stop. In this way, compared with the method in which the safety controller 102 sends a stop instruction to the safety driver 103 through a communication loop, the I / O shutdown signal is directly sent to the torque breaker 106, and the whole process from the safety controller 102 detecting that the mobile device is in an abnormal situation to the mobile device stopping is short, and the torque breaker 106 has a fast response speed, which can achieve the control effect of instant parking and obstacle avoidance of the mobile device.
[0130] In the solution provided in the embodiment of the present application, the shutdown signal sent by the safety controller to the torque breaker is I / O data. After receiving the shutdown signal, the torque breaker does not need to perform communication data verification, thereby shortening the signal sending and signal response process. After the safety controller sends the shutdown signal, the torque breaker can immediately respond to the shutdown signal to control the motor to stop and open the motor brake, thereby improving the motor braking efficiency and achieving the control effect of instant parking of the mobile equipment.
[0131] As an implementation method of the embodiment of the present application, the motor 104 is further provided with a motor encoder 107, and the motor encoder 107 is electrically connected to the safety driver 103;
[0132] The motor encoder 107 is used to detect the speed information of the motor 104 and send the speed information to the safety driver 103;
[0133] The safety driver 103 is specifically used to receive the speed information sent by the motor encoder 107, and when it is determined that the mobile device is in an abnormal situation based on the speed information, output a shutdown signal to the torque disconnector 106, so that the torque disconnector 106 controls the motor 104 electrically connected to the torque disconnector 106 to stop and turn on the motor brake of each motor 104;
[0134] The safety driver 103 is also used to send speed information to the safety controller 102;
[0135] The safety controller 102 is further configured to receive the speed information and output a shutoff signal to the torque disconnector 106 when it is determined that the mobile device is in an abnormal condition based on the speed information;
[0136] The torque breaker 106 is also used to receive the shutdown signal sent by the safety controller 102, determine whether the motor 104 electrically connected to the torque breaker 106 has stopped and opened the motor brake 105; if not, control the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake 105.
[0137] In some cases, there may be no obstacles around the mobile device, but the mobile device may still be at risk of collision or damage, for example, the mobile device is out of control or the mobile speed of the mobile device is set incorrectly, causing the mobile device to move at an excessively fast speed and thus posing a risk of device damage, etc. Another example is that the mobile wheels of the mobile device are entangled by external objects, causing the mobile wheels to move at an excessively slow speed, etc.
[0138] Therefore, in addition to the motor brake 105, the motor 104 of the mobile device may also be provided with a motor encoder 107 electrically connected to the safety driver 103. Since the steering wheels of mobile devices equipped with differential wheels, such as omnidirectional robots, are relatively large and difficult to be applied at low heights, the current method of connecting the motor encoder 107 to the safety controller 102 requires the setting of a relatively large signal loop, which is not suitable for speed monitoring of mobile devices equipped with differential wheels. Considering the device structure, speed monitoring level requirements, and safety control efficiency requirements, the motor encoder 107 is connected to the safety driver 103, thereby realizing a differential motor signal monitoring method with a small loop and meeting the speed monitoring level requirements of PLd and above.
[0139] The motor encoder 107 can be used to detect speed information of the motor 104 , and send the speed information to the safety driver 103 through the electrical connection between the motor encoder 107 and the safety driver 103 .
[0140] The safety driver 103 may receive speed information sent by the motor encoder 107 and determine whether the mobile device is in an abnormal condition based on the speed information.
[0141] In one embodiment, after receiving the speed information, the safety driver 103 can determine whether the speed information is within a preset speed range. If so, it is determined that the current speed of the motor 104 is normal, and then it can be determined that the mobile device is not in an abnormal condition. If not, it is determined that the current speed of the motor 104 is abnormal, and then it can be determined that the mobile device is in an abnormal condition.
[0142] In another embodiment, after receiving the speed information, the safety driver 103 can determine the difference between the speed information and the ideal speed currently corresponding to the mobile device, and judge whether the difference is less than a preset threshold value. If it is less than, it is determined that the current speed of the motor 104 basically meets the ideal speed, and then it can be determined that the mobile device is not in an abnormal condition. If it is not less than, it is determined that the difference between the current speed of the motor 104 and the ideal speed is too large, and then it can be determined that the mobile device is in an abnormal condition.
[0143] In another embodiment, the number of motor encoders 107 can be multiple. After receiving the speed information sent by the motor encoders 107, the safety driver 103 can determine whether the speed information is the same. If they are the same, it can further determine whether the mobile device is in an abnormal situation based on the received speed information. If they are not the same, it can be determined that the mobile device is in an abnormal situation. The number of motor encoders 107 for each motor 104 can be set according to actual needs, for example, 2, 3, etc., and is not specifically limited here.
[0144] When the safety driver 103 determines that the mobile device is in an abnormal situation based on the speed information, it can output a shutdown signal to the torque breaker 106, so that the torque breaker 106 cuts off the power supply of the motor 104 and the motor brake 105 electrically connected to the torque breaker 106, thereby controlling the motor 104 to stop and opening the motor brake 105.
[0145] At the same time, in order to ensure the success rate of controlling the motor 104 to stop and brake, after receiving the speed information sent by the motor encoder 107, the safety driver 103 can not only determine whether the mobile device is in an abnormal situation based on the speed information, and control the motor 104 to stop and open the motor brake 105 when the mobile device is in an abnormal situation, but also send the speed information to the safety controller 102, so that the safety controller 102 can determine whether the mobile device is in an abnormal situation based on the speed information after receiving the speed information, and when it is determined that the mobile device is in an abnormal situation, it can control the motor 104 to stop and brake by sending a shutdown signal to each twist-off switch 106.
[0146] When the mobile device is in normal condition, the safety controller 102 and the safety driver 103 exchange communication data through the communication loop. For example, drive information, speed information, etc. are transmitted through the communication loop. The communication signal transmitted through the communication loop is the communication data. After receiving the communication data, the safety controller 102 and the safety driver 103 need to use the communication protocol to verify the data security of the communication data. For example, data verification is performed using CAN (Controller Area Network), RS485, EtherCAT (Ethernet control automation technology), etc.
[0147] In one embodiment, the safety controller 102 and the safety driver 103 can exchange communication data through two communication loops. In this way, the safety controller 102 and the safety driver 103 can achieve the purpose of data verification by verifying whether the communication data between the two communication loops are the same. Therefore, the data verification process is simplified by mutual verification between the two communication data.
[0148] When the mobile device is in an abnormal situation, in order to improve the control efficiency of the mobile device, the safety controller 102 and the safety driver 103 exchange I / O data through the transmission loop. Since the I / O data does not need to be verified, the data transmission efficiency is improved, thereby improving the motor control efficiency, that is, improving the control efficiency of the mobile device.
[0149] In this case, the safety driver 103 can send speed information to the safety controller 102 through the communication loop, so that the safety controller 102 can receive the speed information sent by the safety driver 103, and determine whether the mobile device is in an abnormal situation based on the speed information. If the mobile device is in an abnormal situation, the safety controller 102 can output a shutdown signal to the torque breaker 106. The torque breaker 106 can receive the shutdown signal sent by the safety controller 102, and then determine whether the motor 104 electrically connected to the torque breaker 106 has stopped and the motor brake 105 has been turned on. If the motor 104 electrically connected to the torque breaker 106 has stopped and the motor brake 105 has been turned on, the torque breaker 106 does not need to respond to the above shutdown signal; if the motor 104 electrically connected to the torque breaker 106 has not stopped and the motor brake 105 has not been turned on, the torque breaker 106 can respond to the above shutdown signal to shut off the power supply of the motor 104 electrically connected to it and the motor brake 105, thereby controlling the motor 104 to stop and brake. In this way, the motor control accuracy is improved through the double insurance control method.
[0150] The way in which the security controller 102 determines whether the mobile device is in an abnormal situation based on the speed information can refer to the way in which the security driver 103 determines whether the mobile device is in an abnormal situation based on the speed information, which will not be repeated here.
[0151] As shown in FIG4(a), the safety driver is electrically connected to the power supply 101. There is a communication loop for communication data and a transmission loop for I / O data between the safety controller 102 and the safety driver 103. The differential wheel set includes two motors 104, namely motor 1 and motor 2, and each motor 104 is provided with a motor brake 105 and a motor encoder 107. Motor 1, motor 2, motor brake 1 and motor brake 2 are all electrically connected to the torque cut-off device 106 of the safety driver 103. Motor encoder 1 and motor encoder 2 are electrically connected to the safety driver 103, respectively, and respectively feedback the speed information of the motor to the safety driver 103. The safety driver 103 receives the encoder input 1 of the motor encoder 1 and the encoder input 2 of the motor encoder 2, and judges whether the mobile device is in an abnormal state based on the speed information carried by the encoder input 1 and the encoder input 2. In addition, the safety driver 103 sends the speed information carried by the encoder input 1 and the encoder input 2 to the safety controller 102 through the communication loop.
[0152] When the safety driver 103 determines that the mobile device is in an abnormal state based on the speed information of the motor received by the encoder input 1 and the encoder input 2, it cuts off the power of the motor 1, the motor brake 1, the motor 2 and the motor brake 2 through the torque breaker, synchronously controls the motor 1 and the motor 2 to stop and opens the motor brake.
[0153] When the safety controller 102 determines that the mobile device is in an abnormal state, it sends a shutdown signal to the STO interface 1 of the torque breaker through the OUT1 interface, and sends a shutdown signal to the STO interface 2 through the OUT2 interface. The STO interface 1 and the STO interface 2 transmit the received shutdown signal to the torque breaker 106, and the torque breaker 106 determines whether the motor electrically connected to itself has stopped and the motor brake is turned on, and when the motor electrically connected to itself 104 has not stopped and the motor brake is not turned on, the power supply of the motor electrically connected to itself and the motor brake is turned off, so that the motor stops and the motor brake is turned on.
[0154] In one embodiment, the motor encoder 107 can send abnormal speed information to the safety driver 103 when detecting abnormal motor speed. The safety driver 103 receives the abnormal speed information sent by the motor encoder 107, sends the abnormal speed information to the safety controller 102, and turns off the power supply of the motor and the motor brake electrically connected to the torque breaker by twisting off the switch of the breaker 106, so that the motor stops and the motor brake of each motor is turned on. When receiving the abnormal speed information, the safety controller 102 outputs a shutdown signal to the torque breaker 106. When receiving the shutdown signal sent by the safety controller 102, the torque breaker 106 determines whether the motor electrically connected to the torque breaker has stopped and the motor brake is turned on; if not, the motor electrically connected to the torque breaker 106 is controlled to stop and the motor brake is turned on.
[0155] As shown in Figure 4(b), when the motor encoder detects that the motor speed is abnormal, the motor encoder sends the abnormal speed information to the safety driver. The safety driver receives the abnormal speed information, shuts off the power of the motor and the motor brake through the torque breaker, shuts off the motor winding through the motor winding driver, and opens the motor brake through the motor brake driver to stop the motor and brake. At the same time, the safety driver sends the abnormal speed information to the safety controller. After receiving the abnormal speed information, the safety controller outputs a shutdown signal to each torque breaker, so that the torque breaker shuts off the power of the motor and the motor brake.
[0156] In the solution provided in the embodiment of the present application, the motor safety control circuit may further include a motor encoder, which can detect the speed information of the motor and send the speed information to the safety driver through its electrical connection with the safety driver, so that when the safety driver determines that the mobile device is in an abnormal situation based on the speed information, it can control the motor to stop and brake through the torque breaker and the motor brake, so that the mobile device stops safely. Moreover, since the motor encoder is directly connected to the safety driver and the response speed of the safety driver is fast, when the speed information reflects that the mobile device is in an abnormal situation, the safety driver can brake and brake the motor immediately, thereby improving the efficiency of stopping control of the mobile device. Furthermore, in order to avoid the situation where the safety driver misjudges the situation of the mobile device due to equipment abnormality and fails to immediately perform motor braking control, after receiving the speed information, the safety driver can not only determine whether the mobile device is in an abnormal situation based on the speed information, and control the motor to stop and open the brake when the mobile device is in an abnormal situation, but also send the speed information to the safety controller, so that the safety controller can also determine whether the mobile device is in an abnormal situation based on the speed information, and send a shutdown signal to the torque switch when the mobile device is in an abnormal situation, so as to control the motor to stop through the torque switch, so that in the case of a misjudgment of the safety driver, the motor can still be controlled to stop and brake, and the success rate of controlling the motor to stop and brake is improved through the double insurance control method.
[0157] As an implementation of an embodiment of the present application, the mobile device includes at least one differential wheel set, the number of safety drives 103 is the same as the number of differential wheel sets, and the two motors 104 in each differential wheel set are electrically connected to one safety drive 103 .
[0158] The mobile device may include at least one differential wheel set. In order to control each differential wheel set separately, the safety driver 103 with the same data may be set according to the number of differential wheel sets of the mobile device, that is, the number of safety drivers 103 in the motor safety control circuit is the same as the number of differential wheel sets of the mobile device. Furthermore, each safety driver 103 may control two motors 104 in a differential wheel set, that is, each safety driver 103 may be one to two. The two motors 104 in each differential wheel set are electrically connected to the torque breaker 106 respectively, and the motor brake 105 electrically connected to each motor 104 is electrically connected to the torque breaker 106, so that the torque breaker 106 can synchronously control the two motors 104 in a differential wheel set.
[0159] Correspondingly, such as Figure 5As shown, the mobile device includes two differential wheel sets, and the motor safety control circuit of the mobile device includes two safety drivers 103. Each safety driver 103 is electrically connected to the power supply 101 and the safety controller 102, respectively, and each safety driver 103 is electrically connected to two motors 104 of a differential wheel set in a one-to-two manner. Each safety driver 103 may include a torque breaker 106, and the motor electrically connected to the safety driver 103 and the motor brake 105 of the motor 104 are both electrically connected to the torque breaker, that is, the torque breaker 1 of the safety driver 1 is electrically connected to the motor 1, the motor brake 1, the motor 2, and the motor brake 2, respectively; the torque breaker 2 of the safety driver 2 is electrically connected to the motor 3, the motor brake 3, the motor 4, and the motor brake 4, respectively.
[0160] The safety processor 102 can communicate with each safety driver 103. When the mobile device is in an abnormal situation, the safety processor 102 can send a shutdown signal to the STO interface 1 of each safety driver 103 through the OUT1 interface, and send a shutdown signal to the STO interface 2 of each safety driver through the OUT2 interface. The STO interface 1 and the STO interface 2 send the received shutdown signal to the torque breaker 106. When the torque breaker 106 receives the shutdown signal, it disconnects the power supply of the motor 104 and the motor brake 105. By synchronously controlling the torque breakers 106 in the two safety drivers 103 to shut off the power supply of the motor 104 and the motor brake 105 to which they are electrically connected, the two driving wheels of the mobile device are synchronously controlled to stop, thereby controlling the mobile device to stop.
[0161] In one embodiment, the mobile device includes at least one differential wheel set, the motor safety control circuit includes a safety driver 103, and the number of torque breakers 106 in the safety driver 103 is the same as the total number of motors 104 in all differential wheel sets of the mobile device, and each motor 104 in each differential wheel set and the motor brake 105 of the motor 104 are electrically connected to the torque breaker 106 in the safety driver 103.
[0162] In the solution provided in the embodiment of the present application, safety drivers with the same data can be set in the motor safety control circuit according to the number of differential wheel sets of the mobile device. In this way, each safety driver controls a differential wheel set, and the motor and the motor brake of each differential wheel set are connected to the torque breaker in the safety driver. Two motors in a differential wheel set can be synchronously controlled by one safety driver, and each differential wheel set of the mobile device can be synchronously controlled by each safety driver, thereby improving the control efficiency of the mobile device.
[0163] As an implementation method of the embodiment of the present application, the motor safety control circuit further includes a safety input device 108 , and the safety input device 108 is electrically connected to the safety controller 102 ;
[0164] The safety input device 108 is used to send a safety signal to the safety controller 102 when an obstacle is detected around the mobile device or when a stop command triggered by an external trigger is obtained;
[0165] The safety controller 102 is specifically configured to receive a safety signal sent by the safety input device 108 , and output a shutoff signal to each torque breaker 106 when determining that the mobile equipment is in an abnormal situation based on the safety signal.
[0166] The safety input device 108 is mainly divided into two types: contactless and non-contact. Among them, the non-contact safety input device may include a laser radar, an infrared detector, etc. This type of safety input device 108 can be set on a mobile device, and then the surrounding environment of the mobile device can be detected to determine whether there are obstacles around the mobile device. For example, a certain range of area around the mobile device can be set in advance as a safety area for the mobile device, and then the safety input device can detect in real time whether there are people or objects invading the safety area. If so, it is determined that there are obstacles around the mobile device, and then a safety signal can be sent to the safety controller 102.
[0167] The contact-type safety input device 108 may include an emergency stop button, a reset button, a manual-automatic button, etc. Such safety input devices may be provided on a mobile device or may not be provided on a mobile device, and may also be virtual buttons displayed on other electronic devices, etc. When the safety input device is triggered externally, for example, a person manually presses the emergency stop button, it is determined that an externally triggered stop command is obtained, and a safety signal may be sent to the safety controller 102.
[0168] As shown in Fig. 6(a), the safety input device 108 is electrically connected to the safety controller 102, and the safety driver 103 is electrically connected to the power supply 101. The safety controller 102 can receive the safety signal sent by the safety input device 108, and determine whether the mobile device is in an abnormal situation based on the safety signal. For example, the safety controller 102 can directly determine that the mobile device is in an abnormal situation when receiving the safety signal sent by the safety input device 108, or can determine whether the safety signal is the same as the preset safety signal after receiving the safety signal sent by the safety input device 108, and if they are the same, determine that the mobile device is in an abnormal situation, etc.
[0169] The safety driver 103 includes a torque breaker 106 , and the torque breaker 106 is electrically connected to the motor 104 and the motor brake 105 , that is, the torque breaker 106 is electrically connected to the motor 1 , the motor brake 1 , the motor 2 , and the motor brake 2 , respectively.
[0170] When the safety controller 102 determines that the mobile device is in an abnormal state based on the safety signal, it can output a shutdown signal to the torque breaker, so that the torque breaker shuts off the power of the motor 1, the motor brake 1, the motor 2 and the motor brake 2, and synchronously controls the motor 1 and the motor 2 to stop and open the motor brake. That is, as shown in Figure 6(b), when the safety input device is triggered, it sends a safety signal to the safety controller. Then, based on the above safety signal, the safety controller decides whether the mobile device is in an abnormal state, and when it is determined that the mobile device is in an abnormal state, it sends a shutdown signal to the STO interface. The torque breaker in the safety driver receives the shutdown signal, and shuts off the power of the motor electrically connected to it and the motor brake electrically connected to the motor, controls the motor to stop and opens the motor brake.
[0171] In the solution provided in the embodiment of the present application, the motor safety control circuit may further include a safety input device, which can send a safety signal to the safety controller through its electrical connection with the safety controller when an obstacle is detected around the mobile device or when an externally triggered stop command is obtained, that is, when it is determined that the mobile device may be in an abnormal situation such as a collision. When the mobile device is in an abnormal situation, the safety controller sends a shutdown signal to the torque breaker, so that the torque breaker can control the motor to stop and open the motor brake, thereby stopping the mobile device safely.
[0172] As an implementation of an embodiment of the present application, as shown in FIG7( a ), the torque breaker includes a high-side control switch, and the safety driver further includes a low-side control switch;
[0173] The power supply 101 is electrically connected to the motor brake 105 via the high-side control switch 109, the low-side control switch 110 is electrically connected to the motor brake 105, and the low-side control switch 110 is grounded;
[0174] The safety driver 103 is specifically configured to disconnect the high-side control switch 109 and / or the low-side control switch 110 and activate the motor brake when receiving a shutdown signal.
[0175] The torque breaker includes a high-side control switch 109 and a processor. The high-side control switch is located between the power supply 101 and the motor brake 105, so that the torque breaker can realize the disconnection of the power supply circuit through the high-side control switch 109. The safety driver also includes a low-side control switch 110 located between the motor brake 105 and the ground terminal. In this way, the safety driver 103 can control the opening and closing of the motor brake 105 through the high-side control switch 109 and the low-side control switch 110 respectively. Specifically:
[0176] The power supply 101 can be electrically connected to the high-side control switch 109 and the motor brake 105, the safety driver 103 can be electrically connected to the high-side control switch 109 to control the opening and closing of the high-side control switch 109, and can also be electrically connected to the low-side control switch 110 to control the opening and closing of the low-side control switch 110. One end of the low-side control switch 110 is electrically connected to the motor brake 105, and the other end is connected to the ground end, that is, the safety driver 103 can be electrically connected to the motor brake 105 through the low-side control switch 110, and the low-side control switch 110 is grounded.
[0177] Because the high-side control switch 109 is originally located on the path between the power supply 101 and the motor brake 105 , when the high-side control switch 109 is disconnected, the power supply of the motor brake 105 can be cut off, thereby achieving the brake effect.
[0178] Therefore, in the above motor safety control circuit, upon receiving the shutdown signal input by the safety controller 102 , the safety driver 103 can control the high-side control switch 109 to be turned off, thereby cutting off the power supply to the motor brake 105 and opening the motor brake.
[0179] For the safety driver 103, because the low-side control switch 110 electrically connected thereto is located between the motor brake 105 and the ground terminal, when the low-side control switch 110 is disconnected, the motor brake 105 cannot be powered on. Therefore, when the mobile device is in an abnormal situation, the safety driver 103 can disconnect the low-side control switch 110 to open the motor brake 105.
[0180] That is to say, when the safety driver 103 receives the shutdown signal input by the safety controller 102, the MCU (Micro Control Unit) inside the safety driver 103 processes the shutdown signal, and then disconnects the high-side control switch 109, and / or disconnects the low-side control switch 110, turns off the motor brake power supply, and turns on the motor brake.
[0181] The process of the torque breaker 106 turning off the motor brake power supply is as follows: the STO interface of the safety driver 103 receives the shutdown signal input by the safety controller 102, and the high-side control switch 109 is controlled and disconnected by the processor MCU inside the safety driver 103 to turn off the motor brake 105 power supply.
[0182] In one embodiment, the safety driver includes a motor brake drive and a power supply switch, as shown in FIG7(b), C1 is a power source, which is the positive electrode of a power source such as a lithium battery, the power supply switch is a high-side control switch (S1), the brake drive is a low-side control switch (S2), the motor brake (L1) is electrically connected to the high-side control switch and the low-side control switch, respectively, and the low-side control switch is connected to the power ground (GND). When the mobile device is in an abnormal state, the safety driver can open the motor brake by disconnecting the high-side control switch of the power supply switch, or by controlling the brake drive action.
[0183] The high-side control switch 109 is located on the path between the power supply 101 and the motor 104, and the high-side control switch is located on the path between the power supply 101 and the motor brake 105, so when the high-side control switch 109 is disconnected, the power supply of the motor 104 and the power supply of the motor brake 105 can be cut off at the same time, achieving the effect of motor braking and motor brake. And when the high-side control switch 109 is specifically located in the common part of the power supply circuit of the motor brake 105 and the power supply circuit of the motor 104, for example, the high-side control switch 109 is disconnected to cut off the power supply of the motor 104, achieving the effect of stopping the motor 104, and at the same time, the power supply of the motor brake 105 can be cut off to achieve the effect of the motor brake.
[0184] In one embodiment, because the low-side control switch 110 is located between the motor brake 105 and the ground terminal, it can only control the path where the motor brake 105 is located, and cannot control the path where the motor 104 is located. Therefore, by disconnecting the low-side control switch 110, the motor 104 cannot be controlled to stop. Therefore, when the mobile device is in an abnormal situation, in addition to disconnecting the low-side control switch 110 to open the motor brake, the safety driver 103 can also disconnect the power supply circuit of each motor 104 to stop the motor 104.
[0185] In one embodiment, the safety driver 103 may include a power supply, which is mainly used to convert the electric energy of the power supply 101 and supply power to the motor 104 and the motor brake 105, that is, the power supply 101 shared by the motor brake 105 and the motor 104 may be the power supply shared by the motor brake 105 and the motor 104. In this case, because the power supply is mainly used to convert the electric energy of the power supply 101 and supply power to the motor 104, the voltage of the electric energy output by the power supply is consistent with the rated voltage of the motor 104, while the rated voltage of the motor brake 105 and the rated voltage of the motor 104 may not be the same. Therefore, in order to enable the motor brake 105 to work normally, the safety driver 103 may also include a voltage conversion device, which can convert the voltage of the electric energy from the power supply to the rated voltage of the motor brake 105 through PWM (Pulse Width Modulation, pulse width modulation), and then output it to the motor brake 105.
[0186] In the solution provided in the embodiment of the present application, the safety driver includes a high-side control switch located between the power supply and the motor brake and a low-side control switch located between the motor brake and the ground terminal. In this way, when the mobile device is in an abnormal situation, the safety driver can disconnect at least one of the high-side control switch and the low-side control switch to disconnect the power supply of the motor brake and open the motor brake.
[0187] As an implementation of an embodiment of the present application, as shown in FIG8( a ), the torque breaker includes a high-side control switch 109 , and the safety driver further includes a low-side control switch 110 ;
[0188] The power supply 101 is electrically connected to the motor 104 via the high-side control switch 109 , the low-side control switch 110 is electrically connected to the motor 104 , and the low-side control switch 110 is grounded;
[0189] The safety driver 103 is specifically configured to disconnect the high-side control switch 109 and / or the low-side control switch 110 when receiving a shutdown signal, so as to control the motor to stop.
[0190] The safety driver 103 may include a high-side control switch 109 and a low-side control switch 110 , the power supply 101 is electrically connected to the motor 104 via the high-side control switch 109 , the low-side control switch 110 is electrically connected to the motor 104 , and the low-side control switch 110 is grounded.
[0191] When the mobile device is in an abnormal situation, the safety driver 103 can disconnect the high-side control switch 109 to turn off the power supply of the motor 104, or disconnect the low-side control switch 110 to turn off the motor winding of the motor 104, control the motor 104 to stop, and then control the mobile device to stop. Specifically, when the safety driver 103 receives the shutdown signal sent by the safety controller 102, or determines that the mobile device is in an abnormal situation based on the speed information, the high-side control switch 109 can be disconnected to disconnect the power supply of the motor 104 through the processor MCU inside the safety driver 103 to achieve high-side control, and / or the low-side control switch can be disconnected to turn off the motor winding to achieve low-side control. Thus, by disconnecting the high-side control switch 109 or disconnecting the low-side control switch 110, the motor 104 is controlled to stop.
[0192] Among them, the process in which the above-mentioned safety driver 103 disconnects the high-side control switch 109 and disconnects the motor power supply is the process in which the torque disconnector 106 disconnects the motor power supply. The torque disconnector 106 receives the shutdown signal input by the safety controller 102, and controls and processes through the processor MCU inside the safety driver 103 to disconnect the high-side control switch 109 and turn off the power supply of the motor 104. The safety driver 103 includes an STO interface. After the STO interface receives the shutdown signal, the shutdown signal is sent to the MCU, and the MCU controls the high-side control switch 109 to disconnect and disconnect the motor power supply.
[0193] In one embodiment, the safety driver includes a power supply control and a motor winding drive, as shown in FIG8(b), C1 is a power supply, which is the positive electrode of a power supply such as a lithium battery, the power supply switch is a high-side control switch (S1), the motor winding drive is electrically connected to the Q1-Q6 three-phase arm bridge switch included in the motor M, and the motor winding drive is connected to the power ground (GND), that is, the low-side control switch. The safety driver can turn off the motor power by disconnecting the high-side control switch S1, or turn off the motor winding by turning off the motor winding drive to turn off the three-phase arm bridge switch of the motor winding, thereby controlling the motor to stop.
[0194] In the solution provided in the embodiment of the present application, the safety driver may include a high-side control switch and a low-side control switch, the high-side control switch is electrically connected to the motor, the low-side control switch is electrically connected to the motor and the low-side control switch is grounded. In this way, when the mobile device is in an abnormal situation, the safety driver can control the motor to stop by turning off the high-side control switch and / or the low-side control switch.
[0195] As an implementation method of the present application, Fig. 9As shown, the safety driver 103 includes a first main controller 111, a first slave controller 112, a first input interface 121, a second input interface 122, a high-side control switch 109, a motor winding drive 1031, and a motor brake drive 1032. The first main controller 111 and the second slave controller 112 are electrically connected to the first input interface 121, the second input interface 122, the high-side control switch 109, the motor winding drive 1031, and the motor brake drive 1032, respectively, and the first main controller 111 is electrically connected to the first slave controller 112; the torque breaker includes a first main controller, a first slave controller, and a high-side control switch;
[0196] The first master controller 111 is used to obtain the shutdown signal input by the safety controller 102 through the first input interface 121 and the second input interface 122, and determine whether the shutdown signal obtained through the first input interface 121 is consistent with the shutdown signal obtained through the second input interface 122. If they are consistent, the shutdown signal is sent to the first slave controller 112;
[0197] The first slave controller 112 is used to obtain the shutdown signal input by the safety controller 102 through the first input interface 121 and the second input interface 122, and determine whether the shutdown signal obtained through the first input interface 121 is consistent with the shutdown signal obtained through the second input interface 122. If they are consistent, the shutdown signal is sent to the first master controller 111;
[0198] The first master controller 111 is further used to determine whether the shutdown signal input by the safety controller 102 is the same as the shutdown signal sent by the first slave controller 112. If they are the same, output a disconnection instruction to the high-side control switch 109 to disconnect the high-side control switch 109, so that the motor 104 electrically connected to the high-side control switch 109 stops and turns on the motor brake 105, output a winding closing signal to the motor winding driver 1031, so that the motor winding driver 1031 turns off the motor winding, and output a brake driving signal to the motor brake driver 1032, so that the motor brake driver 1032 turns on the motor brake 105;
[0199] The first slave controller 112 is also used to determine whether the shutdown signal input by the safety controller 102 is the same as the shutdown signal sent by the first main controller 111. If they are the same, the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111 are obtained, and the disconnection instruction, winding closing signal and brake drive signal determined based on the obtained shutdown signal input by the safety controller 102 and the shutdown signal sent by the first main controller 111 are respectively consistent with the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111. If there are inconsistent signals, an alarm signal is output to the high-side control switch 109, the motor winding drive 1031 and the motor brake drive 1032, so that the high-side control switch 109 shields the disconnection instruction output by the first main controller 111, the motor winding drive 1031 shields the winding closing signal output by the first main controller 111, and the motor brake drive 1032 shields the brake drive signal output by the first main controller 111.
[0200] In order to ensure that the shutdown signal sent by the safety controller 102 can be transmitted to the torque breaker 106, two shutdown signal transmission channels can be provided between the safety controller 102 and the safety driver 103, that is, the safety driver 103 includes two output interfaces for outputting shutdown signals, and the safety driver 103 includes two input interfaces for receiving shutdown signals.
[0201] Based on this, the safety driver 103 may include a first main controller 111, a first slave controller 112, a first input interface 121, a second input interface 122, a high-side control switch 109, a motor winding drive 1031, and a motor brake drive 1032. The first main controller 111 may obtain the shutdown information input by the safety controller 102 from the first input interface 121 and the second input interface 122 through its electrical connection with the first input interface 121 and the second input interface 122, and after obtaining the shutdown information, the first main controller 111 may determine whether the shutdown signal obtained through the first input interface 121 is consistent with the shutdown signal obtained through the second input interface 122. If consistent, the first main controller 111 may send the shutdown signal to the first slave controller 112 through its electrical connection with the first slave controller 112. If inconsistent, a notification message indicating that the shutdown signal is abnormal is output, so that relevant staff can confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0202] Similarly, the first slave controller 112 can also obtain the shutdown information input by the safety controller 102 from the first input interface 121 and the second input interface 122 through its electrical connection with the first input interface 121 and the second input interface 122, and after obtaining the shutdown information, the first slave controller 112 can determine whether the shutdown signal obtained through the first input interface 121 is consistent with the shutdown signal obtained through the second input interface 122. If consistent, the first slave controller 112 can send the shutdown signal to the first main controller 111 through its electrical connection with the first main controller 111. If inconsistent, a notification message indicating that the shutdown signal is abnormal is output, so that relevant staff can confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0203] In this way, the first main controller 111 and the first slave controller 112 can both obtain the shutdown information obtained by themselves and the shutdown information sent by the other controller. After obtaining the shutdown information sent by the first slave controller 112, the first main controller 111 can determine whether the shutdown information obtained by itself is the same as the shutdown information sent from the first slave controller 112. If they are the same, the first main controller 111 can output a disconnection instruction to the high-side control switch 109 to disconnect the high-side control switch 109, thereby stopping the motor 104 electrically connected to the high-side control switch 109 and turning on the motor brake 105, outputting a winding closing signal to the motor winding driver 1031 to make the motor winding driver 1031 close the motor winding, and outputting a brake drive signal to the motor brake driver 1032 to turn on the motor brake.
[0204] In one implementation, if the first master controller 111 and / or the first slave controller 112 only receives a shutdown signal from one of the first input interface 121 and the second input interface 122, an interface abnormality troubleshooting message is output to facilitate staff to troubleshoot related abnormal interfaces and verify the actual operation of the mobile device, so as to facilitate manual control of the mobile device based on the actual operation of the mobile device.
[0205] In one implementation, if the first master controller 111 and the first slave controller 112 only receive a shutdown signal input from one of the first input interface 121 and the second input interface 122, it is determined whether the mobile device is in an abnormal state based on the shutdown signal, and when it is determined that the mobile device is in an abnormal state, the mobile device is controlled to stop by outputting a shutdown instruction, a stop signal, and a brake signal, and an interface abnormality troubleshooting message is output to facilitate staff to troubleshoot abnormalities in relevant abnormal interfaces.
[0206] After obtaining the two shutdown information, the first slave controller 112 can also determine whether the shutdown information it has obtained is the same as the shutdown information sent by the first master controller 111. If different, the first slave controller 112 can output an abnormal prompt message to enable relevant personnel to confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0207] If the first slave controller 112 determines that the shutdown information obtained by itself is the same as the shutdown information sent by the first master controller 111, then the first slave controller 112 can further determine whether the disconnection instruction, winding closing signal and brake drive signal output by the first master controller 111 are correct. Specifically, the first slave controller 112 can obtain the disconnection instruction, winding closing signal and brake drive signal output by the first master controller 111, and determine whether the disconnection instruction, winding closing signal and brake drive signal determined based on the shutdown information received by itself and the shutdown information sent by the first master controller 111 are consistent with the disconnection instruction, winding closing signal and brake drive signal output by the first master controller 111. If they are inconsistent, it means that the first master controller 11 1 may have errors in the disconnection instruction, winding closing signal and brake drive signal output by the first slave controller 112. At this time, the first slave controller 112 can output an alarm signal to the high-side control switch 109, the motor winding drive 1031 and the motor brake drive 1032, so that the high-side control switch 109 shields the disconnection instruction output by the first master controller 111, the motor winding drive 1031 shields the winding closing signal output by the first master controller 111, and the motor brake drive 1032 shields the brake drive signal output by the first master controller 111, so as to avoid the high-side control switch 109, the motor winding drive 1031 and the motor brake drive 1032 from operating due to the erroneous instruction output by the first master controller 111, resulting in the motion state of the mobile device not matching its current environment.
[0208] The first slave controller 112 may not perform any operation when it determines that the disconnection instruction, winding closing signal and brake drive signal determined based on the shutdown information it obtains and the shutdown information sent by the first master controller 111 are consistent with the disconnection instruction, winding closing signal and brake drive signal obtained by the output of the first master controller 111.
[0209] In the solution provided by the embodiment of the present application, the safety driver may include a first master controller, a first slave controller, a first input interface and a second input interface. After receiving the shutdown information input by the first input interface and the second input interface, the first master controller and the first slave controller may respectively verify whether the shutdown information input by the first input interface and the second input interface is the same, so as to avoid misoperation caused by information transmission errors. In addition, the first master controller and the first slave controller may respectively determine whether the shutdown information obtained from the input interface is the same as the shutdown information sent to them by another controller. If they are the same, it means that the input interface can normally receive the shutdown information output by the outside world, and then the first master controller and the first slave controller may control the motor to stop and brake through the high-side control switch, the motor winding drive and the motor brake drive, thereby ensuring the accuracy of the motor control according to the shutdown information, and the first slave controller may further determine whether the safety signal output by the first master controller is accurate to ensure safety.
[0210] The torque breaker 106 includes a first master controller 111, a first slave controller 112 and a high-side control switch 109. When the mobile device is detected to be in an abnormal state, the safety processor 102 outputs a shutdown signal to the torque breaker 106, and the first master controller 111 and the first slave controller 112 process the shutdown signal according to the above processing flow, and when it is determined that the mobile device is in an abnormal state, the high-side control switch 109 is controlled to be disconnected, thereby realizing the control process of controlling the motor 104 to brake through the matrix breaker 106.
[0211] As an implementation method of the present application, Fig.10 As shown, the safety driver 103 includes a first main controller 111, a first slave controller 112, a third input interface 123, a high-side control switch 109, a motor winding drive 1031, and a motor brake drive 1032. The first main controller 111 and the second slave controller 112 are electrically connected to the third input interface 123, the high-side control switch 109, the motor winding drive 1031, and the motor brake drive 1032, respectively, and the first main controller 111 is electrically connected to the first slave controller 112; the torque breaker 106 includes a first main controller 111, a first slave controller 112, and a high-side control switch 109;
[0212] The first master controller 111 is used to obtain external input speed information through the third input interface 123, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a first determination result, and send the first determination result to the first slave controller 112;
[0213] The first slave controller 112 is used to obtain external input speed information through the third input interface 123, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a second determination result, and send the second determination result to the first master controller 111;
[0214] The first main controller 111 is further used to determine whether the first judgment result is the same as the second judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, output a disconnection instruction to the high-side control switch 109 to enable the high-side control switch 109, so that the motor 104 electrically connected to the high-side control switch 109 stops and turns on the motor brake 105, output a winding closing signal to the motor winding driver 1031 to enable the motor winding driver 1031 to close the motor winding, and output a brake driving signal to the motor brake driver 1032 to enable the motor brake driver 1032 to turn on the motor brake 105;
[0215] The first slave controller 112 is also used to determine whether the first judgment result is the same as the second judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111 are obtained, and the disconnection instruction, winding closing signal and brake drive signal determined based on the first judgment result and the second judgment result are respectively consistent with the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111. If they are inconsistent, an alarm signal is output to the high-side control switch 109, the motor winding drive 1031 and the motor brake drive 1032, so that the high-side control switch 109 shields the disconnection instruction output by the first main controller 111, the motor winding drive 1031 shields the winding closing signal output by the first main controller 111, and the motor brake drive 1032 shields the brake drive signal output by the first main controller 111.
[0216] The safety driver 103 may include a first main controller 111, a first slave controller 112, a third input interface 123, a motor winding drive 1031 and a motor brake drive 1032. The first main controller 111 may obtain external input speed information from the third input interface 123 through an electrical connection between the first main controller 111 and the third input interface 123, and determine whether the mobile device is in an abnormal condition based on the speed information. After obtaining the first judgment result, the first main controller 111 may also send the first judgment result to the first slave controller 112 through an electrical connection between the first main controller 111 and the first slave controller 112.
[0217] Similarly, the first slave controller 112 can also obtain speed information of external input from the third input interface 123 through its electrical connection with the third input interface 123, and determine whether the mobile device is in an abnormal situation based on the speed information. After obtaining the second judgment result, the first slave controller 112 can also send the second judgment result to the first main controller 111 through its electrical connection with the first main controller 111.
[0218] In this way, the first main controller 111 and the first slave controller 112 can both obtain their own judgment results on the speed information and the corresponding judgment results of the other controller on the speed information. After obtaining the two judgment results, the first main controller 111 and the first slave controller 112 can respectively determine whether the two judgment results they obtained are the same. If they are the same and the judgment results indicate that the mobile device is in an abnormal situation, the first main controller 111 can output a disconnection instruction to the high-side control switch 109 to stop the motor 104 electrically connected to the high-side control switch 109 and turn on the motor brake 105, output a winding closing signal to the motor winding drive 1031 to make the motor winding drive 1031 close the motor winding, and output a brake drive signal to the motor brake drive 1032 to make the motor brake drive 1032 turn on the motor brake 105, thereby controlling the motor braking and the brake.
[0219] After obtaining the two judgment results, the first slave controller 112 can also determine whether the two judgment results it obtained are the same. If different, the first slave controller 112 can abnormally output a prompt message to enable relevant personnel to confirm the current situation of the mobile device and detect whether there is a program error in the security controller 102.
[0220] If the first slave controller 112 determines that the two judgment results it obtains are the same and the judgment result indicates that the mobile device is in an abnormal situation, then the first slave controller 112 can further determine whether the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111 are correct. Specifically, the first slave controller 112 can obtain the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111, and determine whether the disconnection instruction, winding closing signal and brake drive signal determined based on the first judgment result and the second judgment result are consistent with the obtained disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111. If they are inconsistent, it means that there may be errors in the disconnection instruction, winding closing signal and brake drive signal output by the first main controller 111. At this time, the first slave controller 112 can output an alarm signal to the high-side control switch 109, the motor winding drive 1031 and the motor brake drive 1032, so that the high-side control switch 109 shields the disconnection instruction output by the first main controller 111, the motor winding drive 1031 shields the winding closing signal output by the first main controller 111, and the motor brake drive 1032 shields the brake drive signal output by the first main controller 111.
[0221] The first slave controller 112 may not perform any operation when it determines that the disconnection instruction, winding closing signal and brake drive signal determined based on the first judgment result and the second judgment result are consistent with the disconnection instruction, winding closing signal and brake drive signal output by the first master controller 111.
[0222] The torque breaker 106 includes a first master controller 111, a first slave controller 112 and a high-side control switch 109. When receiving speed information input from the outside, the first master controller 111 and the first slave controller 112 process the speed information according to the above processing flow, and when it is determined based on the speed information that the mobile device is in an abnormal situation, the high-side control switch 109 is controlled to be disconnected, thereby realizing the control process of controlling the motor 104 to brake through the matrix breaker 106.
[0223] In the solution provided in the embodiment of the present application, the safety driver may include a first main controller, a first slave controller and a third input interface for obtaining speed information of the mobile device. The first main controller and the first slave controller may respectively determine whether the mobile device is in an abnormal condition based on the speed information input by the third input interface to obtain a first judgment result and a second judgment result. Then, the first main controller and the first slave controller may respectively determine whether the first judgment result and the second judgment result are the same. If they are not the same, it is very likely that one of the controllers has failed. At this time, a prompt message may be output. If they are the same, it is very likely that the first judgment result and the second judgment result are both operating normally. At this time, the first judgment result and the second judgment result ensure the accuracy of the motor control according to the speed information, and the first slave controller may further determine whether the safety signal output by the first main controller is accurate to ensure safety.
[0224] As an implementation method of the present application, Fig.11 As shown, the safety controller 102 includes an input module 1021, a processing module 1022 and an output module 1023, the processing module 1022 is electrically connected to the input module 1021, the safety driver 103 and the output module 1023 respectively, and the output module 1023 is electrically connected to the safety driver 103;
[0225] The input module 1021 is used to obtain a safety signal input from the outside and send the safety signal to the processing module 1022;
[0226] The processing module 1022 is used to receive the safety signal and the speed information sent by the safety driver 103, and send a control signal to the output module when it is determined that the mobile device is in an abnormal situation based on the safety signal or the speed information;
[0227] The output module 1023 is used to receive the control signal sent by the processing module 1022, and when it is determined that the control signal instructs the mobile device to stop, output a shutdown signal to the torque breaker 106, so that when the torque breaker 106 receives the shutdown signal, it controls the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake 105.
[0228] The safety controller 102 may include multiple modules, namely an input module 1021, a processing module 1022 and an output module 1023, wherein the input module 1021 is connected to the outside to obtain a safety signal input from the outside. For example, the input module 1021 may be electrically connected to the safety input device 108 to send a safety signal when the safety input device 108 detects an obstacle around the mobile device or obtains a stop command triggered by an external trigger.
[0229] The processing module 1022 can be electrically connected to the input module 1021 and the safety driver 103, respectively, to obtain external input safety signals and speed information obtained by monitoring the speed of the motor from the input module 1021 and the safety driver 103, respectively, and then the processing module 1022 can determine whether the mobile device is in an abnormal situation based on the safety signal and / or speed information.
[0230] The processing module 1022 may also be electrically connected to the output module 1023, so that when the processing module 1022 determines that the mobile device is in an abnormal situation based on the safety signal, the control signal may be sent to the output module 1023 and the safety driver 103 respectively through the electrical connection between the processing module 1022 and the output module 1023 and the safety driver 103. When the processing module 1022 determines that the mobile device is in an abnormal situation based on the speed information, because the speed information is sent to the processing module 1022 by the safety driver 103, the safety driver 103 itself can determine whether the mobile device is in an abnormal situation based on the speed information, so the processing module 1022 can send the control signal to the output module 1023 only through the electrical connection between the processing module 1022 and the output module 1023.
[0231] The output module 1023 can receive the control signal sent by the processing module 1022 and determine the content indicated by the control signal. When the control signal instructs the mobile device to stop, the output module 1023 can output a shutdown signal to each torque breaker 106 based on its electrical connection with each torque breaker 106 in the safety driver 103, so that when each torque breaker 106 receives the shutdown signal, it controls the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake 105.
[0232] For example, the output module 1023 can receive the control signal sent by the processing module 1022, and determine the indicated action corresponding to the control signal based on the correspondence between the instructions and indicated actions stored in itself. If the control signal instructs the mobile device to stop, then the output module 1023 can output a shutdown signal to the torque breaker 106 based on its electrical connection with the torque breaker 106 in the safety driver 103, so that when the torque breaker 106 receives the shutdown signal, it controls the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake 105.
[0233] In the solution provided in the embodiment of the present application, the safety controller may include an input module, a processing module and an output module, wherein the input module and the processing module may be used to obtain an external input safety signal and obtain speed information sent by a safety driver, respectively. In this way, on the one hand, the speed information sent by the safety driver can reach the processing module faster to determine whether the mobile device is in an abnormal situation and achieve faster control. On the other hand, even if the input module used to obtain the external input safety signal fails, the processing module can directly obtain the speed information sent by the safety driver and then determine that the mobile device is in an abnormal situation, thereby ensuring the success rate of controlling the motor to stop and brake.
[0234] As an implementation method of the present application, Fig.12 As shown, the input module 1021 includes a second main controller 113, a second slave controller 114, a fourth input interface 124 and a first output interface 131, the second main controller 113 and the second slave controller 114 are electrically connected to the fourth input interface 124 and the first output interface 131 respectively, and the second main controller 113 and the second slave controller 114 are electrically connected;
[0235] The second master controller 113 is used to obtain an external input safety signal through the fourth input interface 124 and send the safety signal to the second slave controller 114;
[0236] The second slave controller 114 is used to obtain an external input safety signal through the fourth input interface 124 and send the safety signal to the second master controller 113;
[0237] The second master controller 113 is further used to determine whether the acquired external input safety signal is the same as the safety signal sent by the second slave controller 114; if they are the same, output the safety signal to the processing module 1022 through the first output interface 131;
[0238] The second slave controller 114 is also used to determine whether the acquired external input safety signal is the same as the safety signal sent by the second main controller 113; if they are the same, obtain the safety signal output by the second main controller 113, and determine whether the acquired external input safety signal is consistent with the acquired safety signal output by the second main controller 113; if they are inconsistent, output an alarm signal to the processing module through the first output interface 131, so that the processing module shields the safety signal output by the second main controller 113.
[0239] The input module 1021 may include a second main controller 113, a second slave controller 114, a fourth input interface 124, and a first output interface 131. The second main controller 113 may obtain an external input safety signal from the fourth input interface 124 through an electrical connection between the second main controller 113 and the fourth input interface 124, and after obtaining the safety signal, the second main controller 113 may send the safety signal to the second slave controller 114 through an electrical connection between the second main controller 113 and the second slave controller 114. Similarly, the second slave controller 114 may also obtain an external input safety signal from the fourth input interface 124 through an electrical connection between the second main controller 113 and the fourth input interface 124, and after obtaining the safety signal, the second slave controller 114 may also send the safety signal to the second main controller 113 through an electrical connection between the second main controller 113 and the second slave controller 114.
[0240] In this way, the second main controller 113 and the second slave controller 114 can both obtain the safety signal obtained by themselves and the safety signal sent by the other controller. After obtaining the two safety signals, the second main controller 113 can determine whether the two safety signals it obtained are the same. If they are the same, the second main controller 113 can output the safety signal to the processing module 1022 through the first output interface 131.
[0241] After obtaining the two safety signals, the second slave controller 114 can also determine whether the two safety signals it obtains are the same. If they are different, the second slave controller 114 can output a prompt message to enable relevant personnel to confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0242] If the second slave controller 114 determines that the two safety signals it obtains are the same, then the second slave controller 114 can further determine whether the safety signal output by the second main controller 113 is correct. Specifically, the second slave controller 114 can obtain the safety signal output by the second main controller 113, and determine whether the obtained external input safety signal is consistent with the obtained safety signal output by the second main controller 113. If they are inconsistent, it means that there may be an error in the safety signal output by the second main controller 113. At this time, the second slave controller 114 can output an alarm signal to the processing module 1022 through the first output interface 131, so that the processing module 1022 shields the safety signal output by the second main controller 113. At the same time, the second slave controller 114 can output a prompt message so that the relevant staff can confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0243] When the second slave controller 114 determines that the acquired external input safety signal is consistent with the acquired safety signal output by the second master controller 113 , the second slave controller 114 may not perform any operation.
[0244] In the solution provided in the embodiment of the present application, the input module may include a first main controller and a first slave controller. The first main controller and the first slave controller can respectively determine whether the safety signal obtained from the input interface is the same as the safety signal sent by another controller. If they are the same, it means that the input interface can normally receive the safety signal output by the outside world, and then the first main controller can output the safety signal to the processing module through the first output interface, so that the processing module can perform subsequent judgment process, and the first slave controller can further determine whether the safety signal output by the first main controller is accurate to ensure safety.
[0245] As an implementation method of the present application, Fig.13 As shown, the processing module 122 includes a third main controller 115, a third slave controller 116, a fifth input interface 125 and a second output interface 132, the third main controller 115 and the third slave controller 116 are electrically connected to the fifth input interface 125 and the second output interface 132 respectively, and the third main controller 115 and the third slave controller 116 are electrically connected;
[0246] The third master controller 115 is used to obtain the safety signal input by the input module 1021 through the fifth input interface 125, determine whether the mobile device is in an abnormal situation based on the safety signal, obtain a third judgment result, and send the third judgment result to the third slave controller 116;
[0247] The third slave controller 116 is used to obtain the safety signal input by the input module 1021 through the fifth input interface 125, determine whether the mobile device is in an abnormal situation based on the safety signal, obtain a fourth judgment result, and send the fourth judgment result to the third master controller 115;
[0248] The third main controller 115 is further used to determine whether the third determination result is the same as the fourth determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output a control signal to the output module 1023 through the second output interface 132;
[0249] The third slave controller 116 is also used to determine whether the third judgment result is the same as the fourth judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, the control signal output by the third main controller 115 is obtained, and it is determined whether the control signal determined based on the third judgment result and the fourth judgment result is consistent with the control signal output by the obtained third main controller 115. If they are inconsistent, an alarm signal is output to the output module 1023 through the third output interface, so that the output module 1023 shields the control signal output by the third main controller 115.
[0250] The processing module 1022 may include a third main controller 115, a third slave controller 116, a fifth input interface 125 and a second output interface 132. The third main controller 115 may obtain the safety signal input by the input module 1021 from the fifth input interface 125 through an electrical connection between the third main controller 115 and the fifth input interface 125, and determine whether the mobile device is in an abnormal situation based on the safety signal to obtain a third judgment result. After obtaining the third judgment result, the third main controller 115 may also send the third judgment result to the third slave controller 116 through an electrical connection between the third main controller 115 and the third slave controller 116.
[0251] Similarly, the third slave controller 116 can obtain the safety signal input by the input module 1021 from the fifth input interface 125 through the electrical connection between the third slave controller 116 and the fifth input interface 125, and judge whether the mobile device is in an abnormal situation based on the safety signal to obtain a fourth judgment result. After obtaining the fourth judgment result, the third slave controller 116 can also send the fourth judgment result to the third main controller 115 through the electrical connection between the third slave controller 116 and the third main controller 115.
[0252] In this way, the third main controller 115 and the third slave controller 116 can both obtain their own judgment results on the safety signal and the corresponding judgment results of the other controller on the safety signal. After obtaining the two judgment results, the third main controller 115 can determine whether the two judgment results it obtained are the same. If they are the same and the judgment results indicate that the mobile device is in an abnormal situation, the third main controller 115 can output the control signal to the output module 1023 through the second output interface 132.
[0253] After obtaining the two judgment results, the third slave controller 116 can also determine whether the two judgment results it obtained are the same. If different, the third slave controller 116 can output a prompt message to enable relevant personnel to confirm the current situation of the mobile device and detect whether there is a program error in the security controller 102.
[0254] If the third slave controller 116 determines that the two judgment results it obtains are the same and the judgment results indicate that the mobile device is in an abnormal situation, then the third slave controller 116 can further determine whether the safety signal output by the third main controller 115 is correct. Specifically: the third slave controller 116 can obtain the control signal output by the third main controller 115, and determine whether the control signal determined based on the third judgment result and the fourth judgment result is consistent with the control signal output by the third main controller 115. If they are inconsistent, it means that the safety signal output by the third main controller 115 may be erroneous. At this time, the third slave controller 116 can output an alarm signal to the output module 1023 through the second output interface 132, so that the output module 1023 shields the safety signal output by the third main controller 115. At the same time, the third slave controller 116 can also output prompt information to enable relevant personnel to confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0255] When the third slave controller 116 determines that the control signal determined based on the third judgment result and the fourth judgment result is consistent with the acquired control signal output by the third master controller 115 , the third slave controller 116 may not perform any operation.
[0256] In the solution provided in the embodiment of the present application, the processing module may include a third main controller and a third slave controller. The third main controller and the third slave controller may respectively determine whether the mobile device is in an abnormal situation based on the safety signal to obtain a third judgment result and a fourth judgment result. Then, the third main controller and the third slave controller may respectively determine whether the third judgment result and the fourth judgment result are the same. If they are not the same, it is very likely that one of the controllers has failed. At this time, a prompt message may be output. If they are the same, it is very likely that the third main controller and the third slave controller are both operating normally. At this time, the control signal may be output to the output module through the second output interface, thereby ensuring the accuracy of the motor control according to the safety signal. The third slave controller may further determine whether the control signal output by the third main controller is accurate to ensure safety.
[0257] As an implementation method of the present application, Fig.14 As shown, the processing module 1022 also includes a third main controller 115, a third slave controller 116, a sixth input interface 126, a seventh input interface 127 and a second output interface 132, and the third main controller 115 and the third slave controller 116 are electrically connected to the sixth input interface 126, the seventh input interface 127 and the second output interface 132 respectively;
[0258] The third master controller 115 is used to obtain the speed information sent by the security driver 103 through the sixth input interface 126 and the seventh input interface 127, and determine whether the speed information obtained through the sixth input interface 126 is consistent with the speed information obtained through the seventh input interface 127. If they are consistent, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a fifth judgment result, and send the fifth judgment result to the third slave controller 116;
[0259] The third slave controller 116 is used to obtain the speed information sent by the security driver 103 through the sixth input interface 126 and the seventh input interface 127, and determine whether the speed information obtained through the sixth input interface 126 is consistent with the speed information obtained through the seventh input interface 127. If they are consistent, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a sixth judgment result, and send the sixth judgment result to the third master controller 115;
[0260] The third main controller 115 is further used to determine whether the fifth judgment result is the same as the sixth judgment result, and if they are the same and the judgment result indicates that the mobile device is in an abnormal situation, output a control signal to the output module through the second output interface 132;
[0261] The third slave controller 116 is also used to determine whether the fifth judgment result is the same as the sixth judgment result; if they are the same and the judgment result indicates that the mobile device is in an abnormal situation, obtain the control signal output by the third main controller 115, and determine whether the control signal determined based on the fifth judgment result and the sixth judgment result is consistent with the obtained control signal output by the third main controller 115; if they are inconsistent, output an alarm signal to the output module through the second output interface 132, so that the output module shields the control signal output by the third main controller 115.
[0262] The processing module 1022 may include a third main controller 115, a third slave controller 116, a sixth input interface 126, a seventh input interface 127, and a second output interface 132. The third main controller 115 may obtain the speed information sent by the security driver 103 from the sixth input interface 126 and the seventh input interface 127 through the electrical connection between the third main controller 115 and the sixth input interface 126 and the seventh input interface 127. It is determined whether the speed information obtained through the sixth input interface 126 is consistent with the speed information obtained through the seventh input interface 127; if they are consistent, it is determined whether the mobile device is in an abnormal situation based on the speed information to obtain a fifth judgment result, and after obtaining the fifth judgment result, the third main controller 115 may also send the fifth judgment result to the third slave controller 116 through the electrical connection between the third main controller 115 and the third slave controller 116; if they are inconsistent, an abnormal prompt message is output to facilitate the staff to confirm the speed information of the mobile device and check whether there is a program error in the relevant interface.
[0263] Similarly, the third slave controller 116 can obtain the speed information sent by the security driver 103 from the sixth input interface 126 and the seventh input interface 127 through the electrical connection between the third slave controller 116 and the sixth input interface 126 and the seventh input interface 127. It is determined whether the speed information obtained through the sixth input interface 126 is consistent with the speed information obtained through the seventh input interface 127; if they are consistent, it is determined whether the mobile device is in an abnormal situation based on the speed information to obtain a sixth judgment result, and after obtaining the sixth judgment result, the third slave controller 116 can also send the sixth judgment result to the third main controller 115 through the electrical connection between the third slave controller 116 and the third main controller 115; if they are inconsistent, an abnormal prompt message is output to facilitate the staff to confirm the speed information of the mobile device and check whether there is a program error in the relevant interface.
[0264] In this way, the third main controller 115 and the third slave controller 116 can both obtain their own judgment results on the speed information and the corresponding judgment results of the other controller on the speed information. After obtaining the two judgment results, the third main controller 115 can determine whether the two judgment results it obtained are the same.
[0265] Because the speed information is sent by the security driver 103 to the processing module 1022, the security driver 103 itself can determine whether the mobile device is in an abnormal situation based on the speed information. Therefore, when the third main controller 115 determines that the two judgment results it obtains are the same and the judgment results indicate that the mobile device is in an abnormal situation, the third main controller 115 can only output the control signal to the output module 1023 through the second output interface 132.
[0266] After obtaining the two judgment results, the third slave controller 116 can also determine whether the two judgment results it obtains are the same. If they are different, the third slave controller 116 can output a prompt message. If the third slave controller 116 determines that the two judgment results it obtains are the same and the judgment result indicates that the mobile device is in an abnormal situation, then the third slave controller 116 can further determine whether the control signal output by the third main controller 115 is correct. Specifically, the third slave controller 116 obtains the control signal output by the third main controller 115, and determines whether the control signal determined based on the fifth judgment result and the sixth judgment result is consistent with the control signal output by the third main controller 115. If they are inconsistent, it indicates that the control signal output by the third main controller 115 may be wrong. At this time, the third slave controller 116 outputs an alarm signal to the output module 1023 through the second output interface 132, so that the output module 1023 shields the control signal output by the third main controller 115. At the same time, the third slave controller 116 can also output a prompt message to enable relevant staff to confirm the current situation of the mobile device and detect whether there is a program error in the safety controller 102.
[0267] When the third slave controller 116 determines that the control signal determined based on the fifth and sixth judgment results is consistent with the acquired control signal output by the third master controller 115 , the third slave controller 116 may not perform any operation.
[0268] In the solution provided in the embodiment of the present application, the processing module may include a third main controller and a third slave controller. The third main controller and the third slave controller may respectively determine whether the mobile device is in an abnormal situation based on the speed information to obtain a fifth judgment result and a sixth judgment result. Then, the third main controller and the third slave controller may respectively determine whether the fifth judgment result and the sixth judgment result are the same. If they are not the same, it is very likely that one of the controllers has failed. At this time, a prompt message may be output. If they are the same, it is very likely that the third main controller and the third slave controller are both operating normally. At this time, the control instruction may be output to the output module through the third output interface, thereby ensuring the accuracy of the motor control according to the safety signal. The third slave controller may further determine whether the control instruction output by the third main controller is accurate to ensure safety.
[0269] As an implementation method of the present application, Fig.15As shown, the output module includes a fourth master controller 117, a fourth slave controller 118, an eighth input interface 128, a third output interface 133 and a fourth output interface 134, the fourth master controller 117 and the fourth slave controller 118 are electrically connected to the eighth input interface 128, the third output interface 133 and the fourth output interface 134 respectively, and the fourth master controller 117 and the fourth slave controller 118 are electrically connected; the third output interface 133 and the fourth output interface 134 are electrically connected to different torque breakers;
[0270] The fourth master controller 117 is used to obtain the control signal input by the processing module 1022 through the eighth input interface 128, and send the control signal to the fourth slave controller 118;
[0271] The fourth slave controller 118 is used to obtain the control signal input by the processing module 1022 through the seventh input interface, and send the control signal to the fourth master controller 117;
[0272] The fourth master controller 117 is further used to determine whether the control signal input by the acquired processing module 1022 is the same as the control signal sent by the fourth slave controller 118; if they are the same, output a shutdown signal to the torque breaker 106 through the third output interface 133 and the fourth output interface 134 respectively, so that the torque breaker 106 controls the motor 104 electrically connected to the torque breaker 106 to stop and turn on the motor brake based on the shutdown signal;
[0273] The fourth slave controller 118 is also used to determine whether the control signal input by the acquired processing module 1022 is the same as the control signal sent by the fourth main controller 117; if they are the same, the shutdown signal output by the fourth main controller 117 is acquired, and it is determined whether the shutdown signal output by the fourth main controller 117 through the third output interface 133 is consistent with the shutdown signal output through the fourth output interface 134, and whether the shutdown signal determined based on the control signal is consistent with the shutdown signal output by the acquired fourth main controller 117; if there is an inconsistency, an alarm signal is output respectively through the third output interface 133 and the fourth output interface 134, so that the torque breaker 106 shields the shutdown signal.
[0274] The output module 1023 may include a fourth main controller 117, a fourth slave controller 118, an eighth input interface 128, a third output interface 133, and a fourth output interface 134. The fourth main controller 117 may obtain the control signal input by the processing module 1022 from the eighth input interface 128 through the electrical connection between the fourth main controller 117 and the eighth input interface 128, and after obtaining the control signal, the fourth main controller 117 may send the control signal to the fourth slave controller 118 through the electrical connection between the fourth main controller 117 and the fourth slave controller 118. Similarly, the fourth slave controller 118 may also obtain the control signal input by the processing module 1022 from the eighth input interface 128 through the electrical connection between the fourth main controller 117 and the eighth input interface 128, and after obtaining the control signal, the fourth slave controller 118 may also send the control signal to the fourth main controller 117 through the electrical connection between the fourth main controller 117 and the fourth slave controller 118.
[0275] In this way, the fourth main controller 117 and the fourth slave controller 118 can both obtain the control signal obtained by themselves and the control signal sent by the other controller. After obtaining the two control signals, the fourth main controller 117 can determine whether the two control signals it obtained are the same. If they are the same, the fourth main controller 117 can respectively shut down the signal to the torque breaker 106 through the third output interface 133 and the fourth output interface 134, so that the torque breaker 106 controls the motor 104 electrically connected to the torque breaker 106 to stop and open the motor brake based on the shutdown signal.
[0276] After the fourth slave controller 118 obtains two control signals, it can also determine whether the two control signals it obtains are the same. If they are different, the fourth slave controller 118 can output a prompt message so that the staff can detect whether there are errors in the program and related interfaces of the safety controller 102 based on the prompt message.
[0277] If the fourth slave controller 118 determines that the two control signals it obtains are the same, then the fourth slave controller 118 can further determine whether the shutdown signal output by the fourth master controller 117 is correct. Specifically, the fourth slave controller 118 can obtain the shutdown signal output by the fourth master controller 117, and determine whether the shutdown signal determined based on the control signal is consistent with the shutdown signal output by the fourth master controller 117. If they are inconsistent, it means that the shutdown signal output by the fourth master controller 117 may be erroneous. At this time, in order to avoid dangerous situations caused by possible errors in the shutdown signal output by the fourth master controller 117, the fourth slave controller 118 can output alarm signals through the third output interface 133 and the fourth output interface 134 respectively, so that each torque breaker 106 shields the shutdown signal.
[0278] The fourth slave controller 118 may not perform any operation when determining whether the shutdown signal determined based on the control signal is consistent with the acquired shutdown signal output by the fourth master controller 117 .
[0279] In the solution provided in the embodiment of the present application, the output module may include a fourth master controller and a fourth slave controller. The fourth master controller and the fourth slave controller may respectively determine whether the control signal obtained from the input interface is the same as the control signal sent to themselves by another controller. If they are the same, it means that the input interface can normally receive the control signal output by the outside world, and then the fourth master controller and the fourth slave controller can output a shutdown signal through the fourth output interface to control the motor to stop and brake through the torque breaker and the motor brake, thereby ensuring the accuracy of the motor control, and the fourth slave controller can further determine whether the safety signal output by the fourth master controller is accurate to ensure safety.
[0280] Below Figure 16-Figure 17 Taking the motor safety control circuit provided in the embodiment of the present application as an example, the following will introduce the motor safety control circuit provided in the embodiment of the present application.
[0281] like Fig.16 As shown, the mobile device may include multiple differential wheel sets, each differential wheel set includes a driving wheel and two motors, and the driving wheel can move in all directions under the drive of the two motors. The two motors in each differential wheel set are driven by a safety driver, and the number of safety drivers included in the motor safety control circuit is the same as the number of differential wheel sets. Each safety driver includes a torque breaker and two interfaces STO1 and STO2 for receiving a shutdown signal, and the torque breaker is electrically connected to the two motors in the differential wheel set and the motor brake electrically connected to each motor, that is, the torque breaker of the safety driver 1 is electrically connected to the motor 1, the motor brake 1, the motor 2 and the motor brake 2 respectively; the torque breaker of the safety driver 2 is electrically connected to the motor 3, the motor brake 3, the motor 4 and the motor brake 4 respectively. The safety driver converts the power supply electricity to the motor and the motor brake through electric energy conversion, so that the power supply of the motor and the motor brake is the power supply after the safety driver converts the power supply, and the torque breaker is used to control the on and off of the power supply circuit of the power supply.
[0282] The safety input device may include a plurality of non-contact devices such as laser radars and a plurality of contact devices such as buttons, namely lasers 1 to laser N and buttons 1 to button N. When the safety input device detects obstacles around the mobile device or obtains an externally triggered stop command, it may send a safety signal to the input module in the safety controller. After receiving the safety signal, the input module may communicate with the processing module of the safety controller and send the safety signal to the processing module so that the processing module determines whether the mobile device is in an abnormal state based on the safety signal. The processing module of the safety controller, the safety driver 1 and the safety driver 2 may also include two communication paths for communication, namely, communication 1 and communication 2. The safety controller may send a drive signal to the safety driver through communication 1 and communication 2, and the safety driver may feedback motor speed information to the safety controller through communication 1 and communication 2.
[0283] When the processing module determines that the mobile device is in an abnormal situation based on the safety signal, the processing module can communicate with the output module of the safety controller and send a control signal to the output module. After receiving the control signal, the output module can send a shutdown signal to the interface STO1 of each safety driver through the OUT1 interface, and send a shutdown signal to the interface STO2 of each safety driver through the OUT2 interface, so that the interface STO1 and the interface STO2 synchronously receive the shutdown signal, and transmit the received shutdown signal to the torque breaker, so that the torque breaker disconnects the power supply of the motor and the motor brake to which it is electrically connected, controls the motor to which it is electrically connected to stop and turns on the motor brake, that is, the torque breaker of the safety driver 1 simultaneously shuts off the power supply of the motor 1, the motor brake 1, the motor 2 and the motor brake 2, and synchronously controls the motor 1 and the motor 2 to stop and turn on the motor brake; the torque breaker of the safety driver 2 simultaneously shuts off the power supply of the motor 3, the motor brake 3, and the motor 4 and the motor brake 4, and synchronously controls the motor 3 and the motor 4 to stop and turn on the motor brake. Moreover, when receiving the shutdown signal, the safety driver can output a brake drive signal through the motor brake driver, and output a winding closing signal through the motor winding driver to close the motor winding and open the motor brake, that is, the safety driver 1 can close the winding of the motor 1 through the motor winding driver A, and open the motor brake 1 through the motor brake driver A, so that the motor 1 stops and the motor brake is opened; the safety driver 2 can close the winding of the motor 2 through the motor winding driver B, and open the motor brake 2 through the motor brake driver B, so that the motor 2 stops and the motor brake is opened; the safety driver 2 can close the winding of the motor 3 through the motor winding driver A, and open the motor brake 3 through the motor brake driver A, so that the motor 3 stops and the motor brake is opened; the safety driver 2 can close the winding of the motor 4 through the motor winding driver B, and open the motor brake 4 through the motor brake driver B, so that the motor 4 stops and the motor brake is opened.
[0284] Each motor can also be provided with two motor encoders, namely motor encoder 1 and motor encoder 2. Each motor encoder can detect the speed information of the motor and send the speed information to the safety driver. The safety driver can determine whether the speed of each motor is abnormal based on each encoder input, that is, safety driver 1 can determine whether the speed of motor 1 is abnormal based on encoder input A1 of motor encoder 1 of motor 1 and encoder input A2 of motor encoder 2; safety driver 1 can determine whether the speed of motor 2 is abnormal based on encoder input B1 of motor encoder 1 of motor 2 and encoder input B2 of motor encoder 2; safety driver 2 can determine whether the speed of motor 3 is abnormal based on encoder input A1 of motor encoder 1 of motor 3 and encoder input A2 of motor encoder 2; and safety driver 2 can determine whether the speed of motor 4 is abnormal based on encoder input B1 of motor encoder 1 of motor 4 and encoder input B2 of motor encoder 2.
[0285] The internal structure of the safety drive is as follows Fig.17 As shown, the safety driver includes shutdown signal interfaces STO1 and STO2, a power supply, a step-down module, a switch, a master controller, a slave controller, two communication paths communication 1 and communication 2 for communicating with the safety controller, brake drive A, winding drive A, brake drive B and winding drive B. Among them, the torque disconnector includes a switch and a controller. The master controller and the slave controller can receive the shutdown signal sent by the safety processor from STO1 and STO2 respectively, and communication 1 and communication 2 can receive the communication data sent by the safety controller respectively, the speed information of motor A sent by encoder A1 and encoder A2 of motor A, and the speed information of motor B sent by encoder B1 and encoder B2 of motor B, and verify the data received by themselves and the data received by another controller through interaction, and then make control decisions.
[0286] Specifically, after receiving the speed information, the safety driver can determine whether the mobile device is in an abnormal situation based on the speed information through the master controller and the slave controller. If the mobile device is in an abnormal situation, the motor can be controlled to stop and the motor brake can be turned on through the switch in the torque breaker, the motor brake drive, and the motor winding drive. In addition, after receiving the speed information, the safety driver can also send the speed information to the processing module of the safety processor through two communication channels, so that the processing module determines whether the mobile device is in an abnormal situation based on the speed information. If the processing module determines that the mobile device is in an abnormal situation, the processing module can send a control signal to the output module. Based on the control signal, the output module outputs a shutdown signal to the interface STO1 and the interface STO2 of each safety driver through OUT1 and OUT2, respectively, so that the torque breaker receives the shutdown signal, cuts off the power supply of the motor and the motor brake, controls the motor to stop, and turns on the motor brake.
[0287] In the solution provided by the embodiment of the present application, the motor safety control circuit can control the motor to stop and brake when the safety input device detects obstacles around the mobile device, or when the safety input device obtains an externally triggered stop command, or when the motor speed captured by the motor encoder is abnormal, so that the mobile device stops safely. In addition, when the mobile device is in an abnormal situation, the safety driver in the motor safety control circuit and the torque cut-off device in the safety controller can control the motor to stop and brake respectively through their own control methods, realizing the double insurance of motor braking and braking, and ensuring the success rate of controlling the motor to stop.
[0288] Corresponding to the above-mentioned motor safety control circuit, an embodiment of the present application further provides a motor safety control method. The following introduces a motor safety control method provided by an embodiment of the present application.
[0289] The motor safety control method provided in the embodiment of the present application can be applied to the torque breaker in the safety driver in the motor safety control circuit described in any of the above embodiments, wherein the motor is used to drive the mobile device to move; the mobile device includes a differential wheel set, and the two motors in the differential wheel set are respectively electrically connected to the torque breaker in the safety driver, and the motor brake electrically connected to each motor is respectively electrically connected to the torque breaker; the method includes:
[0290] Receive a shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop, and open the motor brake, wherein the shutdown signal is output by the safety controller in the motor safety control circuit to the torque breaker when the mobile device is in an abnormal situation.
[0291] The driving wheels in the differential wheel set of the mobile device are driven by two motors. When the device is to be stopped, the two motors in the differential wheel set need to be controlled at the same time to control the driving wheels driven by the two motors to stop. Based on this, the two motors are respectively connected to the torque cut-off device of the safety driver, and the motor brake electrically connected to each motor is respectively electrically connected to the torque cut-off device. In this way, when the safety controller in the motor safety control circuit detects that the mobile device is in an abnormal situation, it can send a shutdown signal to the torque cut-off device, and the torque cut-off device receives the shutdown signal, and controls the motor electrically connected to the torque cut-off device to stop and open the motor brake by disconnecting the power supply of the motor and the motor brake electrically connected to the torque cut-off device. In this way, the two motor brakes in the differential wheel set can be controlled simultaneously by a torque cut-off device, and the control efficiency is improved while controlling the safe parking of the mobile device.
[0292] For example, when the safety controller determines that the mobile device is in an abnormal situation based on the safety signal input by the safety input device, the safety controller may receive a shutdown signal to the torque breaker only, and the torque breaker may receive the shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop, and open the motor brake.
[0293] When the safety controller determines that the mobile device is in an abnormal situation based on the speed information input by the safety driver, the safety driver has determined whether the mobile device is in an abnormal situation based on the speed information while sending the speed information to the safety controller, and will control the motor to stop and open the motor brake when the mobile device is in an abnormal situation. In order to avoid the safety driver failing to control the motor in time due to a device failure, the safety controller can receive a shutdown signal to the torque breaker when it receives the speed information and determines that the mobile device is in an abnormal situation based on the speed information. The torque breaker can receive the shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop and open the motor brake.
[0294] In the solution provided by the embodiment of the present application, since the two motors of the differential wheel set in the mobile device and the motor brake electrically connected to each motor are electrically connected to the torque breaker, when the mobile device is in an abnormal situation, the two motors of the differential wheel set can be synchronously controlled to stop and the motor brake can be synchronously opened through the torque breaker, thereby controlling the driving wheels of the mobile device to stop moving by synchronously controlling each motor to stop and hold the brake, thereby controlling the mobile device to stop safely. In addition, the torque breaker can quickly respond to instantly control each motor to stop and open the motor brake, thereby improving the control efficiency of the mobile device.
[0295] Corresponding to the above-mentioned motor safety control circuit, an embodiment of the present application further provides a mobile device. The following is an introduction to a mobile device provided by an embodiment of the present application.
[0296] A mobile device comprises the motor safety control circuit described in any one of the above embodiments and at least one differential wheel set.
[0297] In the solution provided by the embodiment of the present application, since the two motors of the differential wheel set in the mobile device and the motor brake electrically connected to each motor are electrically connected to the torque breaker, when the mobile device is in an abnormal situation, the two motors of the differential wheel set can be synchronously controlled to stop and the motor brake can be synchronously opened through the torque breaker, thereby controlling the driving wheels of the mobile device to stop moving by synchronously controlling each motor to stop and hold the brake, thereby controlling the mobile device to stop safely. In addition, the torque breaker can quickly respond to instantly control each motor to stop and open the motor brake, thereby improving the control efficiency of the mobile device.
[0298] The mobile device may further include a processor, a communication interface and a memory, and the processor, the communication interface and the memory communicate with each other via a communication bus.
[0299] The communication bus mentioned in the above electronic device can be a Peripheral Component Interconnect (PCI) bus or an Extended Industry Standard Architecture (EISA) bus, etc. The communication bus can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, only one thick line is used in the figure, but it does not mean that there is only one bus or one type of bus.
[0300] The communication interface is used for communication between the above electronic device and other devices.
[0301] The memory may include a random access memory (RAM) or a non-volatile memory (NVM), such as at least one disk memory. Optionally, the memory may also be at least one storage device located away from the aforementioned processor.
[0302] The above-mentioned processor can be a general-purpose processor, including a central processing unit (CPU), a network processor (NP), etc.; it can also be a digital signal processor (DSP), an application specific integrated circuit (ASIC), a field programmable gate array (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components.
[0303] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0304] Each embodiment in this specification is described in a related manner, and the same or similar parts between the embodiments can be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the method and mobile device embodiments, since they are basically similar to the circuit embodiments, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiment.
[0305] The above description is only a preferred embodiment of the present application and is not intended to limit the protection scope of the present application. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application are included in the protection scope of the present application.
Claims
1. A motor safety control circuit, It is characterized in that The motor safety control circuit comprises a power supply, a safety controller, a safety driver and a motor, the motor is provided with a motor brake, and the safety driver is provided with a torque breaker, wherein: The safety driver is electrically connected to the power supply, the safety controller, the motor and the motor brake respectively; the motor is used to drive the mobile device to move; the mobile device includes a differential wheel set, two motors in the differential wheel set are electrically connected to the torque breaker respectively, and the motor brake electrically connected to each motor is electrically connected to the torque breaker respectively; The safety controller is used to output a shutoff signal to the torque breaker when the mobile device is in an abnormal situation; The torque breaker is used to receive a shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop, and open the motor brake.
2. The circuit according to claim 1, It is characterized in that The safety driver comprises a motor winding driver and a motor brake driver, wherein the motor winding driver is electrically connected to the motor, and the motor brake driver is electrically connected to the motor brake; The torque breaker is specifically used to turn off the power supply of the motor and the motor brake to which the torque breaker is electrically connected when receiving the shutdown signal sent by the safety controller; The safety driver is used to send a winding closing signal to the motor winding driver when receiving the shutdown signal, so that the motor winding driver closes the motor winding, and send a brake driving signal to the motor brake driver, so that the motor brake driver opens the motor brake.
3. The circuit according to claim 1, It is characterized in that The shutdown signal is I / O data.
4. The circuit according to claim 1, It is characterized in that The motor is also provided with a motor encoder, and the motor encoder is electrically connected to the safety driver; The motor encoder is used to detect speed information of the motor and send the speed information to the safety driver; The safety driver is specifically used to receive the speed information sent by the motor encoder, and when it is determined that the mobile device is in an abnormal situation based on the speed information, output a shutdown signal to the torque breaker, so that the torque breaker controls the motor electrically connected to the torque breaker to stop and turns on the motor brake of each motor; The safety driver is further used to send the speed information to the safety controller; The safety controller is further configured to receive the speed information and output a shutdown signal to the torque breaker when determining that the mobile device is in an abnormal condition based on the speed information; The torque breaker is also used to receive the shutdown signal sent by the safety controller, determine whether the motor electrically connected to the torque breaker has stopped and the motor brake is turned on; if not, control the motor electrically connected to the torque breaker to stop and turn on the motor brake.
5. The circuit according to any one of claims 1 to 4, It is characterized in that The mobile device comprises at least one differential wheel set, the number of the safety drives is the same as the number of the differential wheel sets, and the two motors in each differential wheel set are electrically connected to one safety drive.
6. The circuit according to claim 5, It is characterized in that The motor safety control circuit further comprises a safety input device, wherein the safety input device is electrically connected to the safety controller; The safety input device is used to send a safety signal to the safety controller when an obstacle is detected around the mobile device or a stop instruction triggered by an external trigger is obtained; The safety controller is specifically configured to receive the safety signal sent by the safety input device, and output a shutdown signal to the torque breaker when determining that the mobile device is in an abnormal situation based on the safety signal.
7. The circuit according to claim 5, It is characterized in that The torque breaker includes a high-side control switch, and the safety driver also includes a low-side control switch; The power supply is electrically connected to the motor via the high-side control switch, the low-side control switch is electrically connected to the motor, and the low-side control switch is grounded; The safety driver is specifically configured to disconnect the high-side control switch and / or close the low-side control switch to control the motor to stop when receiving a shutdown signal.
8. The circuit according to claim 5, It is characterized in that The power supply is electrically connected to the motor brake via the high-side control switch, the low-side control switch is electrically connected to the motor brake, and the low-side control switch is grounded; The safety driver is specifically configured to disconnect the high-side control switch and / or the low-side control switch and activate the motor brake when receiving a shutdown signal.
9. The circuit according to claim 5, It is characterized in that The safety driver includes a first master controller, a first slave controller, a first input interface, a second input interface, a high-side control switch, a motor winding drive, and a motor brake drive, wherein the first master controller and the second slave controller are electrically connected to the first input interface, the second input interface, the high-side control switch, the motor winding drive, and the motor brake drive, respectively, and the first master controller is electrically connected to the first slave controller; the torque breaker includes the first master controller, the first slave controller, and the high-side control switch; The first master controller is used to obtain the shutdown signal input by the safety controller through the first input interface and the second input interface, and determine whether the shutdown signal obtained through the first input interface is consistent with the shutdown signal obtained through the second input interface. If they are consistent, send the shutdown signal to the first slave controller; The first slave controller is used to obtain the shutdown signal input by the safety controller through the first input interface and the second input interface, and determine whether the shutdown signal obtained through the first input interface is consistent with the shutdown signal obtained through the second input interface. If they are consistent, send the shutdown signal to the first master controller; The first master controller is further configured to determine whether the shutdown signal obtained from the safety controller input is the same as the shutdown signal sent by the first slave controller, and if they are the same, output a disconnection instruction to the high-side control switch to disconnect the high-side control switch, so that the motor electrically connected to the high-side control switch stops and turns on the motor brake, output a winding closing signal to the motor winding drive to make the motor winding drive turn off the motor winding, and output a brake driving signal to the motor brake drive to make the motor brake drive turn on the motor brake; The first slave controller is further used to determine whether the shutdown signal obtained by the safety controller input is the same as the shutdown signal sent by the first master controller. If they are the same, the disconnection instruction, the winding closing signal and the brake drive signal output by the first master controller are obtained, and the disconnection instruction, the winding closing signal and the brake drive signal determined based on the obtained shutdown signal input by the safety controller and the shutdown signal sent by the first master controller are respectively consistent with the disconnection instruction, the winding closing signal and the brake drive signal obtained by the first master controller output. If there are inconsistent signals, an alarm signal is output to the high-side control switch, the motor winding drive and the motor brake drive, so that the high-side control switch shields the disconnection instruction output by the first master controller, the motor winding drive shields the winding closing signal output by the first master controller, and the motor brake drive shields the brake drive signal output by the first master controller.
10. The circuit according to claim 5, It is characterized in that The safety driver includes a first master controller, a first slave controller, a third input interface, a high-side control switch, a motor winding drive, and a motor brake drive, wherein the first master controller and the first slave controller are electrically connected to the third input interface, the high-side control switch, the motor winding drive, and the motor brake drive, respectively, and the first master controller and the first slave controller are electrically connected; the torque breaker includes the first master controller, the first slave controller, and the high-side control switch; The first master controller is configured to obtain speed information input externally through the third input interface, determine whether the mobile device is in an abnormal state based on the speed information, obtain a first determination result, and send the first determination result to the first slave controller; The first slave controller is configured to obtain speed information input externally through the third input interface, determine whether the mobile device is in an abnormal state based on the speed information, obtain a second determination result, and send the second determination result to the first master controller; The first main controller is further configured to determine whether the first determination result is the same as the second determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output a disconnection instruction to the high-side control switch to disconnect the high-side control switch, so that the motor electrically connected to the high-side control switch stops and turns on the motor brake, output a winding closing signal to the motor winding drive to cause the motor winding drive to close the motor winding, and output a brake driving signal to the motor brake drive to cause the motor brake drive to turn on the motor brake; The first slave controller is also used to determine whether the first judgment result is the same as the second judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, the disconnection instruction, the winding closing signal and the brake drive signal output by the first main controller are obtained, and the disconnection instruction, the winding closing signal and the brake drive signal determined based on the first judgment result and the second judgment result are respectively consistent with the disconnection instruction, the winding closing signal and the brake drive signal output by the first main controller. If they are inconsistent, an alarm signal is output to the high-side control switch, the motor winding drive and the motor brake drive, so that the high-side control switch shields the disconnection instruction output by the first main controller, the motor winding drive shields the winding closing signal output by the first main controller, and the motor brake drive shields the brake drive signal output by the first main controller.
11. The circuit according to claim 5, It is characterized in that The safety controller comprises an input module, a processing module and an output module, wherein the processing module is electrically connected to the input module, the safety driver and the output module respectively, and the output module is electrically connected to the safety driver; The input module is used to obtain an external input safety signal and send the safety signal to the processing module; The processing module is configured to receive the safety signal and the speed information sent by the safety driver, and send a control signal to the output module when it is determined that the mobile device is in an abnormal condition based on the safety signal or the speed information; The output module is used to receive the control signal sent by the processing module, and when it is determined that the control signal instructs the mobile device to stop, output a shutdown signal to the torque breaker, so that when the torque breaker receives the shutdown signal, it controls the motor electrically connected to the torque breaker to stop and turns on the motor brake.
12. The circuit according to claim 11, It is characterized in that The input module includes a second master controller, a second slave controller, a fourth input interface and a first output interface, the second master controller and the second slave controller are electrically connected to the fourth input interface and the first output interface respectively, and the second master controller is electrically connected to the second slave controller; The second master controller is used to obtain an external input safety signal through the fourth input interface, and send the safety signal to the second slave controller; The second slave controller is used to obtain an external input safety signal through the fourth input interface, and send the safety signal to the second master controller; The second master controller is further configured to determine whether the acquired external input safety signal is the same as the safety signal sent by the second slave controller; if they are the same, output the safety signal to the processing module through the first output interface; The second slave controller is also used to determine whether the acquired external input safety signal is the same as the safety signal sent by the second main controller; if they are the same, obtain the safety signal output by the second main controller, and determine whether the acquired external input safety signal is consistent with the acquired safety signal output by the second main controller; if they are inconsistent, output an alarm signal to the processing module through the first output interface, so that the processing module shields the safety signal output by the second main controller.
13. The circuit according to claim 11, It is characterized in that The processing module includes a third master controller, a third slave controller, a fifth input interface and a second output interface, the third master controller and the third slave controller are electrically connected to the fifth input interface and the second output interface respectively, and the third master controller is electrically connected to the third slave controller; The third master controller is configured to obtain the safety signal input by the input module through the fifth input interface, determine whether the mobile device is in an abnormal situation based on the safety signal, obtain a third determination result, and send the third determination result to the third slave controller; The third slave controller is configured to obtain the safety signal input by the input module through the fifth input interface, determine whether the mobile device is in an abnormal situation based on the safety signal, obtain a fourth determination result, and send the fourth determination result to the third master controller; The third main controller is further configured to determine whether the third determination result is the same as the fourth determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output a control signal to the output module through the second output interface; The third slave controller is also used to determine whether the third judgment result is the same as the fourth judgment result. If they are the same and the judgment result indicates that the mobile device is in an abnormal situation, the control signal output by the third main controller is obtained, and it is determined whether the control signal determined based on the third judgment result and the fourth judgment result is consistent with the control signal output by the obtained third main controller. If they are inconsistent, an alarm signal is output to the output module through the third output interface, so that the output module shields the control signal output by the third main controller.
14. The circuit according to claim 11, It is characterized in that The processing module includes a third master controller, a third slave controller, a sixth input interface, a seventh input interface and a second output interface, and the third master controller and the third slave controller are electrically connected to the sixth input interface, the seventh input interface and the second output interface respectively; The third master controller is used to obtain the speed information sent by the security driver through the sixth input interface and the seventh input interface, and determine whether the speed information obtained through the sixth input interface is consistent with the speed information obtained through the seventh input interface, and if they are consistent, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a fifth judgment result, and send the fifth judgment result to the third slave controller; The third slave controller is used to obtain the speed information sent by the security driver through the sixth input interface and the seventh input interface, and determine whether the speed information obtained through the sixth input interface is consistent with the speed information obtained through the seventh input interface. If they are consistent, determine whether the mobile device is in an abnormal situation based on the speed information, obtain a sixth judgment result, and send the sixth judgment result to the third master controller; The third main controller is further configured to determine whether the fifth determination result is the same as the sixth determination result, and if they are the same and the determination result indicates that the mobile device is in an abnormal situation, output the control signal to the output module through the second output interface; The third slave controller is further configured to determine whether the fifth determination result is the same as the sixth determination result; if they are the same and the determination result indicates that the mobile device is in an abnormal situation, obtain the control signal output by the third master controller, and determine whether the control signal determined based on the fifth determination result and the sixth determination result is consistent with the control signal output by the third master controller; If they are inconsistent, an alarm signal is output to the output module through the second output interface, so that the output module shields the control signal output by the third main controller.
15. The circuit according to claim 11, It is characterized in that The output module includes a fourth master controller, a fourth slave controller, an eighth input interface, a third output interface and a fourth output interface, the fourth master controller and the fourth slave controller are electrically connected to the eighth input interface, the third output interface and the fourth output interface respectively, the fourth master controller is electrically connected to the fourth slave controller; the third output interface and the fourth output interface are electrically connected to different torque breakers; The fourth master controller is used to obtain the control signal input by the processing module through the eighth input interface, and send the control signal to the fourth slave controller; The fourth slave controller is used to obtain the control signal input by the processing module through the seventh input interface, and send the control signal to the fourth master controller; The fourth main controller is further used to determine whether the control signal input by the processing module is the same as the control signal sent by the fourth slave controller; if they are the same, output a shutdown signal to the torque breaker through the third output interface and the fourth output interface respectively, so that the torque breaker controls the motor electrically connected to the torque breaker to stop and turn on the motor brake based on the shutdown signal; The fourth slave controller is further used to determine whether the control signal input by the processing module is the same as the control signal sent by the fourth master controller; if they are the same, obtain the shutdown signal output by the fourth master controller, and determine whether the shutdown signal output by the fourth master controller through the third output interface is consistent with the shutdown signal output through the fourth output interface, and whether the shutdown signal determined based on the control signal is consistent with the shutdown signal output by the fourth master controller; If there is inconsistency, an alarm signal is outputted through the third output interface and the fourth output interface respectively, so that the torque breaker shields the shutdown signal.
16. A motor safety control method, It is characterized in that The method is applied to a torque breaker in a safety driver in a motor safety control circuit according to any one of claims 1 to 15, wherein the motor is used to drive a mobile device to move; the mobile device comprises a differential wheel set, two motors in the differential wheel set are electrically connected to the torque breaker respectively, and a motor brake electrically connected to each motor is electrically connected to the torque breaker respectively; the method comprises: Receive a shutdown signal input by the safety controller, control the motor electrically connected to the torque breaker to stop, and open the motor brake, wherein the shutdown signal is output by the safety controller in the motor safety control circuit to the torque breaker when the mobile device is in an abnormal situation.
17. A mobile device, It is characterized in that The mobile device comprises the motor safety control circuit according to any one of claims 1 to 15 and at least one differential wheel set.
Citation Information
Cited By
Motor safety control circuit, motor safety control method, and moving apparatus
WO2026037166A1
