Robots, mobile robots and their safety control systems

Abstract

To provide a technology related to the field of safety control of mobile robots.SOLUTION: A safety control system includes a first monitoring circuit, a second monitoring circuit, a third monitoring circuit, a safety control circuit, a servo circuit, and a main control board; the first monitoring circuit monitors movement data of a mobile robot, the second monitoring circuit monitors whether the mobile robot collides with an obstacle, and the third monitoring circuit monitors whether the obstacle exists within a preset range of the mobile robot; the safety control circuit generates a first safety command based on the movement data, generates a second safety command based on a collision signal, generates a third safety command based on an alarm signal, and generates a fourth safety command based on status information of a safety input device; the servo circuit receives and executes the corresponding safety command; the main control board outputs a drive control signal to the servo circuit, which then controls the motor of the mobile robot based on the drive control signal.SELECTED DRAWING: Figure 1

Description

[Technical Field]

[0001] The present application relates to the technical field of safety control of mobile robots, and in particular to a robot, a mobile robot and its safety control system. [Background technology]

[0002] With the rapid development of robotics technology, the application and widespread use of mobile robots in industrial and service fields will increase, and there will be more and more opportunities for robots and humans to coexist in the same workplace. In this situation, robot safety monitoring is generally required to achieve robot safety control.

[0003] In conventional technology, safety control objectives are usually achieved by using an external safety PLC (Programmable Logic Controller), but this makes system construction complicated and costly.General logic circuits do not meet the safety requirements proposed in the international safety standard ISO-13849-1, and designing safety circuits is very complex and difficult, making it difficult to meet safety requirements. Summary of the Invention [Problem to be solved by the invention]

[0004] The present application provides a robot, a mobile robot and a safety control system thereof, which solves the above problems of the prior art. [Means for solving the problem]

[0005] The present application provides a mobile robot and its safety control system, thereby solving the above problems of the prior art.

[0006] A first aspect of the present application provides a safety control system for a mobile robot, in which a plurality of mobile devices are installed on the mobile robot, and the mobile devices are used to move the mobile robot horizontally or in the direction of gravity. The safety control system includes a first monitoring circuit, a second monitoring circuit, a third monitoring circuit, a safety control circuit, a servo circuit, and a main control board. The first monitoring circuit is used to monitor the motion status of the plurality of mobile devices and monitor movement data of the mobile robot. The second monitoring circuit is installed on the outer wall of the mobile robot and is used to generate a collision signal when the mobile robot collides with an obstacle. The third monitoring circuit monitors whether an obstacle exists within a predetermined range of the mobile robot, and generates an alarm signal when it detects the existence of an obstacle. the safety control circuit is connected to the first monitoring circuit, the second monitoring circuit, the third monitoring circuit and the safety input device of the mobile robot, and is used to generate a first safety command based on the movement data, generate a second safety command based on the collision signal, generate a third safety command based on the alarm signal, and generate a fourth safety command based on the status information of the safety input device; the servo circuit is connected to the safety control circuit, and is used to receive and execute the first safety command, the second safety command, the third safety command or the fourth safety command output by the safety control circuit; the main control board is connected to the servo circuit, and is used to output a drive control signal to the servo circuit, so that the servo circuit controls the motor of the mobile robot according to the drive control signal.

[0007] A second aspect of the present application provides a mobile robot, the mobile robot including a main body, a plurality of mobile devices, and the safety control system. The plurality of mobile devices are installed on the bottom or top of the main body and are used to move the mobile robot horizontally or along the direction of gravity. The safety control system is used to monitor the motion status of the mobile devices, monitor the movement data of the mobile robot to generate a first safety command, monitor whether the mobile robot collides with an obstacle to generate a second safety command, monitor whether an obstacle exists within a preset range of the mobile robot to generate a third safety command, and / or generate a fourth safety command based on status information of a safety input device of the mobile robot, and control the motors of the mobile robot to execute the corresponding safety command based on the first safety command, the second safety command, the third safety command, and / or the fourth safety command.

[0008] A third aspect of the present application further provides a robot, the robot including a carrier, a main body, and a safety control system, wherein the main body is attached to the carrier and performs motion control in combination with the carrier, the safety control system including a first monitoring circuit, a second monitoring circuit, a third monitoring circuit, a safety control circuit, a servo circuit, and a main control board, the first monitoring circuit being used to monitor the motion state of the main body and monitor motion data of the main body, the second monitoring circuit being installed on an outer wall of the main body and being used to generate a collision signal when the main body collides with an obstacle, the third monitoring circuit being used to monitor whether an obstacle exists within a preset range of the main body, and to generate an alarm signal when it is detected that an obstacle exists, The safety control circuit is connected to the first monitoring circuit, the second monitoring circuit, the third monitoring circuit and the safety input device of the robot, and is used to generate a first safety command based on the movement data, generate a second safety command based on the collision signal, generate a third safety command based on the alarm signal, and generate a fourth safety command based on status information of the safety input device; the servo circuit is connected to the safety control circuit and is used to receive and execute the first safety command, the second safety command, the third safety command or the fourth safety command output by the safety control circuit; and the main control board is connected to the servo circuit and is used to output a drive control signal to the servo circuit, thereby causing the servo circuit to control the motor of the robot based on the drive control signal.

[0009] Unlike the prior art, the present application constructs a safety control system equipped with multiple monitoring circuits and safety control circuits, which can monitor the movement state of the mobile robot, whether a collision will occur, and whether an obstacle exists within a pre-defined area. This multi-faceted monitoring improves the reliability of the safety control of the mobile robot. Meanwhile, the safety control circuit in the safety control system of the present application can be directly connected to the servo circuit, which improves the integration level of the entire safety control system, simplifies the complex circuitry of the safety control system, and reduces production costs.

[0010] It is to be understood that the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the present application.

[0011] In order to more clearly describe the technical solutions in the embodiments of the present application, the following briefly describes the drawings that need to be used in the description of the embodiments. Obviously, the drawings in the following description are only some embodiments of the present application. Those skilled in the art can obtain other drawings from these drawings without any creative efforts. [Brief explanation of the drawings]

[0012] [Figure 1] 1 is a structural schematic diagram of a first embodiment of a safety control system for a mobile robot of the present application. [Figure 2] FIG. 2 is a structural schematic diagram of a second embodiment of a safety control system for a mobile robot according to the present application. [Figure 3] FIG. 10 is a structural schematic diagram of a third embodiment of a safety control system for a mobile robot according to the present application. [Figure 4] FIG. 10 is a structural schematic diagram of a fourth embodiment of the safety control system for a mobile robot of the present application. [Figure 5] FIG. 10 is a structural schematic diagram of a fifth embodiment of the safety control system for a mobile robot of the present application. [Figure 6] FIG. 10 is a structural schematic diagram of a sixth embodiment of the safety control system for a mobile robot of the present application. [Figure 7] FIG. 10 is a structural schematic diagram of a seventh embodiment of the safety control system for a mobile robot of the present application. [Figure 8] 1 is a structural schematic diagram of an embodiment of a mobile robot of the present application. DETAILED DESCRIPTION OF THE INVENTION

