Patent Application
20220126450
The present invention is related to a robot, and more particularly to a control system and method related to a follow selection mechanism of a robot safety state.
With the vigorous development of robot technology, factories use robots to assist operators in rapid processing, assembly and manufacturing operations and improve factory production efficiency, but high-speed robots seriously affect the safety of operators, so the safety control of robot working environment constitutes the main issue of maintaining the safety of robot operations.
Many factories choose robots to replace part of manpower. Therefore, in the system integration environment of the factory, for example, a robot is installed on a track, and the movement of the track is used to drive the robot to move in the working environment. A sensing device is also provided to monitor workers and other foreign objects entering and leaving the working environment of the robot. The robot, track and sensing device are integrated and controlled by a controller to maintain the safety of the robot. Once the sensing device detects a foreign object entering the robot's working environment during the robot operation, the sensing device is triggered, and the sensing device will notify the controller to take the robot and the track to a safety state such as stopping or slowing down. When the sensing device detects that the foreign object has left the working environment of the robot, the controller is notified to control the robot and the track leaving the safety state, and return to the original working state, thereby ensuring the safety of personnel and robot.
However, integrated devices usually include lower-level and higher-level controlled devices. Lower-level controlled devices such as tracks are directly controlled by the controller, and higher-level controlled devices, such as robots, have a variety of job settings, for the sake of safety, usually set that after the higher-level controlled devices are stopped, the personnel must confirm the safety before restarting. Therefore, when a foreign object has completely passed through or has entered an area that cannot be sensed by the sensing device, although the stopped robot has yet to be confirmed to restart, the controller controls the track to automatically leave the safety state and start to move, driving the robot to move, which can cause collision damage to the robot, posing a risk of safety in use. In addition, if all controlled devices are started or stopped according to the detection of the sensing device, and settings cannot be adjusted according to the characteristics of the integrated system, integration flexibility is also lost. In view of the above problems, there are still problems to be solved in controlling the safety of the robot.
An object of the present invention is to provide a system and method for controlling the safety state of a robot, by using a selection device to select to follow a sensing device or a controlled device, the safety state of other controlled devices is set to follow the followed device to improve the flexibility and safety of robot integration.
In order to achieve the purpose of the foregoing invention, the robot safety control system of the present invention is equipped with a sensing device to detect an object entering and leaving the working environment, and generate a sensing signal accordingly. In the working environment, a safety state of a plurality of controlled devices is selected by a selection device to follow a controlled device or the sensing device. The controller connects the sensing device, a plurality of controlled devices and the selection device. The controller has a first output state and a second output state. The first output state controls the plurality of controlled devices to enter the safety state. The second output state controls the plurality of controlled devices to exit the safety state. When the selection device selects to follow the sensing device, the controller receives the entry or exit sensing signal of the sensing device and sends the first output state or the second output state to the plurality of controlled devices to enter or exit the safety state. When the selection device chooses to follow a controlled device, and the controller receives the entry sensing signal of the sensing device, the controller sends the first output state to the plurality of controlled devices to enter the safety state. When the controller receives the exit sensing signal of the sensing device, the controller sends the second output state to the followed controlled device, and then controls the safety state of other controlled devices according to the safety state of the followed controlled device.
The method for controlling the safety state of a robot of the present invention comprises first choosing to follow a sensing device or a controlled device, and using the sensing device to sense an object in and out of the working environment. When detecting a sensing signal for entering the working environment, generate a first output state to controlled devices to enter the controlled devices into a safety state. When detecting a sensing signal for leaving the working environment, and the sensing device is being followed, generate a second output state to follow the sensing signal of the sensing device, and send the second output state to the controlled devices according to the sensing signal to exit the safety state and perform normal operations. When detecting a sensing signal for leaving the working environment, and a controlled device is being followed, generate a second output state to follow the safety state of the controlled device, and send the second output state to the controlled device. When the controlled device exits the safety state, the second output state is sent to other controlled devices to exit the safety state.
These and other objectives of the present invention will no doubt become obvious to those of ordinary skill in the art after reading the following detailed description of the preferred embodiment that is illustrated in the various figures and drawings.
In order to achieve the above-mentioned purpose, the technical means and their effects of the present invention are described below with examples and drawings.
Please refer to
In
The selection device 6 of the control system 1 of the present invention uses a switch to select the controller 2 to output a safety state to follow a controlled device or the sensing device 3. When the selection device 6 selects to follow the sensing device 3, the controller 2 sends the first output state or the second output state to the first controlled device 4 and the second controlled device 5 according to the sensing signal S30 of the sensing device 3 to enter or exit the safety state. When the selection device 6 chooses to follow the second controlled device 5, the controller 2 sends the first output state to the first controlled device 4 and the second controlled device 5 according to the sensing signal S30 of the sensing device 3 to enter the safety state, and sends the second output state to the first controlled device 4 and the second controlled device 5 to exit the safety state according to the safety state of the second controlled device 5. In addition, although the selection device 6 in this embodiment is a switch, and the selection device 6 can be set outside the controller 2, that is, the controller 2 is externally connected to the selection device 6, the selection device 6 can be set inside the controller 2, can be a physical switch set on the first controlled device 4 or the second controlled device 5, or can be externally connected to the first controlled device 4 or the second controlled device 5 to achieve the objective of the present invention.
As shown in
When the control system for the safety state of the robot of the present invention is operating, the selection device 6 is first used to select the object to follow. When the selection device 6 selects to follow the sensing device 3, the controller 2 sets the first output state and the second output state to follow the sensing signal S30 of the sensing device 3 according to the selection signal of the selection device 6. Therefore, when the sensing device 3 senses that the object 8 enters or exits the working environment 7, the sensing signal S30 changes accordingly. When the sensing device 3 senses that the object 8 enters the working environment 7, the controller 2 sends the first output state to the first controlled device 4 and the second controlled device 5, and turns the first controlled device 4 and the second controlled device 5 to the safety state according to the sensing signal S30. When the sensing device 3 senses that the object 8 leaves the working environment 7, the controller 2 sends a second output state to the first controlled device 4 and the second controlled device 5 to exit the safety state of the first controlled device 4 and the second controlled device 5 according to the sensing signal S30. And the first controlled device 4 and the second controlled device 5 return to the normal operations.
But when the selection device 6 selects to follow the second controlled device 5, the controller 2 sets the first output state to follow the sensing device 3 and the second output state to follow the second controlled device 5 according to the selection signal of the selection device 6. Therefore, when the sensing device 3 senses that the object 8 enters the working environment 7, the controller 2 sends the first output state to the first controlled device 4 and the second controlled device 5 according to the sensing signal S30 to take the first controlled device 4 and the second controlled device 5 to the safety state. When the sensing device 3 senses that the object 8 leaves the working environment 7, the controller 2 only sends the second output state to the second controlled device 5. If the second controlled device 5 has left the safety state due to automatic reset, then the controller 2 sends the second output state to the first controlled device 4, and exits the safety state of the first controlled device 4 so that the first controlled device 4 can perform normal operations. If after receiving the second output state, the second controlled device 5 still stays in the safety state due to manual reset, then the controller 2 does not send the second output state to the first controlled device 4, so that the first controlled device 4 can also stay in the safety state. The controller 2 would then send the second output state to the first controlled device 4 when the second controlled device 5 changes to leave the safety state due to manual reset, so that the first controlled device 4 can exit the safety state and perform normal operations.
In addition, the reset device 9, the selection device 6, the sensing device 3, the first controlled device 4, and the second controlled device 5 are mere examples for illustration. The present invention includes but is not limited to this embodiment. The quantity can be reduced or increased according to requirement. Alternatively, the first controlled device 4 and the second controlled device 5 may be controlled by different controllers, and the following state may be set between the two controllers, which all belong to the scope of the present invention.
Please refer to
In step S07, if the followed device is a controlled device, go to step S10 to set the second output state to follow the safety state of the controlled device, and then to step S11 to send the second output state to the followed controlled device. In step S12, check if the followed controlled device has left the safety state? If the followed controlled device has not left the safety state, go to step S13, do not send the second output state to other controlled devices to maintain their safety state, and return to step S12 to continue to check the safety state of the followed controlled device. If the followed controlled device has left the safety state, go to step S14 to send the second output state to other controlled devices to exit their safety state.
In summary, the system and method for controlling the safety state of the robot of the present invention can use the selection device to select to follow the sensing device or a controlled device, and set the safety state of other controlled devices to follow the followed device. When the sensing device detects an object leaves the working environment, the controlled devices are controlled to exit the safety state according to the state of the followed device to enter the normal operation, so as to achieve the safety of the robot integration in the present invention.
Those skilled in the art will readily observe that numerous modifications and alterations of the device and method may be made while retaining the teachings of the invention. Accordingly, the above disclosure should be construed as limited only by the metes and bounds of the appended claims.
| Number | Date | Country | Kind |
|---|---|---|---|
| 109137548 | Oct 2020 | TW | national |
