Patent Application
20190061155
This application claims the priority benefit of Japan application serial no. 2017-161770, filed on Aug. 25, 2017. The entirety of the above-mentioned patent application is hereby incorporated by reference herein and made a part of this specification.
The present disclosure relates to a technology for realizing cooperative work between a robot and a moving body.
Conventionally, work performed simultaneously by a robot and a worker (person) in the same space (cooperative work) has increased at production sites. In such cooperative work, it is necessary to prevent injury to a worker and failure of a robot due to contact (collision) between the robot and the worker.
For example, in Patent Document 1, deceleration of a speed at which a robot can move according to a condition considering a distance between a worker and the robot, and provision of a robot entry prohibition region for performing control of not allowing the robot to enter was investigated.
In addition, in Patent Document 2, control for performing deceleration and emergency stop of a robot using a distance between the robot and a worker was investigated.
[Patent Document 1] Japanese Laid-open No. 4648486
[Patent Document 1] Japanese Laid-open No. 5370127
However, in order to secure a distance at which a robot and a worker are safe, it was necessary to secure a maximum region in which the robot can move. In addition, when a robot is decelerated using a distance between the robot and a worker, it is necessary to decelerate the robot even if the worker does not move, and thus productivity is reduced. Here, a worker is taken as an example, but the same may be applied to other moving bodies.
In the present disclosure, collision between a robot and a moving body is prevented while the robot is moving without increasing a distance between the robot and the moving body to secure safety of the moving body.
The robot control device of the present disclosure is configured as follows.
A robot arm which is able to move about a support point, a detection unit which detects a relative positional relationship with a moving body, a control unit which generates a drive control signal of an actuator which causes the robot arm to be able to move on the basis of a change in the relative positional relationship between the robot arm and the moving body detected by the detection unit, and an output unit which outputs the drive control signal generated by the control unit to the actuator are provided.
Hereinafter, embodiments of the present disclosure will be described.
The detection unit detects the relative positional relationship between the robot arm and the moving body by a sensor attached to the robot arm. The control unit generates the drive control signal which changes a speed at which the robot arm is able to move in accordance with a change in the relative positional relationship with the moving body.
According to this configuration, it is possible to detect a relative positional relationship between the robot arm and the moving body, and generate the drive control signal of the actuator which causes the robot arm to be able to move. The output unit outputs the drive control signal to the actuator. Thereby, it is possible to detect a relative positional relationship between the robot arm and the moving body by the sensor attached to the robot arm, and it is possible to generate the drive control signal which changes a speed at which the robot arm is able to move in accordance with a change in the relative positional relationship with the moving body.
Therefore, it is possible to control the robot using the relative positional relationship between the robot arm and the moving body. Since unnecessary deceleration and emergency stop of the robot can be prevented, productivity is improved.
The robot arm may include the support point formed on one end portion thereof and the sensor attached to the other end portion thereof. With such a configuration, the robot arm can detect a relative position of the moving body at a position at which a distance to the moving body is furthest, that is, a position at which the robot arm and the moving body are most likely to collide, and thus it is possible to reduce the number of sensors.
The control unit may generate the drive control signal using a relative speed between the robot arm and the moving body calculated from a change in the relative positional relationship between the robot arm and the moving body. With such a configuration, it is possible to generate the drive control signal by acquiring the relative speed according to a change in the relative positional relationship between the robot arm and the moving body. Further, it is possible to calculate the relative positional relationship (distance) from the relative speed.
The control unit may generate the drive control signal using a relative distance between the robot arm and the moving body calculated from a change in the relative speed between the robot arm and the moving body. With such a configuration, it is possible to generate a drive control signal by acquiring the relative distance due to a change in the relative speed between the robot arm and the moving body. Further, it is possible to calculate the relative speed from the relative distance.
The control unit may generate the drive control signal for stopping the robot arm when the relative distance between the robot arm and the moving body is shorter than a predetermined stopped distance. With such a configuration, when the robot arm enters a distance assumed to be safe in advance, it is possible to instantly stop the robot.
The control unit may generate the drive control signal for decelerating or accelerating the robot arm when the relative distance between the robot arm and the moving body is longer than a predetermined stopped distance. With such a configuration, an unnecessary emergency stop of the robot can be prevented, and productivity can be improved.
According to the present disclosure, it is possible to secure safety of the moving body when the robot is able to move without increasing the distance between the robot and the moving body.
The support points 12, 12A and 12B can be moved as joints of the robot 1. The robot 1 includes an actuator as a drive mechanism for moving these joints.
A distance between the robot and a moving body in the present disclosure refers to a distance between a position of the robot hand 10 farthest from a base point of the robot base 20 and the moving body. In other words, this is a distance between an end of a maximum range of the robot at that time and the moving body. A range in which the robot can move varies depending on the number of joints (number of axes).
The sensor 15 of the robot 1 detects a relative positional relationship with the worker 2. The worker 2 is a moving body in the present disclosure. The controller 3 is a control unit of the present disclosure.
The sensor 15 is formed as, for example, a displacement sensor, an ultrasonic sensor, a millimeter wave sensor, an optical sensor, or the like. A relative position detected by the sensor 15 is three-dimensional if the robot hand 10 (robot arm 11) can move in three dimensions. Further, the relative position detected by the sensor 15 is two-dimensional if the robot hand 10 (robot aim 11) can move in two dimensions.
The sensor 15 continuously detects the relative position at predetermined time intervals. It is assumed that the worker 2 moves in a worker movement direction, and similarly, the robot hand 10 moves in a robot arm movement direction.
The sensor 15 calculates a relative speed between the worker 2 and the robot hand 10. The sensor 15 transmits the calculated relative speed as sensing data to the controller 3.
The controller 3 generates a drive control signal based on a predetermined risk determination of the sensing data. The controller 3 transmits the drive control signal to the robot 1. When the drive control signal is received, the robot 1 transmits the drive control signal to actuators provided in the support points 12, 12A and 12B.
Here, the risk determination refers to a prescribed value determined so that the robot 1 and the worker 2 are capable of moving safely without collision.
Referring to a functional block diagram of
The sensing unit 15A is a sensing element and outputs a sensor signal corresponding to the positional relationship between the sensor 15 including the sensing unit 15A itself and the worker 2 to the detection unit 15B.
The detection unit 15B calculates the relative positional relationship of the sensor 15 with respect to the worker 2 using the sensor signal.
The detection unit 15B outputs the relative positional relationship to the controller connection unit 15C. The controller connection unit 15C transmits the relative positional relationship to the sensing device connection unit 3A.
The sensing device connection unit 3A receives the relative positional relationship from the controller connection unit 15C. The sensing device connection unit 3A transmits the relative positional relationship to the separation distance estimating function unit 31B.
The separation distance estimating function unit 31B calculates a relative speed of the sensor 15 and the worker 2 from a temporal change of the relative positional relationship. Also, a stopped relative distance when an emergency stop occurs is calculated from the relative positional relationship.
The separation distance estimating function unit 31B transmits the stopped relative distance and the relative speed to the risk determination function unit 32B.
The risk determination function unit 32B transmits the drive control signal generated by the predetermined risk determination to the output unit 3C on the basis of the stopped relative distance and the relative speed.
The output unit 3C transmits the drive control signal to the actuator of the robot 1.
When the sensor 15 is a speed sensor which senses a speed, the relative speed between the sensor 15 and the worker 2 is acquired, and the separation distance estimating function unit 31B can calculate a relative positional relationship by integrating the relative speeds.
When it is assumed that a distal end of the robot 1 is the robot hand 10, the robot hand 10 may move along a trajectory of a point RA1, a point RA2, and a point RA3 toward the worker 2 (in a robot traveling direction). In
In addition, the worker 2 moves along a trajectory of a point SA1, a point SA2, and a point SA3 toward the robot 1 (in a worker traveling direction). Further, the points RA1 and SA1, the points RA2 and SA2, and the points RA3 and SA3 indicate respective positions of the robot 1 and the worker 2 at the same time.
The stopped relative distance refers to a relative distance between the robot hand 10 (robot 1) and the worker 2 at the time when the robot hand 10 is assumed to have been stopped.
The robot 1 moves at a speed vr1 at the point RA1, a speed vr2 at the point RA2, and a speed vr3 at the point RA3. A magnitude relation of the speed is vr1>vr2>vr3 (=0). The worker 2 moves at a speed vs1 at the point SA1, the speed vs2 at the point SA2, and the speed vs3 at the point SA3. Further, the speed vs1, the speed vs2, and the speed vs3 are variable, but may also be constant.
When an emergency stop of the robot hand 10 is performed at the point RA1, the controller 3 calculates the stopped relative distance with the worker 2. Further, it is assumed that the robot hand 10 stops at the point RA3.
At the point RA1, it is assumed that the controller 3 has made an emergency stop on the robot hand 10 moving at the speed vr1.
Despite having made an emergency stop, the robot hand 10 does not stop at the point RA2 due to inertia of the robot hand 10 and decelerates from the speed vr1. For example, it decelerates from the speed vr1 and further decelerates via the speed vr2.
At the point RA3, the robot hand 10 has a speed lower than the speed vr2, that is, the speed vr3 at which the speed is 0, and stops.
A distance calculated from a position of the robot hand 10 at the point RA3 and a position of the worker 2 at the point SA3 is the stopped relative distance.
A flow of the control of the sensor and the controller using the relative positional relationship calculated by the configuration illustrated in
The sensor 15 acquires a relative distance with the worker 2 (S1). Also, the sensor 15 acquires a relative speed with the worker 2.
The controller 3 estimates a relative distance at the time of emergency stop (S2). The relative distance at the time of emergency stop is a distance between the robot hand 10 and the worker 2 when the robot hand 10 is stopped in a case in which an emergency stop is performed at a current relative distance and current relative speed. That is, when the robot 1 and the worker 2 move forward to a certain point, it is a distance calculated by estimating a case in which an emergency stop is performed at an arbitrary point of time. This is the stopped relative distance.
For example, a relative distance and a relative speed of the distal end of the robot 1, that is, the sensor 15 attached to the robot hand 10 and the worker 2 are calculated. At this time, when an emergency stop is performed, a distance between the robot hand 10 and the worker 2 when the robot hand 10 is stopped is calculated assuming that the robot hand 10 decelerates while the worker 2 does not decelerate.
When the stopped relative distance is a positive value (S3: Yes), the controller 3 determines whether or not the stopped relative distance is smaller than a predetermined stopped distance PD (S4). The positive value in the stopped relative distance means that there is a distance in which the robot hand 10 does not collide with the worker 2 when an emergency stop is made at the present point of time.
When the stopped relative distance is smaller than the stopped distance PD (S4: Yes), the controller 3 decelerates the robot hand 10 while maintaining its moving direction (S5) with respect to the robot 1. That is, the robot hand 10 decelerates while maintaining the trajectory of the robot hand 10. The stopped relative distance smaller than the stopped distance PD means that the robot hand 10 and the worker 2 come close to each other when the robot 1 and the worker 2 move while maintaining the relative speed.
At this time, the deceleration speed is set to satisfy a condition in which the stopped relative distance>PD.
The controller 3 acquires another relative position and relative speed, and determines whether or not the stopped relative distance is smaller than the stopped distance PD (S6). When the stopped relative distance is smaller than the stopped distance PD (S6: Yes), the robot is emergently stopped (S7).
When the stopped relative distance is not a positive value (S3: No), the controller 3 emergently stops the robot hand 10 (S7).
When the stopped relative distance is greater than the stopped distance PD (S4: No), it is determined that the distance between the robot 1 and the worker 2 is sufficient, the robot accelerates to a speed at which it can be accelerated or moves at a constant speed (S11), and another relative speed is acquired (S1).
When the stopped relative distance is greater than the stopped distance PD (S6: No), another relative speed is acquired (S1).
As a result, the robot 1 and the worker 2 can perform a safe cooperative work without collision. Further, a distance at which a movable portion of the robot and the moving body can be prevented from colliding can be made smaller than a conventional configuration.
In the description using the flow described above, the description has been given on the premise that the relative distance and the relative speed between the robot 1 and the worker 2 are detected, however, when only a relative distance is acquired, a relative speed can be acquired by differentiating the relative distance.
Also, when the sensor 15 acquires a relative speed, it is preferable to use a Doppler sensor.
Further, the relative speed described above is specifically calculated as follows. In the following description, a case using a two-dimensional relative speed is taken as an example.
Referring to
As illustrated in
An axis connecting the robot base 20 (support point 12) to which the robot 1 is fixed and the worker 2 in a straight line is defined as an X axis. An axis perpendicular to the X axis is defined as a Y axis. An angle between the relative speed vector Vt and the X axis is defined as θ1. As a result, an equation for calculating a relative speed Vx of the sensor 15 in the robot 1 with respect to the worker 2 is Vx=Vt×cos θ1.
Since the relative speed Vx in a direction connecting the robot 1 and the worker 2 can be calculated, most effective relative speed when performing an emergency stop can be calculated, and thereby safety of the cooperative work of the robot and the human can be improved.
Referring to
As illustrated in
Referring to
An axis connecting the robot base 20 (support point 12) to which the robot 1 is fixed and the worker 2 in a straight line is defined as an X axis. An axis perpendicular to the X axis is defined as a Y axis. An angle between the relative speed vector Vt2 and the X axis is defined as θ2. As a result, an equation for calculating a relative speed Vx of the sensor 15 in the robot 1 with respect to the worker 2 is Vx=Vt2×cos θ2.
Even when the robot hand 10 moves in the rotating direction, since the relative speed Vx in the direction connecting the robot hand 10 and the worker 2 can be calculated, a more accurate relative speed can be calculated, and thereby safety of the cooperative work of the robot and the person can be improved.
When the above-described configuration is used, it is possible for the robot and the worker to perform cooperative work more safely without increasing a distance at which the movable portion of the robot and the moving body can be prevented from colliding. In addition, since a distance between the robot and the worker when the robot emergently stops is shorter than a distance based on the prescribed risk determination as in a conventional case, unnecessary stopping of the robot does not occur and productivity can be maintained high.
Also, in the above description, when the distance between the robot and the worker is sufficiently greater than the distance based on the prescribed risk determination, since the speed of the robot can be accelerated, unnecessary efficiency reduction is prevented.
Further, in the above description, the method of calculating the stopped relative distance and the relative speed in the control unit has been described. However, the relative distance and the relative speed may be calculated by a detection unit.
In addition, since other safety protection measures are unnecessary, additional investment (material cost, design, maintenance man-hour) for protecting the robot and the worker can be reduced.
In the above example, the relative speed between the robot and the worker is acquired by attaching a sensor to the distal end of the robot (the robot hand in the above example). However, the same effect can be obtained when a sensor is attached to each of the support points (joints) of the robot. Further, when the relative speed or the relative distance is sensed by each sensor of the support points (joints), more detailed sensing data can be obtained, and thereby safety can be improved further.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2017-161770 | Aug 2017 | JP | national |