[0013] In order to allow those skilled in the art to better understand the technical solution of the present application, the mobile robot and its safety control system provided by the present application will be described in more detail below in conjunction with drawings and specific embodiments. It should be understood that the described embodiments are only a part of the embodiments of the present application, but not all of them. Based on the embodiments of the present application, all other embodiments that those skilled in the art can obtain without inventive efforts fall within the scope of protection of the present application.

[0014] Reference to an "embodiment" herein means that a particular feature, structure, or characteristic described in connection with that embodiment may be included in at least one embodiment of the present application. The appearances of this phrase in various places in the specification do not necessarily all refer to the same embodiment, nor are they separate or alternative embodiments mutually exclusive from other embodiments. Those skilled in the art will understand, either explicitly or implicitly, that the embodiments described herein can be combined with other embodiments.

[0015] In this application, terms such as "first," "second," etc., are used to distinguish different objects, not to describe a particular order. Also, the terms "comprise," "have," and any variations thereof are intended to cover a non-exclusive inclusion. For example, a process, method, system, product, or apparatus that includes a series of steps or units is not limited to the recited steps or units, but may optionally further include steps or units not recited, or may optionally further include other steps or units inherent in the process, method, product, or apparatus.

[0016] In contrast to the prior art, which generally uses a safety PLC to achieve safe control of robots, this application builds a safety control system, and specifically, this application takes a mobile robot as an example to explain how the safety control system safely controls the mobile robot.

[0017] Currently, mobile robots generally have multiple mobile devices. The mobile devices are used to drive the mobile robot to move horizontally or along the direction of gravity. For example, the mobile robot is equipped with left and right wheels, which are driven by motors. Specifically, the speed and direction of the mobile robot are adjusted by adjusting the rotation speed and steering of the left and right wheels. That is, the left and right wheels are used to move the mobile robot horizontally. For example, if the rotation speed of the left wheel is slower than the rotation speed of the right wheel and the steering of the left wheel matches the steering of the right wheel, the mobile robot will be driven to turn left.

[0018] On the other hand, mobile robots are used to load cargo and transport the cargo to the corresponding location for unloading. Based on this characteristic, most mobile robots are equipped with a lifting device to assist in loading and unloading cargo, and the height and rotation angle of the lifting device can be adjusted to adjust the loading and unloading direction of the cargo carried by the mobile robot, that is, the lifting device is used to move the mobile robot along the direction of gravity.

[0019] 1, which is a structural schematic diagram of a first embodiment of a safety control system for a mobile robot of the present application. As shown in FIG. 1, the safety control system 1 of this embodiment includes a first monitoring circuit 11, a second monitoring circuit 12, a third monitoring circuit 13, a safety control circuit 14, a servo circuit 15, and a main control board 16.

[0020] Specifically, the main control board 16 is connected to the servo circuit 15 and is used to output drive control signals to the servo circuit 15, so that the servo circuit 15 controls the motors of the mobile robot based on the drive control signals. Here, the main control board 16 generates corresponding drive control signals based on the robot's operating mode. Optionally, a control panel can be installed on the mobile robot, allowing the operator to select the operating mode of the mobile robot through the control panel, such as selecting a preset moving speed, a preset moving distance, etc. of the mobile robot, thereby determining the moving trajectory of the mobile robot and selecting the corresponding operating mode.

[0021] The first monitoring circuit 11 is used to monitor the motion status of multiple mobile devices, thereby monitoring the movement data of the mobile robot. For example, if the mobile devices have left and right wheels, it is necessary to monitor the rotation speed and steering of the left wheel and the rotation speed and steering of the right wheel, and the current state of the mobile robot can be determined based on the rotation speed and steering of the left wheel and the rotation speed and steering of the right wheel. Alternatively, if the mobile devices are elevators, it is necessary to monitor the lift height and rotation angle of the elevators, and the current state of the mobile robot can be determined based on the lift height and rotation angle of the elevators.

[0022] In this embodiment, by monitoring the movement data of the mobile robot, it is possible to determine whether the movement state of the mobile robot is abnormal, i.e., to realize monitoring of the safe speed of the mobile robot, thereby performing safety control when the mobile robot is in an abnormal state.

[0023] The second monitoring circuit 12 is installed on the outer wall of the mobile robot. In this embodiment, the second monitoring circuit 12 is used to monitor whether the mobile robot collides with an obstacle. When the mobile robot collides with an obstacle, a collision signal is generated and safety control is performed based on the collision signal to prevent secondary collisions or multiple collisions between the mobile robot and the obstacle, realize safe edge contact detection of the mobile robot, and improve the safety reliability of the mobile robot.

[0024] Optionally, the second monitoring circuit 12 in this embodiment may be a pressure sensor, and may include at least one of an edge sensor or an anti-collision strip, where the second monitoring circuit 12 may be installed around the housing surface of the mobile robot to realize 360° spatial collision detection for the mobile robot, thereby improving the safety control effect for the mobile robot and further improving the safety performance of the mobile robot.

[0025] The third monitoring circuit 13 is used to monitor whether an obstacle exists within a preset range of the mobile robot, and to generate a warning signal when an obstacle exists. For example, the third monitoring circuit 13 is used to monitor whether an obstacle exists on the path of the mobile robot, and generates a warning signal when it determines that an obstacle exists on the path of the mobile robot and the distance between the obstacle and the mobile robot is smaller than the preset range.

[0026] Alternatively, the preset range in this embodiment can be selected based on the operation mode of the mobile robot, i.e., when the mobile robot is moving, it needs to determine whether there is an obstacle ahead in the path of the mobile robot's movement, and the preset range is set in direct proportion to the mobile robot's movement speed. When the mobile robot is turning, it needs to determine whether there is an obstacle within the preset range centered on the mobile robot.

[0027] In this embodiment, the third monitoring circuit 13 monitors obstacles, thereby achieving the effect of collision prevention, and the monitoring area of the third monitoring circuit 13, i.e., the preset range, is switchable, improving the applicability of the third monitoring circuit 13.

[0028] The safety control circuit 14 is connected to the first monitoring circuit 11 and the servo circuit 15, and is used to generate a first safety command based on the movement data acquired by the first monitoring circuit 11, so that the servo circuit 15 receives and executes the first safety command to drive and control the motor of the mobile robot.

