A control circuit and control method
The control circuit, composed of signal conversion circuit, delay circuit, and mode selection circuit, solves the problem of high cost of AMR safety controller, realizes safety protection control that matches the robot's performance level, reduces costs and improves safety.
Patent Information
- Application Number
- CN202311458807.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-11-03
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2043-11-03
AI Technical Summary
In the existing technology, the cost of deploying safety controllers for autonomous mobile robots (AMRs) is high, and the performance level of the safety controllers is higher than that of the robot itself, which affects the safety protection effect.
It employs signal conversion circuits, delay circuits, mode selection circuits, and monitoring circuits to provide safety protection and control at the same level as the robot's performance level, including signal conversion, delay processing, and logical AND operations to achieve safe stopping.
It reduces the cost of safety controllers while providing safety protection controls that match the robot's performance level, thus improving safety and control efficiency.
Smart Images

Figure CN117706972B_ABST
Abstract
Description
Technical Field
[0001] This application relates to the field of automatic control technology, and in particular to a control circuit and control method. Background Technology
[0002] Before mechanical equipment is put into use, a risk assessment can be conducted in accordance with mechanical safety standards to determine the risk level and corresponding performance level (PL) of the mechanical equipment. After that, safety components with matching performance levels can be deployed in the mechanical equipment.
[0003] Autonomous Mobile Robots (AMRs) (hereinafter referred to as "robots") are widely used in various fields, such as smart warehousing. Robot control includes safe stop control. Robot stops are categorized into the following three types:
[0004] Stop type 0: Direct power cut-off and mechanical brake engagement;
[0005] Stop type 1: The electronic braking machine stops (speed is monitored during the process), then the power is cut off and the mechanical brake is engaged;
[0006] Stop type 2: Electronic braking stops the machine at zero speed. If the speed exceeds the threshold, power is cut off and mechanical brakes are engaged.
[0007] For stop type 1, safety protection and control are implemented on the robot by deploying safety controllers. However, deploying safety controllers on the robot is costly. Furthermore, the robot's performance level may be, for example, level one, while the performance level of the safety controller and other control components may be, for example, level two, which affects the effectiveness of the robot's safety protection. Summary of the Invention
[0008] This application provides a control circuit and control method. Through a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit, it provides a safety protection control mechanism at the same performance level as the robot. This not only provides control matching the robot's performance level but also reduces costs. Specifically, this application discloses the following technical solutions:
[0009] In a first aspect, embodiments of this application provide a control circuit for performing safety protection control on a robot. The control circuit includes: a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit; the signal conversion circuit is a circuit representing a safety performance level, and the target safety performance level is the safety performance level of the robot; wherein...
[0010] The signal conversion circuit is used to convert the input protection stop signal into an initial safety signal that conforms to the safety performance level, and to output the initial safety signal to the delay circuit; the initial safety signal includes a first level signal and a second level signal; the first level signal is used to maintain the normal operation of the robot; the second level signal is used to trigger a safe stop of the robot;
[0011] The delay circuit is used to directly transmit the first level signal to the mode selection circuit, and to transmit the second level signal to the mode selection circuit after delaying for a preset delay time.
[0012] The mode selection circuit is used to perform a logical AND operation on the signal output by the delay circuit, the robot's emergency stop switch signal, and the enable switch signal when the automatic mode is selected according to the input mode selection signal; when the delay circuit outputs the second level signal or the emergency stop switch signal is the second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop.
[0013] The monitoring circuit is used to monitor the initial protection stop signal, the mode selection signal, and the emergency stop switch signal, and when the initial protection stop signal is the second level signal, to transmit the monitoring results to the robot controller so that the robot controller triggers the motion control component to control the robot to achieve a safe stop.
[0014] In conjunction with the first aspect, in one possible implementation of the first aspect, the delay circuit includes a first delay circuit and a second delay circuit;
[0015] The signal conversion circuit is used to output the initial safety signal to the first delay circuit and the second delay circuit respectively;
[0016] Wherein, the initial safety signal output by the signal conversion circuit to the first delay circuit is the first initial safety signal; the initial safety signal output by the signal conversion circuit to the second delay circuit is the second initial safety signal.
[0017] In conjunction with the first aspect, in one possible implementation of the first aspect, the control circuit further includes a manual operator signal interface for receiving a mode selection signal;
[0018] The mode selection circuit is used to switch the control mode of the control circuit to the manual mode in response to the mode selection signal.
[0019] The mode selection circuit is also used to switch the control mode of the control circuit to the automatic mode in response to the enable switch signal in the manual mode.
[0020] In conjunction with the first aspect, in one possible implementation of the first aspect, the mode selection circuit includes a first mode selection circuit and a second mode selection circuit, wherein,
[0021] The first delay circuit is used to output the first level signal of the first initial security signal to the first mode selection circuit and the second mode selection circuit respectively, and to output the second level signal of the first initial security signal to the first mode selection circuit and the second mode selection circuit respectively after delaying it according to the preset delay time.
[0022] The second delay circuit is used to output the first level signal of the second initial security signal to the first mode selection circuit and the second mode selection circuit respectively, and to output the second level signal of the second initial security signal to the first mode selection circuit and the second mode selection circuit respectively after delaying it according to the preset delay time.
[0023] In conjunction with the first aspect, in one possible implementation of the first aspect, when the first mode selection circuit selects the automatic mode, the output of the first delay circuit is connected in series with the robot's first emergency stop switch input and the output of the second delay circuit, so as to perform a logical AND operation between the delayed signal of the first delay circuit and the first emergency stop switch signal and the delayed signal of the second delay circuit, and output the logical AND operation signal to the motion control component; when the first mode selection circuit selects the manual mode, the output of the first delay circuit is bypassed, and the first level signal is continuously output to the motion control component;
[0024] When the second mode selection circuit selects the automatic mode, the output of the second delay circuit is connected in series with the robot's second emergency stop switch input and the output of the first delay circuit. This allows the signal delayed by the second delay circuit to be logically ANDed with the second emergency stop switch signal and the signal delayed by the first delay circuit, and the result of the logically ANDed signal is output to the motion control component. When the second mode selection circuit selects the manual mode, the output of the second delay circuit is bypassed, and the first level signal is continuously output to the motion control component.
[0025] In conjunction with the first aspect, in one possible implementation of the first aspect, the motion control components of the robot include a first drive circuit, a second drive circuit, a first motor, and a second motor; wherein,
[0026] The first drive circuit is used to respond to the first level signal and maintain the operation of the first motor to maintain the normal operation of the robot; the second drive circuit is used to respond to the first level signal and maintain the operation of the second motor to maintain the normal operation of the robot.
[0027] The first drive circuit is also used to respond to the delayed second level signal, trigger the safety torque shutdown of the first motor, and trigger the mechanical brake of the first motor to trigger the robot to achieve a safe stop;
[0028] The second drive circuit is also used to respond to the delayed second level signal, trigger the safety torque shutdown of the second motor, and trigger the mechanical brake of the second motor to trigger the robot to achieve a safe stop.
[0029] In conjunction with the first aspect, in one possible implementation of the first aspect, the first level signal is a high level signal; the second level signal is a low level signal.
[0030] Secondly, embodiments of this application provide a control method for controlling a circuit, the method comprising:
[0031] The input protection stop signal is converted into an initial safety signal that conforms to the target safety performance level; the target safety performance level is the safety performance level of the controlled robot, and the initial safety signal includes a first level signal and a second level signal;
[0032] When the control circuit is in automatic mode, the initial safety signal is processed, and the processing includes: when the initial safety signal is the second level signal, delaying the second level signal according to a preset delay duration;
[0033] The processed signals, the robot's emergency stop switch signal, and the enable switch signal are subjected to a logical AND operation.
[0034] The robot's behavior is controlled based on the logic and the processed results.
[0035] The control circuit provided in this application embodiment includes a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit. The signal conversion circuit converts the input protection stop signal into an initial safety signal conforming to the stated safety performance level. The first level signal of the initial safety signal is used to maintain the normal operation of the robot, and the second level signal is used to trigger a safe stop for the robot, thereby providing a safety signal of the same level as the robot's performance level. The initial safety signal is output to the delay circuit, which directly transmits the first level signal to the mode selection circuit and delays the second level signal for a preset delay period before transmitting it to the mode selection circuit. The mode selection circuit, when selecting an automatic mode based on the input mode selection signal, performs a logical AND operation on the signal output from the delay circuit, the robot's emergency stop switch signal, and the enable switch signal. When the delay circuit outputs the second level signal or the emergency stop switch signal is the second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop. Furthermore, the monitoring circuit is used to monitor the initial protection stop signal, the mode selection signal, and the emergency stop switch signal. When the initial protection stop signal is the second level signal, the monitoring result is transmitted to the robot controller, so that the robot controller can control the robot to achieve a safe stop via the motion control component. Therefore, this technical solution, by using a circuit that meets the target safety performance level instead of the safety controller and other components in the prior art, helps to reduce costs and provides the robot with control that matches the performance level (i.e., the target performance level). Attached Figure Description
[0036] To more clearly illustrate the technical solutions of the embodiments of this application, the drawings used in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the embodiments of this application. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.
[0037] Figure 1A This is a schematic diagram of the structure of an exemplary control circuit provided in an embodiment of this application;
[0038] Figure 1B A detailed structural schematic diagram of an exemplary control circuit provided in an embodiment of this application;
[0039] Figure 1C Provided for the embodiments of this application Figure 1B A schematic diagram of the structure of the middle circuit 14;
[0040] Figure 1DProvided for the embodiments of this application Figure 1C Detailed structural diagram;
[0041] Figure 2 This is a flowchart illustrating an exemplary control method provided in an embodiment of this application. Detailed Implementation
[0042] To enable those skilled in the art to better understand the technical solutions in the embodiments of this application, and to make the above-mentioned objectives, features and advantages of the embodiments of this application more apparent and understandable, the technical solutions in the embodiments of this application will be further described in detail below with reference to the accompanying drawings.
[0043] While exemplary embodiments of the present application are shown in the accompanying drawings, it should be understood that the embodiments of the present application can be implemented in various forms and should not be limited to the embodiments set forth herein. Rather, these embodiments are provided to enable a more thorough understanding of the embodiments of the present application and to fully convey the scope of the embodiments of the present application to those skilled in the art.
[0044] It should be noted that, unless otherwise stated, the technical or scientific terms used in the embodiments of this application should have the ordinary meaning understood by those skilled in the art to which the embodiments of this application pertain.
[0045] The relevant technologies involved in the embodiments of this application will be described below first.
[0046] Risk assessment of equipment according to mechanical safety standards can refer to evaluating the average hourly probability of hazardous failure. Generally, based on the risk assessment results, equipment is classified into five performance levels (PLs), from lowest to highest: PLA, PLb, PLc, PLd, and PLe. PLA is the lowest PL, with the highest average hourly probability of hazardous failure and the worst safety. PLe is the highest PL, with the lowest average hourly probability of hazardous failure and the best safety.
[0047] For example, a robot used in a smart warehousing scenario might have a PL (Plus Level) of PLd. During use, the robot's behavior can be controlled according to the needs of the scenario, such as stopping the robot. The corresponding control device should be a PLd-level safety control device. In some embodiments, the control device is deployed within the robot system, and the control mechanism conforming to a certain PL includes safety controllers and safety lidar, or safety controllers and safety encoders. This not only increases the cost of the control components, but also results in a waste of resources because the control mechanism composed of safety controllers and safety encoders has a PL of PLe, which is higher than the robot's PLd level.
[0048] According to the background technology of this application, the stop type corresponding to this application is stop type 1. The control process of stop type 1 includes: within a preset delay time, the robot controller sends a stop command to the driver to realize the electronic braking of the robot to a speed of 0. After the delay time is reached, a safe torque off (STO) signal is output to the driver, and the safe torque off (i.e., motor power off) is combined with mechanical brake braking.
[0049] In view of this, embodiments of this application provide a control circuit, which includes a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit. The signal conversion circuit is used to convert an input protection stop signal into an initial safety signal conforming to the stated safety performance level, and to output the initial safety signal to the delay circuit. A first-level signal of the initial safety signal is used to maintain the normal operation of the robot, and a second-level signal is used to trigger a safe stop for the robot. The delay circuit is used to directly transmit the first level signal to the mode selection circuit, and to delay the second level signal for a preset delay period before transmitting it to the mode selection circuit. The mode selection circuit, when selecting an automatic mode based on the input mode selection signal, performs a logical AND operation on the signal output by the delay circuit, the robot's emergency stop switch signal, and the enable switch signal. When the delay circuit outputs the second level signal or the emergency stop switch signal is the second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop. The monitoring circuit is used to monitor the initial protection stop signal, the mode selection signal, and the emergency stop switch signal. When the initial protection stop signal is the second level signal, it transmits the monitoring result to the robot controller, so that the robot controller can control the motion control component to control the robot to achieve a safe stop. Therefore, this technical solution uses circuit components that meet the target safety performance level to replace the safety control components composed of the safety controller and other devices in the prior art, which helps reduce costs and can provide the robot with control that matches the performance level (i.e., the target performance level).
[0050] The following is in conjunction with the appendix Figures 1A to 1D The control circuit of the embodiments of this application will be described exemplarily.
[0051] like Figure 1AAs shown, an exemplary control circuit according to an embodiment of this application may include: a signal conversion circuit 10, a delay circuit 11, a mode selection circuit 12, and a monitoring circuit 13. The signal conversion circuit 10 is a circuit for determining the target safety performance level, which is the safety performance level of the robot. The robot involved here is the robot controlled by this control circuit.
[0052] The signal conversion circuit 10 is used to convert the input signal into an initial safety signal that meets the target safety performance level, and to output the initial safety signal to the delay circuit 11.
[0053] In some embodiments, the signal input to the signal conversion circuit 10 may come from the robot's control platform.
[0054] For example, the target safety performance level is, for instance, the PLd level. Accordingly, the signal conversion circuit 10 can be implemented, for example, as a PLd safety I / O module. The initial safety signal is a safety signal conforming to the PLd level.
[0055] In some embodiments, the initial safety signal includes a first-level signal and a second-level signal. The first-level signal can be used to trigger control of the robot's behavior; the second-level signal can be used to trigger a safe stop of the robot. In practical implementation scenarios, the first signal of the initial safety signal can be the first-level signal.
[0056] For example, the initial safety signal may be a digital output (DO) signal, the first level signal may be a high level signal of the DO signal, and the second level signal may be a low level signal of the DO signal.
[0057] The delay circuit 11 can be used to directly transmit the first level signal to the mode selection circuit 12; the delay circuit 11 can also be used to delay the second level signal according to a preset delay duration, and output the delayed second level signal to the mode selection circuit 12.
[0058] In this technical scenario, the robot requires a certain execution time from responding to a control command to reaching the target state corresponding to that command. For example, taking controlling the robot to a safe stop as an example, the robot needs a certain execution time from responding to a protection stop signal to decelerating to zero. In some embodiments, the preset delay duration can be manually set via a DIP switch based on the robot's motion performance. For example, the preset delay duration is 9 seconds.
[0059] In this example, a low-level signal triggers the protection stop control. The delay circuit 11 can be used to directly output a high-level signal from the DO signal to trigger the robot to begin the stop operation. Upon receiving a low-level signal from the DO signal, the delay circuit 11 does not output the low-level signal but continuously outputs a high-level signal to achieve a preset delay duration (e.g., 9 seconds). This embodiment refers to this process as a delay of the low-level signal. After the delay reaches 9 seconds, the delay circuit 11 can output a low-level signal.
[0060] The mode selection circuit 12 is used to perform a logical AND operation on the signal output by the delay circuit 11, the robot's emergency stop switch signal, and the enable switch signal when the automatic mode is selected according to the input mode selection signal; when the delay circuit 11 outputs a second level signal or the emergency stop switch signal is a second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop.
[0061] It should be noted that during the delay period of the second level signal, the delay circuit 11 can continuously output the first level signal to the mode selection circuit 12 so that the motion control component can continuously control the robot within the preset delay time.
[0062] Furthermore, when manual mode is selected based on the input mode selection signal, the signals from delay circuit 11 to mode selection circuit 12 are bypassed. Only when the emergency stop switch signal is at the second level is a safe stop signal output to the robot's motion control unit to trigger the motion control unit to control the robot to achieve a safe stop.
[0063] The monitoring circuit 13 is used to transmit the monitoring result to the robot controller when it detects the second-level signal of the initial protection stop signal output by the signal conversion circuit 10, so that the robot controller can trigger the motion control component to control the robot to achieve a safe stop. The monitoring circuit 13 can also be used to monitor the mode selection signal and the emergency stop switch signal.
[0064] As can be seen, by adopting this implementation method, a control circuit formed by circuit components that meet the target safety performance level is used to replace the safety controller and other components in the existing technology. This can provide the robot with control that matches the performance level (i.e., the target performance level) and can reduce costs.
[0065] See Figure 1B , Figure 1AThe delay circuit 11 and mode selection circuit 12, as illustrated in the diagram, together form circuit 14. Circuit 14 may include a first hardware circuit 141 and a second hardware circuit 142. In this example, the signal conversion circuit 10 can be used to output an initial safety signal to the first hardware circuit 141 and the second hardware circuit 142, respectively.
[0066] The initial security signal output by the signal conversion circuit 10 to the first hardware circuit 141 is the first initial security signal (e.g., Figure 1B The initial security signal output by the signal conversion circuit 10 to the second hardware circuit 142 is the second initial security signal (e.g., DO1 shown). Figure 1B (DO2 shown).
[0067] It should be understood that the first initial security signal and the second initial security signal are identical signals transmitted through different transmission channels. Under normal operating conditions during the transmission of the first and second initial security signals, the first and second initial security signals should be identical. Thus, in this embodiment, the method of transmitting signals through two transmission channels allows for cross-verification of whether the signals from the two channels are identical, thereby verifying whether any security risks exist during signal transmission.
[0068] Furthermore, the robot's motion control components may include a first drive circuit 21 and a second drive circuit 22. The first hardware circuit 141 can be used to output a first-level signal of the first initial safety signal to the STO1 (Safety torque off) of the first drive circuit 21 and the STO1 of the second drive circuit 22, respectively, and to output a second-level signal of the first initial safety signal to the STO1 of the first drive circuit 21 and the STO1 of the second drive circuit 22, respectively, after a preset delay. The second hardware circuit 142 can be used to output a first-level signal of the second initial safety signal to the STO2 of the first drive circuit 21 and the STO2 of the second drive circuit 22, respectively, and to output a second-level signal of the second initial safety signal to the STO2 of the first drive circuit 21 and the STO2 of the second drive circuit 22, respectively, after a preset delay.
[0069] For ease of distinction, the signal output by the first hardware circuit 141 is represented by DO1_delay; the signal output by the second hardware circuit 142 is represented by DO2_delay.
[0070] In this way, if either the first hardware circuit 141 or the second hardware circuit 142 fails, the control circuit of this embodiment can still perform safety protection control on the robot through another delay circuit, which is beneficial to further improve safety.
[0071] See you again Figure 1B In some implementations, the robot's motion control components may further include a robot controller 23, a first motor 26, and a second motor 27. The robot controller 23 receives monitoring results from the monitoring circuit 13 (in this embodiment, the monitoring circuit 13 is used as the first processor) and sends signals to the first drive circuit 21 and the second drive circuit 22. Exemplarily, both the first drive circuit 21 and the second drive circuit 22 can be used to respond to a first-level signal to trigger the robot controller to control the robot to a safe stop. The first drive circuit 21 is also used to respond to a delayed second-level signal to trigger the safety torque shutdown of the first motor 26 and to trigger mechanical braking of the first motor 26; the second drive circuit 22 is also used to respond to a delayed second-level signal to trigger braking of the second motor 27 and to trigger mechanical braking of the first motor 27. This process constitutes the process of controlling the robot to a safe stop.
[0072] For example, the robot controller 23 can communicate with other circuits via a controller area network (CAN) bus. For instance, the robot controller 23 communicates with the first drive circuit 21 and the second drive circuit 22 via CAN, controlling both the first drive circuit 21 and the second drive circuit 22.
[0073] The first hardware circuit 141 can be connected to the robot's first emergency stop switch contact 24, and is used to perform a logical AND operation between the second level signal of the first hardware circuit 141 after a delay and the first emergency stop control signal ES1 (emergency stop) triggered by the first emergency stop switch contact 24; the second hardware circuit 142 is connected to the robot's second emergency stop switch contact 25, and is used to perform a logical AND operation between the second level signal of the second hardware circuit 142 after a delay and the second emergency stop control signal ES2 triggered by the second emergency stop switch contact 25.
[0074] Since both the emergency stop control signal and the safety stop signal are used to trigger the robot to stop, this simplifies the circuit structure.
[0075] like Figure 1BThe first hardware circuit 141 and the second hardware circuit 142 can also receive control from the second processor. The second processor generates mode selection signals and enable switch signals on the manual operator via a manual operation access interface. The first mode selection signal MAN1 is output to the first hardware circuit 141, and the second mode selection signal MAN2 is output to the second hardware circuit 142. When the mode selection signal is a first level signal (i.e., high level), it switches to manual mode; in manual mode, when the mode selection signal is a second level signal (i.e., low level), it switches to automatic mode. In automatic mode, the control delay circuit 11 normally transmits the protection stop signal; in manual mode, the control delay circuit 11 is bypassed, and only the emergency stop switch signal and the enable switch signal play a control role. When both emergency stop switch signals ES1 and ES2 are first level signals (i.e., high level), enable switch 1 controls enable control signal 1 (EN-C1) and enable signal 1 (EN-NO1) contacts to connect, and enable switch 2 controls EN-C2 and EN-NO2 contacts to connect. DO1_delay and DO2_delay output first level signals (i.e., high level). Robot controller 23 can control the first drive 21 and the second drive 22, which will trigger the first motor 26 and the second motor 27 to operate accordingly.
[0076] As can be seen, the monitoring results output by the monitoring circuit to the robot controller can be implemented as at least one of DO1, DO2, ES1, ES2, MAN1, and MAN2. The specific content of the monitoring results can be implemented as different signals depending on the different scenarios.
[0077] In this way, the control circuit can support switching between two modes by providing an access interface for a manual operator, thereby providing operational space for personnel to intervene in maintenance.
[0078] Figure 1C , Figure 1C yes Figure 1B The schematic diagram of the circuit 14 includes a first power supply (power1) 1411 and a second power supply (power2) 1421. Among them, power1 1411 is used to supply power to the first delay circuit 1412; power2 1421 is used to supply power to the second delay circuit 1422.
[0079] In this technical solution, power1 1411 and power2 1421 are set to supply power to two delay circuits respectively. In the event of a failure of either power supply, the other power supply can still supply power to the corresponding delay circuit to maintain the processing and transmission of the safety stop signal, thereby maintaining the safe control of the robot and helping to achieve the PLD level.
[0080] The delay protection stop signal output by the first delay circuit 1412 is sent to the first mode selection circuit 1413, which outputs DO1_delay; the delay protection stop signal output by the second delay circuit 1422 is sent to the second mode selection circuit 1423, which outputs DO2_delay. In this example, the process of the first mode selection circuit 1413 and the second mode selection circuit 1423 performing logical AND operations on the received signals is detailed in other embodiments of this specification and will not be repeated here.
[0081] The control circuit of the present application embodiment is described below with reference to examples.
[0082] Figure 1D An exemplary schematic diagram of a control circuit is shown. This control circuit includes, for example, a PLd safe IO module, a first power supply 1411 and a second power supply 1421, a first delay circuit 1412 and a second delay circuit 1422, a first mode selection circuit 1413 and a second mode selection circuit 1423. The first mode selection circuit 1413 may include a protection stop signal gating circuit 1, a series circuit 1, and an enable signal control circuit 1; the second mode selection circuit 1423 may include a protection stop signal gating circuit 2, a series circuit 2, and an enable signal control circuit 2.
[0083] It should be understood that Figure 1D This is a schematic description of the control circuit and does not constitute a limitation on the control circuit of the embodiments of this application. In some other embodiments, the control circuit of the embodiments of this application may include more or fewer circuit modules. In other embodiments, some circuit modules in the control circuit may be split into two circuit modules, or some circuit modules may be combined into one circuit module. No limitations are imposed here.
[0084] See you again Figure 1D The first power supply 1411 supplies power to the first delay circuit 1412, and the second power supply 1421 supplies power to the second delay circuit 1422. Both the first power supply 1411 and the second power supply 1421 are, for example, 5 volts (V) power supplies. The first power supply 1411 transforms a 24V power supply to 5V using a DC / DC transformer (DC / DC 1) to power the first delay circuit 1412. The second power supply 1421 transforms a 24V power supply to 5V using a DC / DC transformer (DC / DC 2) to power the second delay circuit 1422.
[0085] It should be noted that power supply protection circuits can be included in both the first power supply 1411 and the second power supply 1421 circuits. Figure 1D(Part of power supply 2 is not shown) to protect the corresponding power supply circuit.
[0086] After receiving a signal from the remote control platform via the CIP Safety Black channel based on the Common Industrial Protocol (CIP), the PLd safety I / O module converts the signal into a DO signal conforming to the PLd level, and outputs a DO1 signal to the first delay circuit 1412 and a DO2 signal to the second delay circuit 1422. The DO1 and DO2 signals have the same voltage level. For example, the first signal of DO1 and DO2 can be a high-level signal.
[0087] After receiving the DO1 signal, the first delay circuit 1412 can directly output a high-level signal of the DO1 signal to the series circuit 1 via the protection stop signal gating circuit 1. For the low-level signal of the DO1 signal, a delay is applied (i.e., no output) until the delay duration reaches a preset duration before outputting to the protection stop signal gating circuit 1. In this embodiment, the output signal of the first delay circuit 1412 is referred to as OUT1, and the signal output by the protection stop signal gating circuit 1 is referred to as DO1 delayed signal 1 (DO1_DELAY_1). Similarly, after receiving the DO2 signal, the second delay circuit 1422 can directly output a high-level signal of the DO2 signal to the series circuit 2 via the protection stop signal gating circuit 2. For the low-level signal of the DO2 signal, a delay is applied (i.e., no output) until the delay duration reaches a preset duration before outputting to the protection stop signal gating circuit 2. In this embodiment, the output signal of the second delay circuit 1422 is called OUT2, and the signal output by the protection stop signal gating circuit 2 is called DO2 delay signal 1 (DO2_DELAY_1).
[0088] In series circuit 1, DO1_DELAY_1, DO2_DELAY_1, and the first emergency stop switch signal ES1 can be connected in series via a logical AND operation. Thus, when any one of these three signals is low, the output EN-C1 of series circuit 1 is low. In automatic mode, EN-C1 controls the contacts of circuit 1 to close via the enable signal, resulting in a low-level output EN-NO1. At this time, the signal output by EN-NO1 can be used as DO1_delay. That is, DO1_delay is low. When DO1_delay is low, both the first and second drive circuits will safely stop.
[0089] Correspondingly, in series circuit 2, DO2_DELAY_1, DO1_DELAY_1, and the second emergency stop switch signal ES2 can be connected in series via a logical AND operation. Thus, when any one of these three signals is low, the output EN-C2 of the series circuit will also be low. Similarly, in automatic mode, EN-C2 controls the contact of circuit 2 to be turned on, and the output EN-NO2 is also low. At this time, the signal output by EN-NO2 can be used as DO2_delay. That is, DO2_delay is low. When DO2_delay is low, both the first and second drive circuits will safely stop.
[0090] It should be noted that the protection stop signal gating circuit 1 is controlled by the first mode selection signal MAN1, and the protection stop signal gating circuit 2 is controlled by the second mode selection signal MAN2.
[0091] When the manual manipulator is connected to the robot, the control circuit is in manual mode, and MAN1 and MAN2 can be at a high level. Furthermore, in manual mode, the OUT1 signal is bypassed, and the output DO1_DELAY_1 of the protection stop signal gating circuit 1 remains high; the OUT2 signal is bypassed, and the output DO2_DELAY_1 of the protection stop signal gating circuit 2 remains high. Simultaneously, the enable signal control circuit 1 disconnects the existing contacts between EN-C1 and EN-NO1. EN-C1 and EN-NO1 are controlled by the enable switch of the manual manipulator. When the enable switch is pressed, EN-C1 and EN-NO1 are connected via enable signal control circuit 1, and DO1_delay can output a low-level signal; when the enable switch is released, EN-C1 and EN-NO1 are disconnected, and simultaneously, the enable signal control circuit 2 disconnects the existing contacts between EN-C2 and EN-NO2. Similarly, EN-C2 and EN-NO2 are controlled by the enable switch of the manual operator. When the enable switch is pressed, EN-C1 and EN-NO1 are turned on through the enable signal control circuit 1, and DO2_delay can output a low-level signal.
[0092] When the manual operator is disconnected from the robot, and MAN1 and MAN2 are low, the control circuit switches to automatic mode. In automatic mode, the robot is controlled by the remote scheduling system. At this time, the output DO1_DELAY_1 of the protection stop signal gating circuit 1 is directly connected to the OUT1 signal, and the output DO2_DELAY_1 of the protection stop signal gating circuit 2 is directly connected to the OUT2 signal. Enable signal control circuit 1 controls EN-C1 and EN-NO1 to be directly connected, while enable signal control circuit 2 controls EN-C2 and EN-NO2 to be directly connected.
[0093] Figure 1D The triggering of various signals on the robot and the robot's response process can be found in the descriptions of other embodiments, and will not be repeated here.
[0094] The control circuit provided in this application embodiment includes a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit. The signal conversion circuit converts the input protection stop signal into an initial safety signal conforming to the stated safety performance level. The first level signal of the initial safety signal is used to maintain the normal operation of the robot, and the second level signal is used to trigger a safe stop for the robot, thereby providing a safety signal of the same level as the robot's performance level. The initial safety signal is output to the delay circuit, which directly transmits the first level signal to the mode selection circuit and delays the second level signal for a preset delay period before transmitting it to the mode selection circuit. The mode selection circuit, when selecting an automatic mode based on the input mode selection signal, performs a logical AND operation on the signal output from the delay circuit, the robot's emergency stop switch signal, and the enable switch signal. When the delay circuit outputs the second level signal or the emergency stop switch signal is the second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop. Furthermore, the monitoring circuit is used to monitor the initial protection stop signal, the mode selection signal, and the emergency stop switch signal. When the initial protection stop signal is the second level signal, the monitoring result is transmitted to the robot controller, so that the robot controller can control the robot to achieve a safe stop via the motion control component. Therefore, this technical solution, by using a circuit that meets the target safety performance level instead of the safety controller and other components in the prior art, helps to reduce costs and provides the robot with control that matches the performance level (i.e., the target performance level).
[0095] Corresponding to the control circuit of the embodiments of this application, the embodiments of this application also provide a control method.
[0096] An exemplary control method provided in this application embodiment is as follows: Figure 2 As shown, this control method is applied to a control circuit, which can be, for example, as follows: Figures 1A to 1D As shown in any of the embodiments. The control method includes the following steps:
[0097] Step S101: Convert the input protection stop signal into an initial safety signal that conforms to the target safety performance level. The initial safety signal includes a first level signal and a second level signal.
[0098] Here, the target safety performance level is the safety performance level of the controlled robot, such as the PLd level. If the initial safety signal conforms to the target safety performance level, then in this example, the initial safety signal is, for example, a PLd level signal.
[0099] For example, the initial safety signal can be a DO signal, the first level signal can be a high level signal, and the second level signal can be a low level signal. In actual implementation scenarios, the first signal of the initial safety signal can be a high level signal.
[0100] It should be noted that the control circuit can be deployed on the robot, and the signals received by the control circuit can originate from the robot's control platform. In one embodiment, the robot can operate within a pre-defined operating area, where a control platform is correspondingly located to control the robot operating within that area. For example, the control platform can generate a source signal in response to a user trigger and transmit this source signal to the robot's slave control module via a wireless network. The robot's slave control module then transmits the source signal to the signal conversion circuit of the control circuit. The slave control module can transmit the source signal to the signal conversion circuit via an Ethernet Industrial Protocol (EIP) module.
[0101] Since the control platform is not considered production machinery, it does not require risk assessment. Therefore, the source signals generated by the control platform do not meet any safety performance level. Based on this, the source signals (i.e., the signals received by the control circuit) must be converted by a signal conversion circuit into signals of the target safety performance level (i.e., the initial safety signal) before they can be used to trigger the robot to perform corresponding operations.
[0102] Step S102: When the control circuit is in automatic mode, the initial safety signal is processed. The processing includes: when the initial safety signal is a second level signal, the second level signal is delayed according to a preset delay duration.
[0103] Furthermore, in response to a received command to switch to manual mode, a first-level signal is continuously output. In response to a received enable signal, the system can switch from manual mode to automatic mode to output a second-level signal.
[0104] Step S103: Perform a logical AND operation on the processed signal, the robot's emergency stop switch signal, and the enable switch signal.
[0105] Step S104: Control the robot's behavior based on the logical AND processing result.
[0106] For example, controlling the robot's behavior based on the result of logical AND processing includes: controlling the robot to stop safely if the signal after logical AND processing is a first-level signal; and driving the robot's motor brake in response to the delayed second-level signal if the signal after logical AND processing is a second-level signal.
[0107] It should be noted that within the preset delay period, even if the initial safety signal is a second-level signal, the control circuit can still continuously respond to the first-level signal in parallel to control the robot's behavior, so that the robot reaches a stopped state. Furthermore, responding to the second-level signal to drive the robot's motor brake to cut off the power to the robot, enabling the robot to remain stably stopped.
[0108] In step S101, after obtaining the initial security signal, it is transmitted to the first delay circuit and the second delay circuit through two channels. Correspondingly, steps S102 to S104 involve processing two signals with the same content, which will not be elaborated here. The circuit components and signal flow involved in steps S101 to S104 can be found in [reference needed]. Figures 1A to 1D The relevant descriptions are omitted here.
[0109] In summary, the control circuit provided in this application includes a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit. The signal conversion circuit converts the input protection stop signal into an initial safety signal conforming to the stated safety performance level. The first level signal of the initial safety signal is used to maintain the normal operation of the robot, and the second level signal is used to trigger a safe stop for the robot, thereby providing a safety signal of the same level as the robot's performance level. The initial safety signal is output to the delay circuit, which directly transmits the first level signal to the mode selection circuit and delays the second level signal for a preset delay period before transmitting it to the mode selection circuit. The mode selection circuit, when selecting an automatic mode based on the input mode selection signal, performs a logical AND operation on the signal output from the delay circuit, the robot's emergency stop switch signal, and the enable switch signal. When the delay circuit outputs the second level signal or the emergency stop switch signal is the second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop. Furthermore, the monitoring circuit is used to monitor the initial protection stop signal, the mode selection signal, and the emergency stop switch signal. When the initial protection stop signal is the second level signal, the monitoring result is transmitted to the robot controller, so that the robot controller can control the robot to achieve a safe stop via the motion control component. Therefore, this technical solution, by using a circuit that meets the target safety performance level instead of the safety controller and other components in the prior art, helps to reduce costs and provides the robot with control that matches the performance level (i.e., the target performance level).
[0110] The robot provided in this disclosure and the control circuit and control method provided in this disclosure are based on the same inventive concept and have the same beneficial effects as the methods used, operated or implemented therein.
[0111] This disclosure also provides a computer-readable storage medium corresponding to the control method provided in the foregoing embodiments. The computer-readable storage medium may be, for example, an optical disc, on which a computer program (i.e., a program product) is stored. When the computer program is run by a processor, it executes the control method provided in any of the foregoing embodiments.
[0112] It should be noted that examples of the computer-readable storage medium may also include, but are not limited to, phase-change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other optical and magnetic storage media, which will not be elaborated here.
[0113] Furthermore, this application also provides a computer program product for storing computer-readable program instructions, which, when executed by a processor, can implement a control method as described in the foregoing embodiments.
[0114] It should be noted that in this application, relational terms such as "first" and "second" are used merely to distinguish one entity or operation from another, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Furthermore, the terms "comprising," "including," or any other variations thereof are intended to cover non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements includes not only those elements but also other elements not expressly listed, or elements inherent to such a process, method, article, or apparatus. Without further limitations, an element defined by the phrase "comprising one..." does not exclude the presence of other identical elements in the process, method, article, or apparatus that includes the element.
[0115] The various embodiments in this specification are described in a related manner. Similar or identical parts between embodiments can be referred to mutually. Each embodiment focuses on describing the differences from other embodiments. In particular, the apparatus embodiments are basically similar to the method embodiments, so the description is relatively simple; relevant parts can be referred to the descriptions of the method embodiments.
[0116] The logic and / or steps represented in the flowchart or otherwise described herein, for example, can be considered as a sequenced list of executable instructions for implementing logical functions, and can be embodied in any computer-readable medium for use by, or in conjunction with, an instruction execution system, apparatus or device (such as a computer-based system, a processor-included system or other system that can fetch and execute instructions from, an instruction execution system, apparatus or device).
[0117] For the purposes of this specification, "computer-readable medium" can mean any means that can contain, store, communicate, propagate, or transmit programs for use by or in conjunction with an instruction execution system, apparatus, or device.
[0118] The above embodiments of this application do not constitute a limitation on the scope of protection of the embodiments of this application.
Claims
1. A control circuit, characterized in that, The control circuit, used for performing safety protection control on the robot, includes: a signal conversion circuit, a delay circuit, a mode selection circuit, and a monitoring circuit; the signal conversion circuit is a circuit for determining the safety performance level, and the target safety performance level is the safety performance level of the robot; wherein, The signal conversion circuit is used to convert the input protection stop signal into an initial safety signal that conforms to the safety performance level, and to output the initial safety signal to the delay circuit; the initial safety signal includes a first level signal and a second level signal; the first level signal is used to maintain the normal operation of the robot; the second level signal is used to trigger a safe stop of the robot; The delay circuit is used to directly transmit the first level signal to the mode selection circuit, and to transmit the second level signal to the mode selection circuit after delaying for a preset delay time. The mode selection circuit is used to perform a logical AND operation on the signal output by the delay circuit, the robot's emergency stop switch signal, and the enable switch signal when the automatic mode is selected according to the input mode selection signal; when the delay circuit outputs the second level signal or the emergency stop switch signal is the second level signal, it outputs a safety stop signal to the robot's motion control component to trigger the motion control component to control the robot to achieve a safe stop. The monitoring circuit is used to monitor the initial protection stop signal, the mode selection signal, and the emergency stop switch signal, and when the initial protection stop signal is the second level signal, to transmit the monitoring results to the robot controller so that the robot controller triggers the motion control component to control the robot to achieve a safe stop.
2. The control circuit according to claim 1, characterized in that, The delay circuit includes a first delay circuit and a second delay circuit; The signal conversion circuit is used to output the initial safety signal to the first delay circuit and the second delay circuit respectively; Wherein, the initial safety signal output by the signal conversion circuit to the first delay circuit is the first initial safety signal; the initial safety signal output by the signal conversion circuit to the second delay circuit is the second initial safety signal.
3. The control circuit according to claim 1, characterized in that, The control circuit also includes a manual operator signal interface, which is used to receive mode selection signals; The mode selection circuit is used to switch the control mode of the control circuit to manual mode in response to the mode selection signal. The mode selection circuit is also used to switch the control mode of the control circuit to the automatic mode in response to the enable switch signal in the manual mode.
4. The control circuit according to claim 2, characterized in that, The mode selection circuit includes a first mode selection circuit and a second mode selection circuit, wherein... The first delay circuit is used to output the first level signal of the first initial security signal to the first mode selection circuit and the second mode selection circuit respectively, and to output the second level signal of the first initial security signal to the first mode selection circuit and the second mode selection circuit respectively after delaying it according to the preset delay time. The second delay circuit is used to output the first level signal of the second initial security signal to the first mode selection circuit and the second mode selection circuit respectively, and to output the second level signal of the second initial security signal to the first mode selection circuit and the second mode selection circuit respectively after delaying it according to the preset delay time.
5. The control circuit according to claim 4, characterized in that, When the first mode selection circuit selects the automatic mode, the output of the first delay circuit is connected in series with the robot's first emergency stop switch input and the output of the second delay circuit. This allows the signal delayed by the first delay circuit to be logically ANDed with the first emergency stop switch signal and the signal delayed by the second delay circuit, and the result of the logically ANDed signal is output to the motion control component. When the first mode selection circuit selects the manual mode, the output of the first delay circuit is bypassed, and the first level signal is continuously output to the motion control component. When the second mode selection circuit selects the automatic mode, the output of the second delay circuit is connected in series with the robot's second emergency stop switch input and the output of the first delay circuit. This allows the signal delayed by the second delay circuit to be logically ANDed with the second emergency stop switch signal and the signal delayed by the first delay circuit, and the result of the logically ANDed signal is output to the motion control component. When the second mode selection circuit selects the manual mode, the output of the second delay circuit is bypassed, and the first level signal is continuously output to the motion control component.
6. The control circuit according to claim 5, characterized in that, The robot's motion control components include a first drive circuit, a second drive circuit, a first motor, and a second motor; wherein, Both the first driving circuit and the second driving circuit are used to respond to the first level signal and maintain the normal operation of the robot; The first drive circuit is also used to respond to the delayed second level signal to trigger the safety torque shutdown of the first motor and to trigger the mechanical brake of the first motor. The second drive circuit is also used to respond to the delayed second level signal, trigger the safety torque shutdown of the second motor, and trigger the mechanical brake of the second motor.
7. The control circuit according to claim 1, characterized in that, The first level signal is a high level signal; The second level signal is a low level signal.
8. A control method, characterized in that, For controlling a circuit, the method includes: The input protection stop signal is converted into an initial safety signal that conforms to the target safety performance level; the target safety performance level is the safety performance level of the controlled robot, and the initial safety signal includes a first level signal and a second level signal; When the control circuit is in automatic mode, the initial safety signal is processed, and the processing includes: when the initial safety signal is the second level signal, delaying the second level signal according to a preset delay duration; The processed signals, the robot's emergency stop switch signal, and the enable switch signal are subjected to a logical AND operation. The robot's behavior is controlled based on the logic and the processed results.
9. The control method according to claim 8, characterized in that, The step of controlling the robot's behavior based on the logical AND processing result includes: controlling the robot to stop safely if the processed signal is the first level signal; If the processed signal is the delayed second-level signal, the robot's motor brake is driven in response to the delayed second-level signal.
10. The control method according to claim 8 or 9, characterized in that, Also includes: In response to the received command to switch to manual mode, the first level signal is continuously output; In response to the received enable signal, the second level signal is output.
Citation Information
Patent Citations
Programmable I / O safety controller, programming device, equipment, medium and system
CN112783015A
I / O Expansion for Safety Controller
US20160282911A1
