This application is based upon and claims the benefit of priority of the prior Japanese Patent Application No. 2020-187982, filed on Nov. 11, 2020, the entire contents of which are incorporated herein by reference.
The embodiment discussed herein is related to an operation control technology.
In recent years, to reduce teaching work of teaching operations to industrial robot arms, research is advancing on automating the teaching work by applying a machine learning technology such as deep reinforcement learning and recurrent neural networks to attitude control of robot arms. In the deep reinforcement learning, training needs a large cost (many trials) and a long time. Thus, in a case where there are restrictions on a cost and a training time, methods using the recurrent neural networks such as a recurrent neural network (RNN) and a long short-term memory (LSTM) are used.
Japanese Laid-open Patent Publication No. 2018-089728, Japanese Laid-open Patent Publication No. 2020-062701, and U.S. Patent Application Publication No. 2019/0091864 are disclosed as related art.
According to an aspect of the embodiments, a non-transitory computer-readable recording medium stores an operation control program for causing a computer to execute processing including: detecting a position of an object included in an operating environment of a device; specifying an operation path of the device on the basis of an operation position of the device and the position of the object; generating first operation information on the basis of the operation path and reference information that associates position information of a plurality of points included in the operating environment with operation information that represents an operating state of the device when the plurality of points are the operation positions; and controlling the device on the basis of the first operation information.
The object and advantages of the invention will be realized and attained by means of the elements and combinations particularly pointed out in the claims.
It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory and are not restrictive of the invention.
On the other hand, development of a robot arm assuming collaboration with humans is advancing, and a technology that prevents collision between the robot arm and another object is needed. Thus, there is a technology that detects an obstacle by using a camera image or a sensor, specifies three-dimensional position coordinates (x, y, z), and prevents collision between a robot arm and the obstacle.
However, since a track of the robot arm is determined by attitude information of an operation set in advance or machine-learned operation, it is not possible to perform an irregular operation that is not set in advance or machine-learned, such as avoiding an unexpected obstacle. Thus, when the obstacle is detected, an operation of the robot arm needs to be uniformly stopped in an emergency, which causes a problem that a work load and time for unnecessary restarting are needed.
In one aspect, an operation control program, an operation control method, and an operation control apparatus that are capable of generating a track of a robot arm for avoiding an obstacle may be provided.
Hereinafter, embodiments of an operation control program, an operation control method, and an operation control apparatus according to the present embodiment will be described in detail with reference to the drawings. Note that the embodiments do not limited the present embodiment. Furthermore, each of the embodiments may be appropriately combined within a range without inconsistency.
First, an operation control system for implementing the present embodiment will be described.
The operation control apparatus 10 is, for example, an information processing apparatus such as a desktop personal computer (PC), a notebook PC, or a server computer used by an administrator who manages the robot arm 100. The operation control apparatus 10 detects an object in an operating environment of the robot arm 100, generates an operation path and operation information of the robot arm 100 for avoiding the object, and controls the robot arm 100. Note that the object detected in the operating environment of the robot arm 100 may be referred to as an obstacle regardless of whether or not there is a possibility of actually colliding with the robot arm 100.
Note that, although the operation control apparatus 10 is illustrated as one computer in
The robot arm 100 is, for example, a robot arm for industrial use, and is, more specifically, a picking robot that picks up (grips) and moves an article in a factory, a warehouse, or the like.
The camera device 200 captures, from a side of or above the robot arm 100, an image of an operating environment of the robot arm 100, for example, a range in which the robot arm 100 may operate. The camera device 200 captures the image of the operating environment in real time while the robot arm 100 is operating, and the captured image is transmitted to the operation control apparatus 10. Note that, although only one camera device 200 is illustrated in
[Functional Configuration of Operation Control Apparatus 10]
Next, a functional configuration of the operation control apparatus 10 illustrated in
The communication unit 20 is a processing unit that controls communication with another device such as the robot arm 100 or the camera device 200, and is, for example, a communication interface such as a universal serial bus (USB) interface or a network interface card.
The storage unit 30 is an example of a storage device that stores various types of data and a program executed by the control unit 40, and is, for example, a memory, a hard disk, or the like. The storage unit 30 stores position information 31, attitude information 32, an image database (DB) 33, a machine learning model DB 34, and the like.
The position information 31 stores three-dimensional position information of a plurality of imaginary points preset in a space within an operation range of the robot arm 100. The imaginary points are, for example, apexes of each triangular pyramid when triangular pyramids of a predetermined size are arranged side by side so as to fill the space within the operation range of the robot arm 100.
The attitude information 32 is information for controlling an operation of the robot arm 100, and stores information indicating an angle of the axis of each joint of the robot arm 100. The attitude information 32 of a normal operation in a case where no obstacle is detected in an operating environment of the robot arm 100 is created in advance, or the attitude information 32 of the next operation is determined by a machine learning model. Furthermore, for example, in the case of the six-axis robot arm illustrated in
The image DB 33 stores a captured image of the operating environment of the robot arm 100 captured by the camera device 200. Furthermore, the image DB 33 stores a mask image indicating a region of an obstacle, which is output by inputting the captured image to an object detector.
The machine learning model DB 34 stores, for example, model parameters for constructing an object detector generated by machine learning using a captured image of the operating environment of the robot arm 100 as a feature amount and a mask image indicating a region of an obstacle as a correct label, and training data for the object detector.
Furthermore, the machine learning model DB 34 stores, for example, model parameters for constructing a recurrent neural network (RNN) generated by machine learning using current attitude information 32 as a feature amount and future attitude information 32 as a correct label, and training data for the RNN.
Note that the information described above stored in the storage unit 30 is merely an example, and the storage unit 30 may store various types of information other than the information described above.
The control unit 40 is a processing unit that controls the entire operation control apparatus 10 and is, for example, a processor. The control unit 40 includes a detection unit 41, a specification unit 42, a generation unit 43, and a device control unit 44. Note that each processing unit is an example of an electronic circuit included in a processor or an example of a process executed by the processor.
The detection unit 41 detects a position of an object included in an operating environment of a device such as the robot arm 100. More specifically, the detection unit 41 may specify a region of the object in an image obtained by capturing the operating environment of the device such as the robot arm 100 by using the camera device 200 from at least one direction such as a side of or above the device, and detect the position of the object. Note that the region of the object may be specified from a mask image output by using, for example, an object detector generated by machine learning using the captured image of the operating environment of the robot arm 100 as a feature amount and a mask image indicating a region of an obstacle as a correct label.
Furthermore, a plurality of the camera devices 200 may capture images of the operating environment from a plurality of directions such as a side of and above the device. In this case, the detection unit 41 specifies the region of the object in each image captured from each direction, and detects the position of the object. Note that, by capturing the images of the operating environment from the plurality of directions such as the side of and above the device by the plurality of camera devices 200, the detection unit 41 may also specify the region of the object in each image captured from each direction, and detect the position of the object three-dimensionally.
Furthermore, the detection unit 41 detects that the object has disappeared from the operating environment of the device such as the robot arm 100. With this configuration, an operation of the device that has been operated so as to avoid the object may be returned to a normal operation.
The specification unit 42 specifies, on the basis of an operation position of a device such as the robot arm 100 and a position of an object, an operation path of the device. More specifically, for example, on the basis of the position information 31 of a plurality of imaginary points preset in a space within an operation range of the robot arm 100 and a position of an object detected by the detection unit 41, the specification unit 42 calculates a distance between each of the plurality of imaginary points and the object. Then, the specification unit 42 uses position information of imaginary points with the calculated distance is equal to or lower than a predetermined threshold to set a predetermined region including the object as a region where path search is not possible, and specifies the operation path of the device on the basis of the operation position of the device so as to avoid the region.
The generation unit 43 generates the attitude information 32 to enable operation along an operation path on the basis of reference information that associates the position information 31 of a plurality of imaginary points with the attitude information 32 that is operation information representing an operating state of the device when the imaginary points are the operation positions, and the operation path specified by the specification unit 42. For example, points are set at regular intervals on the specified operation path, and on the basis of the reference information that associates the position information 31 of the plurality of imaginary points with the attitude information 32 of the device when the imaginary points are the operation positions, the attitude information 32 of the device when the point at the regular intervals are the operation positions is interpolated and calculated.
The device control unit 44 controls a device such as the robot arm 100 on the basis of the attitude information 32 generated by the generation unit 43. With this configuration, the device may operate to avoid an object. Furthermore, in a case where the detection unit 41 detects that the object has disappeared from an operating environment of the device, the device control unit 44 returns the attitude information 32 to the attitude information 32 of the normal operation to control the device. As described above, the attitude information 32 of the normal operation is the attitude information 32 for performing an operation in a case where an obstacle is not detected, which is created and set in advance or determined by a machine learning model.
[Details of Functions]
Next, each function will be described in detail with reference to
An object detector 50 illustrated in
In
Next, imaginary points preset in a space within an operation range of a device such as the robot arm 100 will be described.
Thus, for example, in order to detect a position of the object that may be an obstacle, triangular pyramids of a predetermined size are arranged side by side so as to fill a space within the operation range 400, for example, imaginary points 410, which are apexes of each triangular pyramid, are set, and the position information 31 of each point is stored. Note that, in the example of
Note that a length of one side of a triangular pyramid may be set to, for example, 20 cm (centimeters), but the length of one side is not limited to this length. Furthermore, the triangular pyramids and imaginary points 410 as illustrated in
Furthermore, in the example of
Next, specification of an operation path for avoiding an obstacle by the specification unit 42 will be described.
Next, generation of attitude information on an operation path by the generation unit 43 will be described.
Then, the generation unit 43 generates the attitude information 32 of the robot arm 100 when the tip of the robot arm 100 is positioned at the points 450 from the attitude information 32 of the robot arm 100 when the tip of the robot arm 100 is positioned at each of the imaginary points 410, which is acquired in advance. For more specific description, each of the points 450 is designated as points 450-1 to 450-3 as illustrated in a right side of
[Flow of Processing]
Next, a flow of operation control processing of a device such as the robot arm 100, which is executed by the operation control apparatus 10, will be described.
First, as illustrated in
Next, on the basis of the position information 31 of imaginary points preset in a space within an operation range of the device and the position of the object detected in Step S101, the operation control apparatus 10 calculates a distance between each of the imaginary points and the object (Step S102).
Next, the operation control apparatus 10 uses the position information 31 of imaginary points with the distance calculated in Step S102 of equal to or lower than a predetermined threshold to determine a predetermined region including the object as a region where path search is not possible, and specifies an operation path of the device to a target position for avoiding the region (Step S103).
Next, the operation control apparatus 10 sets points at regular intervals on the operation path specified in Step S103, and generates attitude information when a specific part of the device is positioned at each point from attitude information when the specific part of the device is positioned at the imaginary points (Step S104). The attitude information corresponding to each point is generated, for example, by interpolating attitude information corresponding to imaginary points forming a figure including each point on the operation path.
Next, the operation control apparatus 10 controls the device on the basis of the attitude information corresponding to each point on the operation path, which is generated in Step S104 (Step S105). With this configuration, the device may be operated while avoiding the object detected in the operating environment of the device. Note that, although the operation control processing illustrated in
[Effects]
As described above, the operation control apparatus 10 detects a position of the object 150 included in an operating environment of a device such as the robot arm 100, specifies the operation path 440 of the device on the basis of an operation position of the device and the position of the object 150, generates first operation information on the basis of the operation path 440 and reference information that associates the position information 31 of a plurality of points included in the operating environment with operation information that represents an operating state of the device when the plurality of points are the operation positions, and controls the device on the basis of the first operation information.
In this way, on the basis of the position of the object 150 detected in the operating environment of the device such as the robot arm 100 and the operation position of the device, the operation control apparatus 10 specifies the operation path 440 of the device. Then, on the basis of the specified operation path 440, the position information 31 of the imaginary points 410 preset in a space within the operation range 400, and the attitude information 32 which is the operation information of the device when the imaginary points 410 are the operation positions, the attitude information 32 for avoiding the object 150 is generated to control the device. With this configuration, the operation control apparatus 10 may generate a track of the robot arm 100 for avoiding the object 150 that may be the obstacle 420.
Furthermore, the processing of specifying the operation path 440, which is executed by the operation control apparatus 10, includes processing of calculating a distance between each of the plurality of points and the object 150 on the basis of the position information 31 of the plurality of points and the position of the object 150, and specifying the operation path 440 on the basis of the position information 31 of points with the distance of equal to or lower than a threshold and the operation position of the device.
With this configuration, the operation control apparatus 10 may generate a track of the robot arm 100 for more efficiently and accurately avoiding the object 150 that may be the obstacle 420.
Furthermore, the processing of generating the first operation information, which is executed by the operation control apparatus 10, includes processing of setting points at regular intervals on the operation path 440, and calculating, on the basis of the reference information, the first operation information that represents the operating state of the device when the points at the regular intervals are the operation positions.
With this configuration, the operation control apparatus 10 may generate a track of the robot arm 100 for more accurately avoiding the object 150 that may be the obstacle 420.
Furthermore, the plurality of points is set in the space within the operation range 400 of the device.
With this configuration, the operation control apparatus 10 may generate a track of the robot arm 100 for more accurately avoiding the object 150 that may be the obstacle 420.
Furthermore, each of the plurality of points has a positional relationship corresponding to each of apexes of a triangular pyramid in a case where a plurality of triangular pyramids is connected.
With this configuration, the operation control apparatus 10 may generate a track of the robot arm 100 for more accurately avoiding the object 150 that may be the obstacle 420.
Furthermore, the operation control apparatus 10 further acquires the first operation information when a specific part of the device is positioned at a first point of the plurality of points on the basis of the operation position of the device and the position information 31 of the plurality of points, and generates the reference information on the basis of position information of the first point and the first operation information.
With this configuration, the operation control apparatus 10 may generate a track of the robot arm 100 for more accurately avoiding the object 150 that may be the obstacle 420.
Furthermore, the processing of detecting the position of the object 150, which is executed by the operation control apparatus 10, includes processing of specifying a region of the object 150 in an image obtained by capturing the operating environment from at least one direction.
With this configuration, the operation control apparatus 10 may more accurately detect the object 150 that may be the obstacle 420 and generate a track of the robot arm 100 for avoiding the object 150.
Furthermore, the processing of detecting the position of the object 150, which is executed by the operation control apparatus 10, includes processing of detecting that the object 150 has disappeared from the operating environment, and, in a case where it is detected that the object 150 has disappeared from the operating environment, the operation control apparatus 10 further controls the device on the basis of second operation information preset to represent a normal operating state of the device.
With this configuration, the operation control apparatus 10 may more efficiently operate the robot arm 100.
[System]
Pieces of information including a processing procedure, a control procedure, a specific name, various types of data, and parameters described above or illustrated in the drawings may be optionally changed unless otherwise specified. Furthermore, the specific examples, distributions, numerical values, and the like described in the embodiments are merely examples, and may be optionally changed.
Furthermore, each component of each device illustrated in the drawings is functionally conceptual and does not necessarily have to be physically configured as illustrated in the drawings. For example, specific forms of distribution and integration of each device are not limited to those illustrated in the drawings. For example, all or a part of the devices may be configured by being functionally or physically distributed or integrated in optional units according to various types of loads, usage situations, or the like. Moreover, all or an optional part of each processing function performed in each device may be implemented by a central processing unit (CPU) and a program analyzed and executed by the CPU, or may be implemented as hardware by wired logic.
[Hardware]
The communication interface 10a is a network interface card or the like and communicates with another server. The HDD 10b stores a program for operating the functions illustrated in
The processor 10d is a hardware circuit that reads a program that executes processing similar to the processing of each processing unit illustrated in
In this way, the operation control apparatus 10 operates as an information processing apparatus that executes the operation control processing by reading and executing a program that executes processing similar to the processing of each processing unit illustrated in
Furthermore, the program that executes processing similar to the processing of each processing unit illustrated in
All examples and conditional language provided herein are intended for the pedagogical purposes of aiding the reader in understanding the invention and the concepts contributed by the inventor to further the art, and are not to be construed as limitations to such specifically recited examples and conditions, nor does the organization of such examples in the specification relate to a showing of the superiority and inferiority of the invention. Although one or more embodiments of the present invention have been described in detail, it should be understood that the various changes, substitutions, and alterations could be made hereto without departing from the spirit and scope of the invention.
Number | Date | Country | Kind |
---|---|---|---|
2020-187982 | Nov 2020 | JP | national |