[0029] Optionally, the first monitoring circuit 11 is used to monitor the current state of the mobile robot, i.e., monitor the movement of the mobile robot itself. If it is monitored that the mobile robot is moving abnormally, for example, if the mobile robot is overrunning, the safety control circuit 14 can output a first safety command to control the motor to slow down or stop, i.e., perform a corresponding Safe Torque Off (STO) control.

[0030] The safety control circuit 14 is further connected to the second monitoring circuit 12 and is used to generate a second safety command based on the collision signal generated by the second monitoring circuit 12, so that the servo circuit 15 receives and executes the second safety command to drive and control the motor of the mobile robot.

[0031] Optionally, the second monitoring circuit 12 is used to monitor whether a collision of the mobile robot occurs. If a collision of the mobile robot is detected, the mobile robot needs to be controlled to stop moving immediately, and therefore the safety control circuit 14 outputs a second safety command to realize a motor holding brake of the motor.

[0032] The safety control circuit 14 is further connected to the third monitoring circuit 13 and is used to generate a third safety command based on the alarm signal generated by the third monitoring circuit 13, so that the servo circuit 15 receives and executes the third safety command to drive and control the motor of the mobile robot.

[0033] Optionally, a third monitoring circuit 13 is used to monitor whether an obstacle exists within a preset area, and the preset area is set and switched based on the operation mode, i.e., the third safety command generated by the safety control circuit 14 in different operation modes is also different.

[0034] For example, when a mobile robot is moving and it is determined that an obstacle exists within a predetermined area, the mobile robot needs to be controlled to slow down or stop. The slower speed may be a speed that will not cause damage to the mobile robot if it collides with an obstacle, or a speed that will not cause the mobile robot to roll over after colliding with an obstacle.

[0035] Therefore, the third safety command generated by the safety control circuit 14 based on the warning signal can include a safe torque-off control or a safe brake control, etc.

[0036] The safety control circuit 14 is further connected to the safety input device and is used to generate a fourth safety command based on the status information of the safety input device, so that the servo circuit 15 receives and executes the fourth safety command to drive and control the motor of the mobile robot.

[0037] Optionally, the safety input device of this embodiment can include an emergency stop switch, a safety door, an enable switch, a reset button, a start button, a mode selection switch, an obstacle detection shield switch, or other input devices for monitoring the safety performance of the industrial robot, where the safety control circuit 14 can be connected to multiple safety input devices for realizing different functions.

[0038] For example, if the safety control circuit 14 is connected to an emergency stop switch, when the mobile robot collides with an obstacle or in an emergency, the operator presses the emergency stop switch to generate a fourth safety command, and the safety control circuit 14 controls the mobile robot to stop moving based on the fourth safety command.

[0039] If the safety control circuit 14 is connected to an enable switch or a start button, a fourth safety command can be generated by the operator pressing the associated switch, and the safety control circuit 14 controls the start of the mobile robot, or controls the enable of the mobile robot, or controls the stop of the enable of the mobile robot based on the fourth safety command.

[0040] Optionally, the enable switch of this embodiment can further select a 3-state enable actuator (3-State Enable), in which the 3-state enable actuator needs to be pressed continuously to operate, so that in an emergency the operator can press the button fully or release the button to stop the mobile robot, which can effectively improve the reliability and timeliness of the safety control of the mobile robot.

[0041] The safety control system 1 of this embodiment includes a first monitoring circuit 11, a second monitoring circuit 12, and a third monitoring circuit 13 with different monitoring functions, which can realize more comprehensive sensing and monitoring of the mobile robot itself and its movement environment. When the different monitoring circuits generate corresponding monitoring signals, the safety control circuit 14 outputs corresponding safety commands, which control the servo circuit 15 to perform corresponding safety protection operations, thereby improving the reliability of the safety control of the mobile robot.

[0042] At the same time, the safety control system 1 of this embodiment realizes integrated safety control, does not require an external device such as a safety PLC, and can meet the safety standard requirements of Category 3 (CAT3, Safety Category 3) and Performance Level d (PLD, Equipment Safety Performance Level d).In addition, the safety control system 1 of this embodiment can be integrated into the control panel of a mobile robot, offering the advantages of high integration and compact size.

[0043] In addition, all of the monitoring circuits, safety control circuits 14, and servo circuits 15 in this embodiment are pure hardware logic circuits 142, which can improve the response speed of the circuits and shorten the development and certification cycles. At the same time, this embodiment does not use devices such as programmable logic controllers (PLCs), microprocessors (CPUs), microcontrollers (MCUs), etc., and does not require supporting software and / or firmware, which can significantly reduce production costs.

[0044] Furthermore, the safety control circuit 14 in this embodiment may be directly connected to the main control board 16. Here, the safety control circuit 14 further transmits the generated first safety command, second safety command, third safety command and / or fourth safety command to the main control board 16, and the main control board 16 disables the servo circuit 15, i.e., stops the enable output of the servo circuit 15, based on different safety commands.

[0045] Optionally, the first safety command, the second safety command, the third safety command, and / or the fourth safety command may include an STO shutdown command, and unlike when receiving a disable command, the servo circuit 15 in the STO shutdown state still receives the enable output of the main control board 16. After the mobile robot completes the safe shutdown and resolves the fault, the servo circuit 15 can directly control the startup of the mobile robot, in which case the servo circuit 15 can operate normally without power outage.

[0046] 2, which is a structural schematic diagram of a second embodiment of the safety control system for a mobile robot of the present application. As shown in FIG. 2, the safety control circuit 14 includes an input circuit 141, a logic circuit 142, and an output circuit 143.

[0047] Here, the input circuit 141 is connected to a safety input device and is used to obtain status information of the safety input device, specifically, the status information of the safety input device may be specifically the pressing status of the safety input device.

[0048] Since the types of safety input devices are different, the input signals are also different, and some of the safety input devices need to receive the test signal output by the safety control circuit 14 and generate a feedback signal based on the test signal, which can characterize the status information of the safety input device. Alternatively, some of the safety input devices can generate a signal by themselves, and the signal that the safety input device inputs to the safety control circuit 14 can characterize the status information of the safety input device.

[0049] The logic circuit 142 is connected to the input circuit 141 and generates a fourth safety command based on the status information of the safety input device. Optionally, in this embodiment, the input circuit 141 can receive input signals of the safety input device through dual channels, and the logic circuit 142 is further connected to the input circuit 141 and performs logic comparison based on the input signals of the dual channels, thereby realizing status judgment of the safety input device and generating a corresponding fourth safety command.

[0050] In another embodiment, the logic circuit 142 is further connected to the input circuit 141 via dual channels to achieve dual redundant detection of input signals and improve the reliability of safety control of the mobile robot. By installing the dual redundant logic circuit 142 in this embodiment, the mobile robot using the safety control system 1 can comply with the international safety standard ISO-13849-1 and improve the safety level of the mobile robot.

[0051] The output circuit 143 is connected to the logic circuit 142 and the servo circuit 15, and is used to send the fourth safety command to the servo circuit 15. Optionally, the output circuit 143 in this embodiment may be a simple logic circuit 142. Alternatively, in other embodiments, the logic circuit 142 may be directly connected to the servo circuit 15.

[0052] Furthermore, the output circuit 143 in this embodiment is connected to the main control board 16. The logic circuit 142 is used to generate a fourth safety command in response to status information of the safety input device, which is a dangerous trigger state, a fault state, or a misconnection state, and to send the fourth safety command to the output circuit 143 and the main control board 16.

[0053] The output circuit 143 further sends a fourth safety command to the servo circuit 15, so that the servo circuit 15 executes the first safety command and further controls the shutdown of the mobile robot. The logic circuit 142 is further used to send status information to the main control board 16 of the mobile robot, and in response to the status information being in a fault state or a misconnection state, the main control board 16 generates alarm information, so that the user can check the safety input device based on the alarm information and solve the fault problem of the safety input device.

[0054] Alternatively, the logic circuit 142 may be further used to determine whether the input circuit 141 has failed, and transmit the failure information of the input circuit 141 to the main control board 16 of the mobile robot, so that the main control board 16 disables the servo circuit 15 if the input circuit 141 has failed.

[0055] 1 and 2, and further referring to FIG. 3, which is a structural schematic diagram of a third embodiment of the safety control system for a mobile robot of the present application. As shown in FIG. 3, the logic circuit 142 includes a primary circuit 1421 and a secondary circuit 1422.

[0056] Specifically, the primary circuit 1421 is connected to the input circuit 141 and is used for jointly processing the status information of the safety input device. Optionally, the primary circuit 1421 may be connected to the input circuit 141 through a dual channel and is used for receiving two input signals and cross-validating the two input signals. Optionally, the number of primary circuits 1421 may be two, and each primary circuit 1421 is connected to the input circuit 141. Here, the two primary circuits 1421 are connected to each other to cross-validate the received input signals.

[0057] In this embodiment, a primary circuit 1421 with a dual redundant structure is installed, so that the mobile robot using the safety control system 1 can comply with the international safety standard ISO-13849-1, thereby improving the safety level of the mobile robot.

[0058] Here, the primary circuit 1421 can perform parallel-to-serial conversion of the status information of the multiple safety input devices, where the status information of each safety input device can be a pulse signal, and the waveforms of the multiple pulse signals are different, and the primary circuit 1421 integrates the multiple pulse signals to output a signal containing the multiple pulse signal information.

[0059] The secondary circuit 1422 is connected to the primary circuit 1421 and the output circuit 143 and is used to generate a fourth safety command based on the state information and send the fourth safety command to the output circuit 143 .

[0060] Here, the secondary circuit 1422 receives the signal output by the primary circuit 1421, determines whether the signal is identical to the integrated signal of the multiple pulse signals under normal conditions, and if not, determines that the status information of at least one safety input device has changed, and simultaneously generates a fourth safety command based on this determination. The secondary circuit 1422 can also further determine which specific safety input device's status information has changed.

[0061] 1 to 3, and further refer to FIG. 4, which is a structural schematic diagram of a fourth embodiment of a safety control system for a mobile robot of the present application. As shown in FIG. 4, the number of secondary circuits 1422 in this embodiment is two, and each secondary circuit 1422 is connected to a primary circuit 1421 and an output circuit 143. Here, the two secondary circuits 1422 are connected to each other to mutually verify the output signals of the received primary circuits 1421.

[0062] Here, in this embodiment, by installing a secondary circuit 1422 with a dual redundant structure, the mobile robot using the safety control system 1 can comply with the international safety standard ISO-13849-1, thereby improving the safety level of the mobile robot.

[0063] 1 and 3, and further referring to FIG. 5, which is a structural schematic diagram of a fifth embodiment of a safety control system for a mobile robot of the present application. As shown in FIG. 5, the safety control circuit 14 of this embodiment further includes a state monitoring module 144 and a mode switching module 145.

[0064] Here, the status monitoring module 144 is used to monitor the operating status of the mobile robot and generates a mode switching signal based on the operating status of the mobile robot. The mode switching module 145 is connected to the status monitoring module 144 and the logic circuit 142. The mode switching module 145 generates a mode signal based on the mode switching signal, and the logic circuit 142 generates a fourth safety command based on the mode signal and the status information of the safety input device.

[0065] Specifically, the motion state of the mobile robot may include stationary, accelerating, starting, etc. The state monitoring module 144 can monitor the motion state of the mobile robot to determine what state the mobile robot is in at present, or further determine that the mobile robot is about to switch states, and generate a switching signal according to different states and a corresponding mode switching signal according to different motion states.

[0066] Furthermore, the mode switching module 145 determines whether a state change occurs by receiving different mode switching signals, and simultaneously receives the state information of the safety input device, and generates a fourth safety command based on both.

[0067] For example, if the state monitoring module 144 monitors that the mobile robot is currently in a high-speed moving state, and the logic circuit 142 receives state information of the safety input device indicating that the safety input device has been triggered, for example, if the emergency stop device is triggered, generating an emergency stop signal directly based on the triggering of the emergency stop device may cause the mobile robot to perform an emergency stop operation, which may cause it to roll over or the like, and may endanger pedestrians passing by. Therefore, it is necessary to generate a fourth safety command by combining the current operating state of the mobile robot and the state information of the safety input device.

[0068] 1 and further referring to FIG. 6, which is a structural schematic diagram of a sixth embodiment of the safety control system for a mobile robot of the present application. As shown in FIG. 6, the first monitoring circuit 11 of this embodiment includes a first encoder 111 and a second encoder 112.

[0069] If the mobile robot includes left and right wheels, the first encoder 111 and the second encoder 112 are used to monitor the left and right wheels respectively, and obtain the moving speed information, position information and direction information of the mobile robot.

[0070] Optionally, the first monitoring circuit 11 includes multiple encoders, two of which are used to monitor the motion status of the same mobile device. Specifically, the number of the first encoder 111 and the second encoder 112 in this embodiment may both be two, and a first encoder 1111A, a first encoder 2111B, a second encoder 1112A, and a second encoder 2112B may be defined. Here, the first encoder 1111A and the first encoder 2111B each have independent read heads and are mounted on the same PCB. At the same time, the second encoder 1112A and the second encoder 2112B each have independent read heads and are mounted on the same PCB. In this embodiment, the dual encoders monitor data for the left and right wheels, respectively. This prevents the first monitoring circuit 11 from receiving motion information for the left and / or right wheels, which would otherwise prevent the left and / or right wheels from being unable to be safely controlled if an error occurs in one of the encoders, thereby improving the reliability of safe control of the mobile robot.

[0071] Here, the first encoder 111 outputs a first test pulse signal to the left wheel, and the left wheel returns motion information of the left wheel based on the first test pulse signal, and the second encoder 112 outputs a second test pulse signal to the right wheel, and the right wheel returns motion information of the right wheel based on the second test pulse signal.

[0072] Furthermore, the first monitoring circuit 11 of this embodiment includes a third encoder 113. Here, if the mobile robot includes a lifting device, the third encoder 113 is used to monitor the lifting device and obtain the lifting height and rotation angle of the lifting device.

[0073] Optionally, the first monitoring circuit 11 includes multiple encoders, two of which are used to monitor the motion status of the same mobile device. That is, the number of third encoders 113 in this embodiment may be two, and third encoders 1113A and 2113B may be defined. Here, third encoders 1113A and 2113B each have independent read heads and are mounted on the same PCB. In this embodiment, the dual encoders monitor the data of the lifting device. This prevents the first monitoring circuit 11 from receiving the motion information of the lifting device and safely controlling the lifting device if an error occurs in one of the encoders, thereby improving the reliability of the safe control of the mobile robot.

[0074] Here, in this embodiment, by installing a first monitoring circuit 11 with a dual redundant structure, the mobile robot of the safety control system 1 can be made to comply with the international safety standard ISO-13849-1, thereby improving the safety level of the mobile robot.

[0075] 7, which is a structural schematic diagram of a seventh embodiment of the safety control system for a mobile robot of the present application, in addition to FIG. 6. As shown in FIG. 7, the safety control circuit 14 further includes a first diagnostic circuit 146, a decoding circuit 147, a second diagnostic circuit 149, and an area determination circuit 148.

[0076] Here, the first diagnostic circuit 146 is connected to the first encoder 111 and the second encoder 112, and monitors the motion states of the left and right wheels based on the monitoring data of the first encoder 111 and the monitoring data of the second encoder 112.

[0077] In this embodiment, a first encoder 1111A, a first encoder 2111B, a second encoder 1112A, and a second encoder 2112B are installed, and specifically, the first diagnostic circuit 146 is connected to the first encoder 1111A, the first encoder 2111B, the second encoder 1112A, and the second encoder 2112B, respectively.

[0078] Here, the monitoring data of the first encoder 111 and the second encoder 112 includes rotational speed information and steering information, and therefore the first diagnostic circuit 146 can determine a first rotational angle and a first rotational speed of the left wheel based on the monitoring data of the first encoder 1111A and the first encoder 2111B, and can determine a second rotational angle and a second rotational speed of the right wheel based on the monitoring data of the second encoder 1112A and the second encoder 2112B.

[0079] Furthermore, the movement of the wheels is mainly controlled by the rotation angle and rotation speed, and the first diagnostic circuit 146 can respectively obtain two rotation angles and rotation speeds of the left wheel, and also obtain two rotation angles and rotation speeds of the right wheel, and can monitor each wheel by comparing the corresponding rotation angles and rotation speeds of the wheels.

[0080] Specifically, the first diagnostic circuit 146 compares the two first rotation angles, and in response to the two first rotation angles being the same, determines that both the first encoder 1111A and the first encoder 2111B are normal, and in response to the first rotation angle being the actual rotation angle of the left wheel or the two first rotation angles being different, determines that the first encoder 1111A or the first encoder 2111B is abnormal.

[0081] The first diagnostic circuit 146 compares the two second rotation angles and, in response to the two second rotation angles being the same, determines that the second encoder 1112A and the second encoder 2112B are normal, and, in response to the second rotation angle being the actual rotation angle of the right wheel or the two second rotation angles being different, determines that the second encoder 1112A or the second encoder 2112B is abnormal.

[0082] The first diagnostic circuit 146 compares the two first rotational speeds and further calculates the difference between the two first rotational speeds, and determines that both the first encoder 1111A and the first encoder 2111B are normal in response to the difference between the two first rotational speeds being smaller than a preset threshold, or determines that the first encoder 1111A or the first encoder 2111B is abnormal in response to the difference between the first rotational speeds being greater than or equal to a preset threshold.

[0083] The first diagnostic circuit 146 compares the two second rotational speeds and further calculates the difference between the two second rotational speeds, and determines that both the second encoder 1112A and the second encoder 2112B are normal in response to the difference between the two second rotational speeds being smaller than a predetermined threshold, or determines that the second encoder 1112A or the second encoder 2112B is abnormal in response to the difference between the two second rotational speeds being greater than or equal to the predetermined threshold.

[0084] In this embodiment, the threshold value of the rotational speed difference between the left wheel and the right wheel is set to a predetermined threshold value, thereby improving the consistency of safety monitoring and the safety reliability of the safety monitoring of the entire machine.

[0085] 7, the decoding circuit 147 is connected to the first encoder 1111A, the first encoder 2111B, the second encoder 1112A, and the second encoder 2112B, and is used to decode the monitoring data of the first encoder 1111A and the first encoder 2111B to obtain the speed signal and the direction signal of the left wheel, and to decode the monitoring data of the second encoder 1112A and the second encoder 2112B to obtain the speed signal and the direction signal of the right wheel. Here, the decoding circuit 147 is used to decode the monitoring data of the first encoder 1111A, the monitoring data of the first encoder 2111B, the monitoring data of the second encoder 1112A, and the second encoder 2112B to obtain the corresponding speed signal and the direction signal. Here, the speed signal and the direction signal are of different signal types; specifically, the speed signal is an analog signal, and the direction signal is a digital signal.

[0086] Specifically, the decoding circuit 147 of this embodiment includes a first decoding circuit 1471, a second decoding circuit 1472, a third decoding circuit 1473, and a fourth decoding circuit 1474. The first decoding circuit 1471 is connected to the first encoder 1111A, the second decoding circuit 1472 is connected to the first encoder 2111B, the third decoding circuit 1473 is connected to the second encoder 1112A, and the fourth decoding circuit 1474 is connected to the second encoder 2112B.

[0087] As shown in FIG. 7, the second diagnosis circuit 149 is connected to the decoding circuit 147 and is used to determine whether the left wheel is abnormal based on the speed signal and / or direction signal of the left wheel, determine whether the right wheel is abnormal based on the speed signal and / or direction signal of the right wheel, and determine whether the mobile robot will overrun based on the speed signal of the left wheel and the speed signal of the right wheel.

[0088] Optionally, in one embodiment, the second diagnostic circuit 149 determines the rotation angle of the left wheel based on the left wheel direction signal and determines the rotation speed of the left wheel based on the left wheel speed signal.

[0089] Here, the second diagnostic circuit 149 compares the rotation angles of the two left wheels, and in response to the rotation angles of the two left wheels being the same, determines that the first encoder 1111A and the first encoder 2111B are both normal, and in response to the rotation angles being the actual rotation angles of the left wheels or the rotation angles of the two left wheels being different, determines that the first encoder 1111A or the first encoder 2111B is abnormal.

[0090] The second diagnostic circuit 149 compares the rotational speeds of the two left wheels and further calculates the difference between the rotational speeds of the two left wheels, and determines that both the first encoder 1111A and the first encoder 2111B are normal in response to the difference between the rotational speeds of the two left wheels being smaller than a preset threshold, or determines that the first encoder 1111A or the first encoder 2111B is abnormal in response to the difference between the rotational speeds of the two left wheels being greater than or equal to the preset threshold.

[0091] Specifically, the second diagnostic circuit 149 determines the rotation angle of the right wheel based on the direction signal of the right wheel, and determines the rotation speed of the right wheel based on the speed signal of the right wheel.

[0092] Here, the second diagnostic circuit 149 compares the rotation angles of the two right wheels, and in response to the rotation angles of the two right wheels being the same, determines that both the second encoder 1112A and the second encoder 2112B are normal, and in response to the rotation angles being the actual rotation angles of the right wheels, or the rotation angles of the two right wheels being different, determines that the second encoder 1112A or the second encoder 2112B is abnormal.

[0093] The second diagnostic circuit 149 compares the rotational speeds of the two right wheels and further calculates the difference between the rotational speeds of the two right wheels, and determines that both the second encoder 1112A and the second encoder 2112B are normal in response to the difference between the rotational speeds of the two right wheels being smaller than a preset threshold, or determines that the second encoder 1112A or the second encoder 2112B is abnormal in response to the difference between the rotational speeds of the two right wheels being greater than or equal to the preset threshold.

[0094] In another embodiment, the second diagnostic circuit 149 compares the rotation speed of the left wheel and the rotation speed of the right wheel, calculates the difference between the rotation speed of the left wheel and the rotation speed of the right wheel, and determines that the mobile robot will overrun in response to the difference between the rotation speed of the left wheel and the rotation speed of the right wheel being greater than a preset threshold.

[0095] 7, the third monitoring circuit 13 of this embodiment includes a radar 131, which realizes non-contact monitoring of obstacles. Optionally, the radar is used to emit a pulsed laser, receive the reflected light of the pulsed laser, and determine whether there is an obstacle within a preset range of the mobile robot based on the reflected light.

[0096] The area determination circuit 148 is connected to the decoding circuit 147 and generates area information based on the speed and direction signals of the left wheel and the speed and direction signals of the right wheel. The radar 131 is connected to the area determination circuit 148 and switches the predetermined area of the mobile robot based on the area information. Here, switching the predetermined area described in this embodiment can be related to the operating environment of the mobile robot.

[0097] Here, the area determination circuit 148 is connected to a first decoding circuit 1471, a second decoding circuit 1472, a third decoding circuit 1473, and a fourth decoding circuit 1474, respectively.

[0098] Since the distance traveled by a mobile robot is determined by its speed and steering, the area determination circuit 148 needs to receive the decoded speed and direction signals of the left wheel and the right wheel.

[0099] Specifically, the region determination circuit 148 generates region information based on the output signals of the first decoding circuit 1471, the second decoding circuit 1472, the third decoding circuit 1473, and the fourth decoding circuit 1474. Optionally, a map of the current operating region can be stored in the region determination circuit 148, and different regions on the map correspond to different moving distances, which can be calculated and obtained according to the rotation speed, steering, and moving time.

[0100] Here, the output signal of the first decoding circuit 1471 and the output signal of the second decoding circuit 1472 are both data characterizing the distance traveled by the left wheel of the mobile robot, and it is only necessary to select either one of the two. The output signal of the third decoding circuit 1473 and the output signal of the fourth decoding circuit 1474 are both data characterizing the distance traveled by the right wheel of the mobile robot, and it is only necessary to select either one of the two.

[0101] In another embodiment, the region determination circuit 148 may further include a first region determination circuit and a second region determination circuit.

[0102] Here, the first area determination circuit is connected to the first decoding circuit 1471 and the third decoding circuit 1473, and generates first area information based on the decoded left wheel speed signal, left wheel direction signal, right wheel speed signal, and right wheel direction signal.

[0103] The second area determination circuit is connected to the second decoding circuit 1472 and the fourth decoding circuit 1474, and generates second area information based on the decoded left wheel speed signal, left wheel direction signal, right wheel speed signal, and right wheel direction signal.

[0104] Furthermore, the radar 131 is connected to the first area determination circuit and the second area determination circuit, and generates a fault diagnosis signal based on the first area information and the second area information.

[0105] Here, the radar 131 cross-verifies the first area information and the second area information, and if it determines that they match, it proves that the detection calculation results of the first area determination circuit and the second area determination circuit match, i.e., the area corresponding to the first area information or the second area information is the area where the mobile robot is currently located. Since different obstacles exist in different areas, it is possible to switch the obstacle detection area by determining the area where the mobile robot is currently located.

[0106] If it is determined that the two do not match, it proves that the detection calculation results of the first area determination circuit and the second area determination circuit do not match, and in this case the first area information and the second area information are unreliable, and there is a possibility that the first area determination circuit and / or the second area determination circuit is abnormal, or at least one of the first decoding circuit 1471, the second decoding circuit 1472, the third decoding circuit 1473 and the fourth decoding circuit 1474 is abnormal.

[0107] Optionally, the radar 131 of this embodiment can use a communication bus to connect the first area determination circuit and the second area determination circuit to realize data transmission.

[0108] At the same time, the radar 131 can be connected to the first encoder 111 and the second encoder 112 via a processing circuit, and the processing circuit can calculate the moving distance of the mobile robot during its movement. Furthermore, a map of the current operating area can be stored in the processing circuit, and different areas on the map correspond to different moving distances. Therefore, by comparing the current moving distance and the initial position, the current area of the mobile robot can be determined, and the radar can switch between preset areas, i.e., monitoring areas, based on the output signal of the processing circuit.

[0109] This application establishes a safety control system 1 equipped with multiple monitoring circuits and safety control circuits 14, which can monitor the mobile robot's movement state, whether a collision will occur, whether there is an obstacle within a pre-defined area, etc., thereby improving the reliability of the mobile robot's safety control through multi-faceted monitoring. At the same time, the installation of multiple dual-redundant circuits can improve the accuracy of data acquisition and calculation in the safety control system 1, thereby making the mobile robot equipped with the safety control system 1 compliant with the international safety standard IOS-13849-1 and improving the safety level of the mobile robot.

[0110] Meanwhile, the safety control circuit 14 in the safety control system 1 of the present application can be directly connected to the main control board 16 and the servo circuit 15, which can improve the overall integration of the safety control system 1, simplify the complex circuitry of the safety control system 1, and reduce production costs. At the same time, the main control board 16 and the safety control circuit 14 of the present application can be connected via a communication bus, which can transmit a large amount of data information including at least the motion information of the left and right wheels of the mobile robot, operation mode selection information, monitoring area switching signal, reset information, and start signal, and facilitate the integration of the safety control system 1, which can be integrated into the control panel of the mobile robot, improving the integration of the safety control system 1 and simultaneously reducing production costs.

[0111] The present application further provides a mobile robot, and reference is made to Fig. 8, which is a structural schematic diagram of one embodiment of the mobile robot of the present application. As shown in Fig. 8, the mobile robot 20 includes a main body 21, a plurality of moving devices 22, and a safety control system 23, where the safety control system 23 is the safety control system 1 described in any of the above embodiments, and the description thereof will be omitted here.

[0112] Specifically, the plurality of moving devices 22 are installed on the bottom and / or top of the main body 21 and are used to move the mobile robot 20 in the horizontal direction or the direction of gravity. For example, left and right wheels installed on the bottom of the main body 21 are used to move the mobile robot 20 in the horizontal direction, or a lifting device installed on the top of the main body 21 is used to move the mobile robot 20 in the direction of gravity.

[0113] The safety control system 23 is connected to the motors of the mobile robot 20, and is used to monitor the motion state of the mobile device 22, monitor the movement data of the mobile robot 20 to generate a first safety command, monitor whether the mobile robot 20 collides with an obstacle to generate a second safety command, monitor whether there is an obstacle within a preset range of the mobile robot 20 to generate a third safety command, and / or generate a fourth safety command based on the status information of the safety input device of the mobile robot 20, and control the motors of the mobile robot 20 to execute the corresponding safety command based on the first safety command, the second safety command, the third safety command and / or the fourth safety command.

[0114] The present application further provides a robot, the robot including a carrier, a main body, and a safety control system, wherein the safety control system includes a first monitoring circuit, a second monitoring circuit, a third monitoring circuit, a safety control circuit, a servo circuit, and a main control board, the first monitoring circuit is used to monitor the motion state of the main body and monitor the motion data of the main body, the second monitoring circuit is installed on the outer wall of the main body and is used to generate a collision signal when the main body collides with an obstacle, the third monitoring circuit is used to monitor whether an obstacle exists within a preset range of the main body, and is used to generate an alarm signal when it is detected that an obstacle exists, and the safety control circuit includes: The safety control circuit includes a servo circuit connected to the second monitoring circuit, the third monitoring circuit, and the safety input device of the mobile robot, and is used to generate a first safety command based on the movement data, a second safety command based on the collision signal, a third safety command based on the alarm signal, and a fourth safety command based on the status information of the safety input device. The safety control circuit includes a servo circuit connected to the safety control circuit and is used to receive and execute the first safety command, the second safety command, the third safety command, or the fourth safety command output by the safety control circuit. The main control board is connected to the servo circuit and is used to output a drive control signal to the servo circuit, which causes the servo circuit to control the motor of the mobile robot based on the drive control signal.

[0115] Here, the body is attached to a carrier and can perform motion control in combination with the carrier.

[0116] Optionally, at least one of the robot's control cabinet, main control board, servo circuits, servo drive components, etc. may be mounted on the carrier.

[0117] Here, the body or a part of the body is movably mounted, the movement of the body includes rotation and / or translation, and the movement data includes rotation data and / or translation data, etc.

[0118] In some embodiments, the carrier may include a moving device, which is used to move the mobile robot along the horizontal direction or the gravity direction. In this embodiment, the robot is a fully mobile robot, and the specific operation structure and control thereof may refer to the above embodiments.

[0119] In some embodiments, the carrier includes a base, and the base can be fixed to a workbench or the like to ensure stability of the base during operation of the robot. In this embodiment, the robot is a partially mobile robot, and the main body or a portion of the main body is movable relative to the base. For example, the main body may include a robot arm, and the robot arm may be moved relative to the base, or a portion of the joint of the robot arm may be moved relative to the base. The movable part of the main body may also include at least one of a telescoping cargo frame, an extension shaft, an end effector, a motor, etc.

[0120] The safety control system is connected to the robot's motors and is used to monitor the motion of the robot's body or a moving part mounted on the body, monitor the motion data of the body or the moving part to generate a first safety command, monitor whether the body or the moving part will collide with an obstacle to generate a second safety command, monitor whether an obstacle is present within a preset range of the body or the moving part to generate a third safety command, and / or generate a fourth safety command based on the status information of the robot's safety input device, and control the robot's motors to execute the corresponding safety command based on the first, second, third, and / or fourth safety command. In this manner, the robot of this embodiment is equipped with a safety control system including multiple monitoring circuits and safety control circuits, which can monitor the robot's motion, whether a collision will occur, and whether an obstacle is present within a preset range. This multi-faceted monitoring improves the reliability of the robot's safety control. Meanwhile, the safety control circuit in the safety control system can be directly connected to the servo circuit, which improves the integration of the entire safety control system, simplifies the complex circuitry of the safety control system, and reduces production costs.

[0121] The above is merely an embodiment of the present application, and does not limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made by utilizing the contents of the specification and drawings of the present application, or anything directly or indirectly applicable to other related technical fields, is similarly included within the scope of the claims of the present application.

Claims

1. A safety control system for a mobile robot, comprising: a movement device is installed on the mobile robot; the safety control system of the mobile robot includes a first monitoring circuit, a second monitoring circuit, a third monitoring circuit, a safety control circuit, a servo circuit, and a main control board; the first monitoring circuit is used to monitor the motion state of the mobile device and monitor the movement data of the mobile robot; the second monitoring circuit is installed on an outer wall of the mobile robot and is used to generate a collision signal when the mobile robot collides with an obstacle; the third monitoring circuit is used to monitor whether the obstacle exists within a predetermined range of the mobile robot, and to generate an alarm signal when it is detected that the obstacle exists; the safety control circuit is connected to the first monitoring circuit, the second monitoring circuit, the third monitoring circuit and a safety input device of the mobile robot, and is used to generate a first safety command based on the movement data, generate a second safety command based on the collision signal, generate a third safety command based on the alarm signal, and generate a fourth safety command based on status information of the safety input device; the servo circuit is connected to the safety control circuit and is used to receive and execute the first safety command, the second safety command, the third safety command, or the fourth safety command output by the safety control circuit; the main control board is connected to the servo circuit and is used to output a drive control signal to the servo circuit, so that the servo circuit controls the motor of the mobile robot according to the drive control signal; the safety control circuit includes an input circuit, a logic circuit, and an output circuit; the input circuit is connected to the safety input device and is used to obtain status information of the safety input device; the logic circuit is connected to the input circuit and is used to generate the fourth safety command based on state information of the safety input device; the output circuit is connected to the logic circuit and the servo circuit and is used to send the fourth safety command to the servo circuit; 1. A safety control system for a mobile robot, wherein the logic circuit includes two primary circuits each connected to the input circuit and connected to each other, and at least one secondary circuit connected to each primary circuit and the output circuit.

2. The safety control circuit further includes a state monitoring module and a mode switching module; the state monitoring module is used to monitor an operating state of the mobile robot and generate a mode switching signal based on the operating state of the mobile robot; 2. The safety control system for a mobile robot according to claim 1, wherein the mode switching module is connected to the status monitoring module and a logic circuit, the mode switching module is used to generate a mode signal based on the mode switching signal, and the logic circuit is used to generate the fourth safety command based on the mode signal and status information of the safety input device.

3. the moving device includes a left wheel and a right wheel; the left wheel and the right wheel are used to move the mobile robot along a horizontal direction; 2. The safety control system for a mobile robot according to claim 1, wherein the first monitoring circuit includes a first encoder and a second encoder, and the first encoder and the second encoder are used to monitor the left wheel and the right wheel, respectively, to obtain information on the moving speed, position, and direction of the mobile robot.

4. the safety control circuit further includes a first diagnostic circuit; 4. The safety control system for a mobile robot according to claim 3, wherein the first diagnostic circuit is connected to the first encoder and the second encoder, and is used to monitor the motion states of the left wheel and the right wheel based on monitoring data from the first encoder and monitoring data from the second encoder.

5. the safety control circuit further includes a decoding circuit and a second diagnostic circuit; the decoding circuit is connected to the first encoder and the second encoder, and is used to decode the monitoring data of the first encoder to obtain a speed signal and a direction signal of the left wheel, and to decode the monitoring data of the second encoder to obtain a speed signal and a direction signal of the right wheel; 4. The safety control system for a mobile robot according to claim 3, wherein the second diagnostic circuit is connected to the decoding circuit and is used to determine whether the left wheel is abnormal based on the speed signal and / or direction signal of the left wheel, to determine whether the right wheel is abnormal based on the speed signal and / or direction signal of the right wheel, and to determine whether the mobile robot will overrun based on the speed signal of the left wheel and the speed signal of the right wheel.

6. the third monitoring circuit includes a radar; the safety control circuit includes a decoding circuit and a region determination circuit; the decoding circuit is connected to the first encoder and the second encoder, and is used to decode the monitoring data of the first encoder to obtain a speed signal and a direction signal of the left wheel, and to decode the monitoring data of the second encoder to obtain a speed signal and a direction signal of the right wheel; the region determining circuit is connected to the decoding circuit and is used for generating region information according to the left wheel speed signal, the left wheel direction signal, the right wheel speed signal, and the right wheel direction signal; 4. The safety control system for a mobile robot according to claim 3, wherein the radar is connected to the area determination circuit and is used to switch the predetermined area of the mobile robot based on the area information.

7. the moving device includes an elevator device, and the elevator device is used to move the mobile robot along the direction of gravity; 2. The safety control system for a mobile robot according to claim 1, wherein the first monitoring circuit includes a third encoder, and the third encoder is used to monitor the lifting device and obtain the lifting height and rotation angle of the lifting device.

8. 2. The safety control system of claim 1, wherein the second monitoring circuit includes at least one of an edge sensor or an anti-collision strip.

9. A mobile robot including a main body, a moving device, and the safety control system for a mobile robot according to any one of claims 1 to 8, the moving device is installed on the bottom or top of the main body and is used to move the mobile robot along a horizontal direction or a gravity direction; The safety control system of the mobile robot is used to monitor the motion state of the mobile device, monitor the movement data of the mobile robot to generate a first safety command, monitor whether the mobile robot collides with an obstacle to generate a second safety command, monitor whether the obstacle exists within a preset range of the mobile robot to generate a third safety command, and / or generate a fourth safety command based on status information of a safety input device of the mobile robot, and control the motors of the mobile robot to execute the corresponding safety commands based on the first safety command, the second safety command, the third safety command and / or the fourth safety command.

10. A robot including a carrier, a body, and a safety control system, the body is attached to the carrier and performs motion control in combination with the carrier; the safety control system includes a first monitoring circuit, a second monitoring circuit, a third monitoring circuit, a safety control circuit, a servo circuit, and a main control board; the first monitoring circuit is used to monitor the motion state of the body and monitor motion data of the body; the second monitoring circuit is installed on an outer wall of the body and is used to generate a collision signal when the body collides with an obstacle; the third monitoring circuit is used to monitor whether the obstacle exists within a preset range of the main body, and generate an alarm signal when it is detected that the obstacle exists; the safety control circuit is connected to the first monitoring circuit, the second monitoring circuit, the third monitoring circuit and a safety input device of the robot, and is used to generate a first safety command based on the motion data, generate a second safety command based on the collision signal, generate a third safety command based on the alarm signal, and generate a fourth safety command based on status information of the safety input device; the servo circuit is connected to the safety control circuit and is used to receive and execute the first safety command, the second safety command, the third safety command, or the fourth safety command output by the safety control circuit; the main control board is connected to the servo circuit and is used to output a drive control signal to the servo circuit, so that the servo circuit controls the motor of the robot based on the drive control signal; the safety control circuit includes an input circuit, a logic circuit, and an output circuit; the input circuit is connected to the safety input device and is used to obtain status information of the safety input device; the logic circuit is connected to the input circuit and is used to generate the fourth safety command based on state information of the safety input device; the output circuit is connected to the logic circuit and the servo circuit and is used to send the fourth safety command to the servo circuit; The logic circuit includes two primary circuits each connected to the input circuit and connected to each other, and at least one secondary circuit connected to each primary circuit and the output circuit.

Images