JP7442224B1 - Gripping system, grasping method, control device, and program - Google Patents

Abstract

An object of the present invention is to bring the released object into a more appropriate state when releasing the object gripped by a robot. A gripping system 1 includes an articulated robot 30 having a gripping member 31a that opens and closes, and a control device 40 that controls the operation of the articulated robot 30. The control device 40 performs a gripping operation in which an object to be gripped is gripped by the gripping member 31a by closing the gripping member 31a, and a gripping operation in which the object to be gripped is gripped by the gripping operation by opening the gripping member 31a. A release operation for releasing the object from the gripping member 31a, and a leveling operation for leveling the surface of the object to be released by bringing the gripping member 31a into an open state in a state in which it is in contact with the object to be released by the release operation. , the articulated robot 30 is made to execute. [Selection diagram] Figure 7

Description

The present invention relates to a gripping system, a gripping method, a control device, and a program.

In recent years, various tasks have been performed using robots equipped with grasping functions. For example, when a robot performs the work of plating a side dish, the robot grasps a predetermined amount of ingredients stored in a container such as a vat, transfers them to a designated area of the side dish container, and releases them. (place) work is realized.
A technique related to such a robot that serves food is disclosed in, for example, Patent Document 1.

JP 2021-30407 Publication

However, in the plating work performed by a robot, the state of the ingredients after plating may not be in an appropriate state.
For example, when the gripped ingredients are released at the center of the container, the ingredients are piled up high in the center of the container. On the other hand, the ingredients do not spread to the edge of the area of the container where the food should be served, and the bottom of the container is visible after being served. When the bottom surface is visible in this way, customers who purchase the packaged product feel that the total amount of ingredients on the plate is small.
To avoid this, there is a desire in food factories and the like to arrange ingredients flatly so that the bottom of the container is not visible. However, with conventional techniques, it has been difficult to satisfy such demands.

Furthermore, this problem is not limited to cases where the object is food, but is common to various fields in which gripping is performed by robots, such as the industrial field.
That is, in the conventional technology, when releasing an object gripped by a robot, there is still room for improvement in bringing the released object into an appropriate state.

An object of the present invention is to bring the released object into a more appropriate state when releasing the object gripped by a robot.

In order to solve the above problems, a gripping system according to an embodiment of the present invention,
A gripping system comprising a robot equipped with a gripping member that opens and closes, and a control device that controls the operation of the robot,
The control device includes:
a gripping operation of gripping an object to be gripped by the gripping member by bringing the gripping member into a closed state;
a releasing operation of releasing the gripped object gripped by the gripping operation from the gripping member by opening the gripping member;
a leveling operation of leveling the surface of the release target by bringing the gripping member into an open state in a state in which it is in contact with the release target released by the release operation;
The robot is characterized by causing the robot to execute the following.

According to the present invention, when an object gripped by a robot is released, the state of the released object can be brought into a more appropriate state.

FIG. 1 is a perspective view showing a state in which a plurality of gripping systems 1 according to the present invention are lined up. FIG. 1 is an enlarged perspective view of the main parts of the gripping system 1 according to the present invention. 3 is a schematic diagram showing an example of the shape of a gripping member 31a installed at the tip of a hand 31. FIG. It is a figure showing the positional relationship of accommodation space 10A, hand 31, grasping member 31a, robot arm 32, and ingredients in the case of performing operations, such as grasping operation. It is a figure showing opening and closing of a pair of grip members 31a. 4 is a schematic diagram showing the hardware configuration of a control device 40. FIG. 4 is a block diagram showing the functional configuration of a control device 40. FIG. FIG. 3 is a schematic diagram showing an example of a grasping operation by the articulated robot 30. FIG. 3 is a schematic diagram showing an example of a releasing operation and a leveling operation by the articulated robot 30. FIG. 3 is a schematic diagram showing an example of a leveling operation performed by the articulated robot 30. FIG. FIG. 3 is a schematic diagram showing an example of a falling motion by the articulated robot 30. 2 is a flowchart showing the flow of ingredient plating processing executed by the gripping system 1. FIG. FIG. 3 is a schematic diagram showing an example of a release operation accompanied by a sudden stop by the articulated robot 30.

Embodiments of the present invention will be described below with reference to the drawings.
[Embodiment]
[composition]
1 and 2 are schematic diagrams showing the overall configuration of a gripping system 1 according to the present invention. FIG. 1 is a perspective view showing a state in which a plurality of gripping systems 1 are lined up, and FIG. FIG. 3 is an enlarged perspective view of the main part.
The gripping system 1 in this embodiment is intended to apply the present invention to a system for plating and plating materials. In the following description, an example will be described in which the gripping system 1 grips ingredients such as side dishes as objects and places the ingredients in individual side dish containers. Note that this arrangement of individual side dishes in containers is only an example, and the present embodiment is also applicable to other applications, such as for example, serving each of a plurality of side dishes individually in a corresponding area of a boxed lunch container. It is also possible. In addition, in the following explanation, weight will be used as an example of the amount of ingredients to be served, but the present invention is applicable to physical quantities other than weight, such as volume, bulk, mass, etc. It is possible to apply.

As shown in FIGS. 1 and 2, the gripping system 1 includes an ingredient storage section 10, a container supply section 20, an articulated robot 30, a control device 40, and a shielding section 50. Note that a belt conveyor 2 is installed adjacent to the gripping system 1 to automatically convey containers of prepared foods.

The ingredient accommodating section 10 includes a accommodating space 10A that accommodates ingredients such as side dishes to be served in the gripping system 1. For example, the storage space 10A may be configured by the ingredients storage section 10 itself, or may be configured by a general-purpose container such as a large vat or a tray that can be installed in the ingredients storage section 10. In this storage space 10A, for example, kneaded salads such as potato salad (salads containing viscous or sticky ingredients), okara, dried daikon radish, namasu, hijiki, boiled beans, butter corn, etc. Contains side dishes. In the present embodiment, it is assumed that the ingredient storage unit 10 stores one type of ingredient for multiple meals (for example, several tens to hundreds of meals). Then, the plurality of gripping systems 1 arrange the ingredients of any side dish in the corresponding side dish container, thereby completing the work of serving the side dish. The storage space 10A of the ingredients storage section 10 can be replaced manually by a worker or automatically by the articulated robot 30.

The container supply unit 20 supplies a container of a prepared dish to a predetermined position (a serving position P1 in FIG. 2) in the gripping system 1 where ingredients are to be arranged. The container supply unit 20 stores a plurality of containers of prepared foods, and when the gripping system 1 starts operating, the containers are supplied one by one to the serving position P1. In addition, a weight sensor 21 is installed at the serving position P1 to measure the weight of the prepared food container, and when ingredients are served at the serving position P1, the weight of the served ingredients (i.e., weight). The weight data measured at this time is output to the control device 40. When the weight measurement is completed, the container of the prepared food is delivered to the belt conveyor 2 by a pushing mechanism provided in the container supply section 20.

The articulated robot 30 is configured by, for example, a horizontal articulated robot or a vertical articulated robot, and includes a hand 31 that can grasp the ingredients to be served, and a robot arm 32 that moves the hand 31 to any position within a movable range. , is equipped with.
Further, the joint holding the hand 31 of the articulated robot 30 is equipped with a weight sensor 30A that measures the weight of the ingredient grasped by the hand 31, as an example of means for acquiring the physical quantity of the ingredient grasped by the grasping member 31a. is set up. In addition, the joint that holds the hand 31 of the articulated robot 30 has a reaction force from the contacted ingredient (a benefit obtained by contacting the surface), as an example of a means for detecting that the hand 31 has contacted the ingredient. A force sensor 30B is installed to measure the sense of force (including the sense of force caused by the force). The data on the weight of the ingredients measured by the weight sensor 30A (i.e., the weight of the gripped ingredients) and the reaction force from the ingredients measured by the force sensor 30B (i.e., the detection result of contact with the ingredients) ) is output to the control device 40.

Further, the joint that holds the hand 31 includes an axis that rotates the hand 31 in a twisting direction with respect to the robot arm 32. Therefore, by changing the orientation of the hand 31 when the hand 31 grips the ingredient, the direction in which the hand 31 opens and closes can be adjusted. Thereby, when the hand 31 reaches the vicinity of the inner wall surface of the container, it is possible to change the direction of the hand 31 so that the hand 31 opens and closes in a direction parallel to the inner wall surface of the accommodation space 10A, and the inner wall surface of the container It becomes easier to grasp nearby ingredients.

FIG. 3 is a schematic diagram showing an example of the shape of the gripping member 31a installed at the tip of the hand 31.
Note that in FIG. 3, only one of the pair of gripping members 31a is shown.
As shown in FIG. 3, the gripping member 31a in this embodiment includes a top plate, a main plate, a first side plate, and a second side plate. The top plate portion has a rectangular plane. In addition, when the plane of the top plate section is in a horizontal state, the main plate section is inclined from one end in the longitudinal direction of this plane toward a position spaced apart vertically below the other end in the longitudinal direction of this plane. It has been extended. Furthermore, when the plane of the top plate is in a horizontal state, the first side plate and the second side plate extend vertically downward from each end of the plane.
In addition, in the following description, when each of these pair of gripping members 31a is described without distinguishing them, they are simply referred to as "gripping members 31a."

FIG. 4 is a diagram showing the positional relationship among the accommodation space 10A, the hand 31, the gripping member 31a, the robot arm 32, and the ingredients when performing an operation such as a gripping operation. In FIG. 10, the vertical direction is referred to as the Z direction, the first horizontal direction perpendicular to the Z direction (the direction perpendicular to the paper surface) is referred to as the Y direction, and the second horizontal direction perpendicular to each of the Z direction and the Y direction is referred to as the Y direction. The horizontal direction is called the X direction. That is, the Z direction, the Y direction, and the X direction are directions perpendicular to each other.

The hand 31 is placed at the tip of the robot arm 32. Furthermore, the gripping member 31a is supported by the hand 31 by being coupled to the hand 31 by a coupling member. The hand 31 and the gripping member 31a coupled thereto can move within a movable range in each of the X direction, Y direction, and Z direction according to the operation of the robot arm 32 controlled by the control device 40. is possible. Further, the hand 31 realizes a gripping operation by opening and closing the pair of gripping members 31a in the Y direction using an actuator (not shown).
Furthermore, the hand 31 and the gripping member 31a coupled thereto can rotate with the Z direction as a rotation axis.
With such a configuration, in this embodiment, the positions and orientations of the hand 31 and the gripping member 31a can be changed arbitrarily, and thereby it is possible to appropriately perform operations such as a gripping operation with various movements. becomes.

FIG. 5 is a diagram showing opening and closing of the pair of gripping members 31a. The gripping member 31a shown in FIG. 3 is coupled to the hand 31 by a coupling member such that the respective openings face each other. Further, the X direction, Y direction, and Z direction in FIG. 5 are the same as the directions defined in FIG. 4. The pair of gripping members 31a are brought into an open state by performing an opening operation along the opening/closing direction (Y direction) as shown in FIG. 5(a). Furthermore, when performing the gripping operation, the pair of gripping members 31a are brought into a closed state by performing a closing operation along the opening/closing direction (Y direction) as shown in FIG. 5(b).

Then, the pair of gripping members 31a are brought into a closed state and the gripping members 31a come into contact with each other, so that at least the inner surface with the tip and side plate portions closed forms a container shape for gripping ingredients. In the case of such a shape of the gripping member 31a, the tip of the gripping member 31a is inserted vertically from the surface into an ingredient such as a kneaded salad, and the pair of gripping members 31a are closed at a predetermined depth to lift the ingredient. By doing so, it is possible to grasp and take out a substantially constant amount of ingredients from the storage space 10A.
Furthermore, after the pair of gripping members 31a are transferred onto the prepared food container at the serving position P1, the pair of gripping members 31a are opened and the container shape is opened, so that the ingredients taken out by gripping are This frees up the ability to place almost a certain amount of ingredients in a prepared food container.

Returning to FIGS. 1 and 2, the control device 40 is configured by an information processing device such as a PC (Personal Computer) or a programmable controller, and controls the entire gripping system 1 by executing various programs. For example, the control device 40 causes the container supply unit 20 to supply containers, and the articulated robot 30 to grasp ingredients from the ingredients storage unit 10 and release them into a container for a side dish to serve the ingredients. control etc. More specifically, for example, the control device 40 controls the drive of the robot arm 32 to move the hand 31 to a preset predetermined position along a predetermined route and at a predetermined speed, or to drive the actuator of the hand 31. By controlling this, the operation of gripping and releasing the ingredients by the gripping member 31a is realized.

The shielding section 50 is constituted by a plate-like member that surrounds the area and information in the grasping system 1 in which the ingredient storage section 10, the container supply section 20, and the articulated robot 30 are installed. The plate-like member constituting the shielding part 50 is made of a transparent material such as glass or resin, and allows the operating status of the gripping system 1 to be visually confirmed from the outside. Moreover, a door that can be opened and closed is installed in a part of the side wall that the shielding part 50 constitutes. When replacing the storage space 10A of the ingredients storage section 10, adding a container of prepared foods to the container supply section 20, or performing maintenance on the gripping system 1, the operator opens the door of the shielding section 50 and performs various operations. be able to.

[Hardware configuration of control device 40]
FIG. 6 is a schematic diagram showing the hardware configuration of the control device 40.
As shown in FIG. 6, the control device 40 includes a CPU (Central Processing Unit) 711, a ROM (Read Only Memory) 712, a RAM (Random Access Memory) 713, a bus 714, an input section 715, and an output section. 716, a storage section 717, a communication section 718, and a drive 719.

The CPU 711 executes various processes according to a program recorded in the ROM 712 or a program loaded into the RAM 713 from the storage unit 717.
The RAM 713 also appropriately stores data necessary for the CPU 711 to execute various processes.

The CPU 711, ROM 712, and RAM 713 are interconnected via a bus 714. An input section 715, an output section 716, a storage section 717, a communication section 718, and a drive 719 are connected to the bus 714.

The input unit 715 includes an input device such as a mouse and a keyboard, and receives input of various information to the control device 40. Note that a microphone may be provided as the input unit 715, and input of various information may be accepted through voice input from the worker.
The output unit 716 is configured with a display, a speaker, etc., and outputs images and audio.
The storage unit 717 is configured with a hard disk, a DRAM (Dynamic Random Access Memory), or the like, and stores various data managed by each server.
The communication unit 718 controls communication with other devices via the network.

A removable medium 731 made of a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, or the like is appropriately installed in the drive 719. The program read from the removable medium 731 by the drive 719 is installed in the storage unit 717 as necessary.
Note that the above hardware configuration is the basic configuration of the control device 40, and the configuration may not include some hardware, include additional hardware, or change the implementation form of the hardware. I can do it.

[Functional configuration]
Next, the functional configuration of the control device 40 will be explained.
FIG. 7 is a block diagram showing the functional configuration of the control device 40.
As shown in FIG. 7, by executing a program for controlling the operation of the gripping system 1, the CPU 711 of the control device 40 has a sensor information acquisition unit 151, an ingredient state determination unit 152, and an ingredient quantity determination unit. A determination section 153, an articulated robot control section 154, a container supply control section 155, and a recording control section 156 function. Further, the storage unit 717 includes a parameter storage unit 171 and a history database (history DB) 172.

The parameter storage unit 171 stores various parameters used when the gripping system 1 operates. For example, the parameter storage unit 171 stores the position of the storage space 10A of the ingredient storage unit 10, the position of the container for the prepared food supplied from the container supply unit 20, the position of the area in the container for the prepared dish in which the ingredients are to be served, and the location of the ingredient storage unit 10. The relationship between the amount of insertion of the hand 31 into the ingredient when grasping the ingredient and the weight of the ingredient to be grasped (function or table format data, etc.), parameters defining the movement pattern of the articulated robot 30, etc. are stored. Ru. In this embodiment, the amount of insertion of the hand 31 into the ingredients is an index for estimating the weight (physical quantity) of the ingredients. That is, from the relationship between the amount of insertion of the hand 31 into the ingredient and the weight of the ingredient to be gripped, the actual weight of the gripped ingredient (target gripping weight) is determined by the amount of insertion of the hand 31 into the ingredient. Estimated based on quantity.

In the history DB 172, parameters related to control acquired when the gripping system 1 operates, or measurement data of the weight of ingredients served by the gripping system 1 are stored as a history. Furthermore, the history DB 172 also stores an ingredient state map indicating the state of the ingredients in the storage space 10A of the ingredient storage section 10. Details of this ingredient state map will be described later together with a description of the recording control unit 156 that creates and updates the ingredient state map.

The sensor information acquisition unit 151 acquires sensor information that is information detected by various sensors installed in the gripping system 1. For example, the sensor information acquisition unit 151 may collect data on the weight of the ingredients measured by the weight sensor 30A installed at the joints of the articulated robot 30, data on the reaction force from the ingredients measured by the force sensor 30B, etc. , data on the weight of the ingredients measured by the weight sensor 21 of the container supply section 20 is acquired.

The ingredient condition determination unit 152 recognizes the condition of the ingredients based on the data of the reaction force from the ingredients measured by the force sensor 30B. For example, the ingredient state determination unit 152 determines the depth of the ingredient in the accommodation space 10A (from the surface of the ingredient in the accommodation space 10A to the (depth to the bottom) and the degree of flatness of the surface (how rough the surface is). In this embodiment, instead of determining the state of the ingredients by image analysis using a camera, a method of measuring the state of the ingredients based on the reaction force using the force sensor 30B is used. Therefore, for example, it is possible to reduce the introduction cost and management cost of the camera, and there is no need to consider blind spots of the camera, so it is possible to more flexibly select the arrangement of the articulated robot 30 and the accommodation space 10A. . Furthermore, since no camera is used, there is no need to consider the effects of steam generated from ingredients or lighting on photography.

In addition, upon recognizing the depth of the ingredient and the degree of flatness of the surface, the ingredient state determination unit 152 determines whether these conform to the conditions for grasping the ingredient (for example, the depth of the ingredient and the degree of flatness of the surface). It is determined whether the degree of flatness is greater than or equal to a set threshold value. The degree of flatness of the surface of the ingredient can be defined, for example, based on the absolute value of the size of the unevenness of the surface, and is defined such that the flatter the surface of the ingredient, the larger the value. be able to. Alternatively, the degree of flatness may be determined for each portion of the surface of the ingredient. In addition, the ingredient condition determination unit 152 determines whether the condition of the ingredients in the storage space 10A is such that a specified amount of ingredients can be grasped in one grasping operation.

Based on the data of the weight of the ingredients measured by the weight sensor 30A of the articulated robot 30 and the data of the weight of the ingredients measured by the weight sensor 21 of the container supply unit 20, the ingredient amount determination unit 153 It is determined whether a specified amount of ingredients has been grasped and whether a specified amount of ingredients has been placed in the prepared dish container.

The articulated robot control unit 154 controls the motion of the articulated robot 30 and causes the articulated robot 30 to perform a series of operations for plating ingredients according to the motion pattern defined in the gripping system 1. For example, the articulated robot control unit 154 performs an operation of grasping an ingredient with the hand 31 of the articulated robot 30 (grasping operation), an operation of transferring the grasped ingredient to a container of a side dish (transfer operation), and an operation of grasping the ingredient. An operation of releasing the ingredients (release operation), an operation of leveling the released ingredients (leveling operation), an operation of dropping the ingredients attached to the gripping member 31a onto the surface of the released ingredients (dropping operation), etc. The multi-joint robot 30 is made to execute the process.

The container supply control unit 155 controls the container supply unit 20 to supply containers of prepared food for serving the ingredients to be served in the gripping system 1 to the serving position P1 at a predetermined timing. Further, the container supply control section 155 controls the container supply section 20 and causes the belt conveyor 2 to carry out the prepared food container filled with ingredients.

The recording control unit 156 stores, in the history DB 172, control-related parameters acquired when the gripping system 1 performs the gripping operation and measurement data of the weight of the ingredients served by the gripping system 1. Further, the recording control unit 156 creates and updates an ingredient status map indicating the status of ingredients in the storage space 10A of the ingredient storage unit 10, and also stores this ingredient status map in the history DB 172. More specifically, the recording control unit 156 records the measurement data of the weight of the ingredient and the reaction force of the ingredient acquired when the grasping system 1 performs the grasping operation, and the determination result by the ingredient state determination unit 152, which will be described later. In addition, the state of the ingredients in each region of the storage space 10A is detected based on the measurement data of the weight of the ingredients arranged in the gripping system 1, and is stored in association with identification information that identifies each region. , generate an ingredient state map. In this case, the state of the ingredients refers to the remaining amount of the ingredients in each region, and the depth and flatness of the ingredients determined by the ingredient condition determination unit 152, which will be described later. In addition, when the storage space 10A is replaced with a new one after the ingredients in the storage space 10A have been arranged, a predetermined amount of ingredients (for example, a sufficient amount for the storage space 10A) The ingredient status map is updated assuming that the ingredients (ingredients) are accommodated in a predetermined state (for example, with a flat surface).

Next, details of each operation performed by the articulated robot 30 based on the control of the articulated robot control unit 154 will be described.

[Gripping action]
In the grasping system 1 according to the present embodiment, the depth (insertion amount) of inserting the grasping member 31a into the ingredient and the ingredient to be grasped at that time depend on the type of ingredient and the grasping member 31a used. The relationship between the weight and the weight is known in advance. For example, the density of the ingredient to be gripped (a parameter representing the weight per unit depth) is measured in advance, and the gripping is performed using a function whose element is the multiplication value of the density of the ingredient and the depth into which the gripping member 31a is inserted. The weight can be calculated (estimated). Thereby, the weight of the ingredient to be gripped can be estimated by simple calculation.

Further, the weight calculated in this manner can also be held as data in a table format. Furthermore, since the range of the surface of the ingredient whose flatness decreases can be determined by one grasping operation, a pitch for shifting the grasping position is set for each grasping operation on the surface of the ingredient within the storage space 10A. Furthermore, a gripping operation pattern is set for how to grip the ingredient from which position on the surface of the ingredient, based on the preset depth and pitch into which the gripping member 31a is inserted. Then, according to this gripping operation pattern, the gripping operation is performed as follows.

FIG. 8 is a schematic diagram showing an example of a grasping operation by the articulated robot 30.
As shown in FIG. 8, when the articulated robot 30 grips ingredients, (1) approaches the ingredients, (2) detects the surface of the ingredients, (3) inserts the gripping member 31a into the ingredients. , (4) closing the gripping member 31a to bring the gripping member 31a into a closed state, and (5) measuring the weight (physical quantity) of the gripped ingredient. If the gripped weight matches the specified amount, the ingredients are transferred to the prepared food container and released. Note that the gripped weight conforming to the specified amount means, for example, that the weight of the gripped ingredient is within a predetermined error (within ±15%, etc.) with respect to the target weight. However, considering the case where the ingredient sticks to the gripping member 31a and is not released, the error when the gripped weight is more than the specified amount may be set to be larger than the error when it is less. On the other hand, if the weight of the gripped ingredients does not match the specified amount, (6) release the ingredients to the gripped position in the storage space 10A (return the ingredients); (7) if the weight of the gripped ingredients exceeds the specified amount; (For example, if the weight of the gripped ingredient exceeds the upper limit of the specified amount range), the gripping member 31a is inserted to a shallower depth than the previous time, and the ingredient is gripped. (8) If the weight of the gripped ingredient is insufficient (for example, if the weight of the gripped ingredient is below the lower limit of the specified amount range), the gripping member 31a is The ingredients are gripped again by adjusting the depth to which they are inserted into the ingredients and gripping the ingredients again.

Detecting the surface of the ingredient in step (2) can be done by measuring the reaction force that the gripping member 31a of the articulated robot 30 receives when it comes into contact with the ingredient, using the force sensor 30B.
In addition, when inserting the gripping member 31a into the ingredients in step (3), the insertion amount is calculated from the control parameters of the articulated robot 30 (rotation angle of joints, etc.), or the surface of the ingredients is detected in step (2). It is possible to calculate the insertion amount from the elapsed time since the insertion was started.

In addition, in step (8), even if the gripping member 31a is inserted deeper into the ingredients than the previous time, if the specified amount of ingredients cannot be gripped (the insertion depth required to take the specified amount is When the depth of the ingredients is shallow), the ingredients can be controlled from multiple locations on the surface of the ingredients so that the total amount of ingredients gripped multiple times becomes the specified amount. is also possible. In this case, for example, when the total depth of inserting the gripping member 31a into multiple locations on the surface of the ingredient (total insertion amount) is to grasp a specified amount of ingredients at one time, the gripping member 31a is inserted into the ingredient. It can be controlled to be the same as the depth. In addition, for example, when gripping from the second location onwards, the gripped ingredient is once released to the next planned gripping position, and the released ingredient is placed on the surface of the ingredient where it is present, by a specified amount at once. It is also possible to insert the gripping member 31a into the ingredients to the depth that it would be inserted when gripping the ingredients, and to control so that a predetermined amount of ingredients can be gripped at once.

Note that the relationship between the depth (insertion amount) of the gripping member 31a into the ingredients and the weight of the ingredients gripped at that time can be calculated (estimated) from the density of the ingredients, as well as Machine learning is performed on the data on the depth at which 31a is inserted and the data on the weight of the ingredient gripped at that time, and the weight of the gripped ingredient is estimated using the machine learning model generated by machine learning. It may also be a thing. In addition, in the process of machine learning, the density of the ingredients is calculated, and using the calculated density, the weight of the gripped ingredients is calculated from the depth (insertion amount) of the gripping member 31a inserted into the ingredients. It's okay.

[Release action]
9(a) and 9(b) are schematic diagrams showing an example of a release operation by the articulated robot 30.
In FIG. 9(a), the Y direction is the opening/closing direction when gripping and releasing by the gripping member 31a, the X direction is the direction perpendicular to the opening/closing direction in the horizontal plane, and the Z direction is the height direction. be. That is, FIG. 12 is a schematic diagram illustrating a cross section (ie, YZ plane) perpendicular to the X direction of the pair of gripping members 31a. The X direction, Y direction, and Z direction in FIG. 9(a) are the same as the directions defined in FIG. 4.
Note that since FIGS. 9(b) and 9(c), as well as FIGS. 10, 11, and 13, which will be described later, all illustrate similar vertical sections (i.e., YZ plane), these In the figure, illustration of each direction is omitted.

The articulated robot 30 grasps the ingredients accommodated in the accommodation space 10A by performing a grasping operation as shown in FIG. The articulated robot 30 then transfers the gripped pair of gripping members 31a onto the prepared food container at the serving position P1, as shown in FIG. 9(a). Then, the articulated robot 30 lowers the gripping member 31a to the height at which it is released. In addition, in the drawings and the following description, the ingredients gripped by the gripping member 31a are appropriately referred to as "gripping ingredients."

Next, as shown in FIG. 9(b), when the articulated robot 30 descends to the height for release, it stops descending and then opens the gripping member 31a in the opening/closing direction to bring it into the open state. The gripping material is released from the gripping member 31a. This release takes place, for example, in the center of the horizontal plane of the container of prepared food, at a height close to the bottom of the container. By releasing at such a position, it is possible to prevent the released ingredients from scattering outside the prepared food container.

In this case, the release ingredients released at the center of the container are piled up high in the center of the container. On the other hand, the release material does not spread to the end portion of the area where the container should be served, and the bottom surface of the container is visible when the container is viewed from vertically above. As described above, when the bottom surface is visible in this way, customers who purchase the packaged product feel that the total amount of the packaged release ingredients is small. Therefore, in this embodiment, after the release operation, a leveling operation, which will be described below, is performed.

Further, when the ingredients have viscosity or stickiness, a part of the gripped ingredients may adhere to the inner surface of the gripping member 31a, as shown in the figure. However, in this embodiment, the attached ingredients can be dropped by a dropping operation described below. In addition, in the drawings and the following description, the ingredient released by the gripping member 31a is appropriately referred to as a "released ingredient". In addition, the ingredients attached to the gripping member 31a are appropriately referred to as "attached ingredients."

[Leveling operation]
FIGS. 9(c) and 10 are schematic diagrams showing an example of a leveling operation by the articulated robot 30.
As shown in FIG. 9(c), after performing the release operation, the articulated robot 30 raises the gripping member 31a to a position vertically above the released ingredients while maintaining the open state. . Next, as shown in FIG. 10(d), the multi-joint robot 30 closes the gripping member 31a at a position vertically above the loaded release material to bring it into the closed state. That is, the gripping member 31a is raised and brought into the closed state while preventing the gripping member 31a from coming into contact with the released ingredients that have been served.
As described above, since the gripping member 31a is not in contact with the release ingredients, the state in which the release ingredients are arranged at this point is unchanged from the state in which they are arranged immediately after release.

Next, as shown in FIG. 10(e), the articulated robot 30 moves the surface of the center (i.e., the center of the container) of the release ingredients piled up in a mountain shape while maintaining the gripping member 31a in the closed state. lower towards. As a result, the outer surface of the tip of the gripping member 31a comes into contact with the top portion of the release ingredients piled up in a mountain shape at the center of the container.
In this case, the height to which the gripping member 31a is lowered depends on the characteristics of the release material (for example, viscosity, stickiness, density), the shape of the release material, the amount of the release material, and the container. It can be set appropriately depending on the size, etc. As an example, the gripping member 31a is lowered until the tip of the gripping member 31a is located at a height lower than the height of the top of the release material at the center of the container and higher than the height assumed as the height after leveling. let In addition, in order to facilitate understanding of the height of the apex of the release material and the height assumed as the height after leveling, each of these heights is shown in the figure by a broken line.

Next, as shown in FIG. 10(f), the articulated robot 30 opens the gripping member 31a to an open state while the outer surface of the tip of the gripping member 31a remains in contact with the release material. Along with this, the leveling operation is realized in a plurality of regions on the surface of the release material, targeting regions whose height is relatively higher than other regions.

As a result, due to the characteristics of the release operation by the gripping member 31a that opens and closes, the height of the ingredients in the region (in this case, the center of the container) that is relatively high inevitably becomes relatively low. By moving it to an area (here, the edge of the container), the surface can be leveled and the height can be made uniform.
Furthermore, by leveling the surface of the release ingredients in this way, the ingredients can be spread all the way to the edges of the area of the container where they are to be served. Therefore, it is possible to solve the problem that the bottom of the container is visible after serving. In addition, the surface of the ingredients placed in the container can be made flat and presentable. That is, it is possible to compensate for the drawbacks of the release operation by the gripping member 31a that opens and closes, and to bring the released release tool into a more appropriate state.

Moreover, this leveling operation can be realized only by operating the gripping member 31a. Therefore, there is also an effect that there is no need to separately prepare a special member, mechanism, etc. for leveling the surface of the release material.
Furthermore, according to the gripping system 1, by performing the release based on the center of the container, it is possible to prevent ingredients from scattering outside the container at the time of release.
Further, according to the gripping system 1, the gripping member 31a is brought into the open state with the outer surface of the gripping member 31a in contact with the top of the mountain-shaped release material at the center of the container. As a result, the leveling operation can be executed in a state where the leveling can be performed efficiently.

[Falling motion]
FIG. 11 is a schematic diagram showing an example of a falling motion by the articulated robot 30. By performing the gripping operation, the releasing operation, and the leveling operation as described above, it is possible to realize the arrangement of the ingredients, and it is also possible to bring the arranged release ingredients into a more appropriate state. However, due to the gripping operation and the release operation, the attachment material has adhered to the inner surface of the gripping member 31a. Further, due to the leveling operation, the adhesion material has also adhered to the outer surface of the gripping member 31a.
If the gripping member 31a is transferred to the accommodation space 10A in this state, there is a risk that the attached ingredients will fall on the transfer route and be scattered. When the adhered ingredients are scattered in this way, it becomes necessary for the operator to manually clean it. Furthermore, the scattered ingredients must be discarded, resulting in a loss of ingredients. Therefore, in this embodiment, after the leveling operation is performed, the dropping operation described below is performed.

As shown in FIG. 11(g), after performing the releasing operation, the articulated robot 30 raises the gripping member 31a together with the attachment material.

Next, as shown in FIG. 11(h), the articulated robot 30 moves the gripping member 31a together with the attachment material to drop the attachment material onto the surface of the release material in the container. In this case, movement means, for example, repeating vertical movement. Alternatively, for example, it is possible to repeat left and right movements, or to combine up and down movements with left and right movements. The range of movement (stroke) at this time and the number of times these movements are repeated can be set in advance, taking into consideration the size of the ingredients, the shape of the ingredients, the speed required for plating, etc. .
Moreover, instead of setting in advance in this way, the control may be performed according to the actual falling situation. For example, the weight of the attached ingredient attached to the gripping member 31a may be measured by the weight sensor 30A, and the exercise may be repeated until the weight of the attached ingredient falls below a threshold value. Further, in this case, if the weight of the adhered ingredients does not fall below the threshold even after repeating the movement multiple times, the movement range may be expanded to cause the adhered ingredients to fall with a larger movement.
As a result, the release material adhering to the gripping member 31a due to the leveling operation, the gripping action, and the release action falls onto the surface of the release material already placed on the container. Therefore, for example, it is possible to prevent the adhered ingredients from falling and scattering on the route of transfer to the accommodation space 10A.
In addition, as shown in FIG. 11(g), when raising the gripping member 31a, if the gripping member 31a is raised higher than necessary, the above-described dropping operation with reference to FIG. 11(h) will not occur. Accordingly, there is a possibility that the adhered ingredients may be scattered outside the container. Therefore, it is preferable to raise the gripping member 31a only to an extent that does not interfere with this operation.

[Overall operation]
Next, the overall operation of the gripping system 1 will be explained.
FIG. 12 is a flowchart showing the flow of ingredient plating processing executed by the gripping system 1. The ingredient plating process is started, for example, when an operator performs an operation to start the ingredient plating process.
When the ingredient plating process is started, in step S11 in FIG. (data on the insertion amount, etc.) from the parameter storage unit 171, preparations for gripping the ingredients are made.

In step S12, the articulated robot control unit 154 transfers the hand 31 to the accommodation space 10A according to the motion pattern data.

In step S13, the ingredient state determination unit 152 recognizes the state of the ingredients in the accommodation space 10A by reading the ingredient state map indicating the state of the ingredients in the accommodation space 10A of the ingredient storage unit 10 from the history DB 172. do. Thereafter, the ingredient condition determination unit 152 continues to recognize the condition of the ingredient based on the data of the reaction force from the ingredient measured by the force sensor 30B, which is acquired by the sensor information acquisition unit 151.

In step S14, the depth to which the gripping member 31a is inserted into the ingredients is determined based on the movement pattern data read in step S11 and the state of the ingredients in the storage space 10A recognized in step S13.
In step S15, the articulated robot control unit 154 inserts the gripping member 31a into the ingredient to the determined insertion depth.
In step S16, the articulated robot control unit 154 closes the gripping member 31a and grips the ingredients.

In step S17, the ingredient amount determining unit 153 measures the weight (physical quantity) of the grasped ingredient and determines whether a specified amount of ingredient is being grasped. If the predetermined amount of ingredients is being held, the determination in step S17 is Yes, and the process proceeds to step S18. On the other hand, if the prescribed amount of ingredients is not gripped, the determination in step S17 is No, and the process is performed again from step S14. In this case, if the gripping material being gripped exceeds the specified amount, the insertion depth is re-determined to become shallower in step S14, which is performed again. On the other hand, if the gripping material being gripped is less than the specified amount, the insertion depth is re-determined to become deeper in step S14, which is performed again. Note that the processing from step S14 to step S17 corresponds to the gripping operation described with reference to FIG.

In step S18, the articulated robot control unit 154 moves the gripping member 31a to the position of the prepared food container.
In step S19, the articulated robot control unit 154 releases the gripping material gripped by the gripping member 31a to a predetermined area within the container (for example, the center of the container in the horizontal plane).

In step S20, the articulated robot control unit 154 raises the gripping member 31a while keeping it open.
In step S21, the articulated robot control unit 154 closes and lowers the gripping member 31a.
In step S22, the articulated robot control unit 154 smooths the surface of the release material by opening the gripping member 31a in contact with the release material.
Note that the processing from step S20 to step S21 corresponds to the leveling operation described with reference to FIGS. 9(c) to 10.

In step S23, the articulated robot control unit 154 causes the adhered material to fall by a dropping motion.

In step S24, the recording control unit 156 stores in the history DB 172 the control-related parameters acquired in the ingredient serving process and the measurement data (history data) of the weight of the served ingredients. Furthermore, the recording control unit 156 updates the ingredient state map indicating the state of the ingredients in the accommodation space 10A of the ingredient storage unit 10, and also stores the updated ingredient state map in the history DB 172. In this case, if there is an excess or deficiency in the weight of the served ingredients, an alert may be output to the worker.

In step S25, the articulated robot control unit 154 determines whether the conditions for terminating the ingredient plating process are met. In this case, the conditions for terminating the ingredient arrangement process include that the ingredients have been arranged in the scheduled number of prepared food containers, or that the operator has performed an operation to end the ingredient arrangement process. can be defined.
If the conditions for terminating the ingredient plating process are not met, a negative determination is made in step S25, and the process is repeated from step S12. On the other hand, if the conditions for terminating the ingredients plating process are met, the determination in step S25 is Yes, and the ingredients plating process ends.

As described above, the grasping system 1 according to the present embodiment can bring the released ingredient into a more appropriate state when releasing the ingredient grasped by the articulated robot 30. In addition to this, the gripping system 1 according to the present embodiment also has various effects as described above when explaining the leveling operation and the dropping operation.

[Modification 1]
In the above-described embodiment, after lowering the gripping member 31a as shown in FIGS. 9(a) and 9(b), the gripping member 31a is opened with the gripping member 31a stopped, thereby creating an open state and releasing the gripping material. Was. The present invention is not limited to this, and the gripping material may be released by other methods. For example, when lowering the gripping member 31a and stopping the lowering, the releasing operation is executed while suddenly stopping the gripping member 31a so that the amount of change in speed before and after the stop is greater than a predetermined value. It's okay. Thereby, the gripped material can be efficiently dropped. FIG. 13 is a schematic diagram showing an example of a release operation accompanied by a sudden stop by the multi-joint robot 30.

First, as shown in FIG. 13(a), the articulated robot 30 lowers the gripping member 31a, which is gripping the gripping material, at a predetermined speed or higher. Then, as shown in FIG. 13(b), the articulated robot 30 opens the gripping member 31a in the lowered state to release the gripping material, and cancels the lowering to open the gripping member 31a. to stop.
In this case, the articulated robot 30 does not simply stop, but stops the gripping member 31a from descending suddenly so that the amount of change in speed before and after the stop is greater than a predetermined value. By doing so, the gripping material is caused to fall from the gripping member 31a.
As a result, the inertia force in the downward direction of the gripping member 31a supported by the articulated robot 30 during a sudden stop is canceled out, while the inertia force in the downward direction is maintained for the gripping material. Materials can be dropped efficiently. Moreover, in this case, the released ingredients that have fallen become one lump and are piled up in a mountain shape. However, by performing the leveling operation as described above after that, the released release material can be brought into a more appropriate state, so this is not a problem.

[Modification 2]
In the above-described embodiment, after lowering the gripping member 31a as shown in FIGS. 9(a) and 9(b), the gripping member 31a is opened with the gripping member 31a stopped, thereby creating an open state and releasing the gripping material. Was. Further, as shown in FIGS. 10(e) and 10(f), the leveling operation was performed by opening the gripping member 31a in contact with the release material. In this case, the way the gripping member 31a is opened may be different between when performing the releasing operation and when performing the leveling operation.

For example, when performing a leveling operation, if the gripping member 31a is opened in the same way as when performing a release operation, the horizontal movement (that is, the movement in the Y direction) of the gripping member 31a will gain too much momentum, which There is a risk that the release material that should be leveled within the container may be scattered outside the container.
Therefore, when the hand 31 has a mechanism that can vary the speed of the horizontal movement of the gripping member 31a, when performing the leveling operation, it is possible to It is preferable to control the speed to be slower. This can prevent the release material from scattering outside the container during the leveling operation.

Furthermore, for example, if the hand 31 has a mechanism that can vary the width of the horizontal opening of the gripping member 31a, the leveling operation may be performed with a lower width than the release action. , it is preferable to control the opening width to be narrower. This also prevents the release material from scattering outside the container during the leveling operation. In this case, for example, even if the gripping member 31a is opened by an air cylinder using an ON/OFF controlled solenoid valve, a plurality of sensors for detecting the opening width may be arranged to correspond to the plurality of opening widths. The opening width can be varied.
Note that the speed of horizontal movement and the opening width can also be adjusted depending on, for example, the size of the container in which the ingredients are to be placed. For example, there may be cases where the container is large and the opening width when performing the opening operation does not allow the ingredients to spread all the way to the edge of the container. In such a case, it is preferable to control the opening width to be wider when performing the leveling operation than when performing the releasing operation. This allows the ingredients to be spread all the way to the edges of the container, even if the container is large.

[Modification 3]
In the embodiment described above, it was assumed that a pair of gripping members 31a (ie, two gripping members 31a) were used, but the present invention is not limited to this. You may make it use three or more plural holding members 31a. Then, a configuration may be adopted in which a gripping operation is performed by bringing the openings of each gripping member 31a closer to each other, and a releasing operation is performed by moving the openings of each gripping member 31a away from each other.
In this case, for example, if three gripping members 31a are used, the tips of the three gripping members 31a, each with a center angle of 120°, should be moved closer to or farther from the center when viewed from vertically above. .
Even in this case, each operation such as the above-mentioned leveling operation can be executed.

[Modification 4]
In the above-described embodiment, the ingredient condition determination unit 152 determines the condition of the ingredient based on the data of the reaction force from the ingredient (i.e., the detection result of contact with the ingredient) measured by the force sensor 30B. However, the present invention is not limited to this.

If the installation cost of the camera is not a problem, the state of the ingredients may be determined by taking a picture with a camera (that is, an imaging device). Further, in the above-described embodiment, the weight of the ingredients held by the articulated robot 30 or the weight of the ingredients placed in the container of prepared food is measured by the weight sensors 30A and 21, but the invention is not limited to this. .
For example, it is also possible to calculate the weight of the ingredient by estimating the volume of the ingredient from an image of the ingredient captured by the imaging device and multiplying the density by the estimated volume.
In this case, a means for calculating the weight of the ingredients can be implemented without using the weight sensors 30A, 21.

[Configuration example]
As described above, the gripping system 1 in this embodiment includes the articulated robot 30 that includes the gripping member 31a that opens and closes, and the control device 40 that controls the operation of the articulated robot 30.
The control device 40 is
a gripping operation of gripping an object to be gripped by the gripping member 31a by bringing the gripping member 31a into a closed state;
a releasing operation of releasing the gripped object gripped by the gripping operation from the gripping member 31a by opening the gripping member 31a;
a leveling operation of leveling the surface of the object to be released by bringing the gripping member 31a into an open state while in contact with the object to be released by the release operation;
The articulated robot 30 is made to execute.
Thereby, the surface of the object to be released can be leveled, and the ingredients can be spread all the way to the edge of the area of the container to be served. Therefore, it is possible to solve the problem that the bottom of the container is visible after serving. In addition, the surface of the ingredients placed in the container can be made flat and presentable.
That is, according to the gripping system 1, when the object gripped by the robot is released, the state of the released object can be brought into a more appropriate state.
Moreover, this leveling operation can be realized only by operating the gripping member 31a. Therefore, there is also an advantage that there is no need to separately prepare a special member, mechanism, etc. for leveling the surface of the object to be released.

The control device 40 is
In response to performing the release operation, a leveling operation is performed on a plurality of regions of the surface of the object to be released whose height is relatively higher than other regions.
As a result, due to the characteristics of the release operation, objects in areas where the height inevitably becomes relatively high (for example, the center of the container) can be removed from areas where the height inevitably becomes relatively low (for example, in the center of the container). By moving it to the edge), you can level the surface and make the height uniform. That is, it is possible to compensate for the drawbacks of the release operation by the gripping member 31a that opens and closes.

The control device 40 is
In the release operation, the object to be grasped is released to the center of the horizontal plane of the predetermined container;
In the leveling operation, the gripping member 31a is brought into an open state with the gripping member 31a in contact with the object to be released at the center of the horizontal plane of a predetermined container.
Thereby, by performing the release based on the center of the container, it is possible to prevent the objects from scattering outside the container, and it is also possible to level out the objects placed in the center of the container afterwards.

The control device 40 is
After performing the release operation, raise the grip member 31a in the open state,
The raised gripping member 31a is brought into a closed state,
By lowering the grip member 31a that has been brought into the closed state after being raised, the grip member 31a is brought into an open state with the outer surface of the grip member 31a in contact with the object to be released;
Perform the leveling operation using these steps.
As a result, the leveling operation can be executed in a state where the leveling can be performed efficiently.

The control device 40 is
After performing the leveling operation, by moving the gripping member 31a, at least the object to be released that has adhered to the gripping member 31a due to the leveling operation is dropped onto the surface of the object to be released that is not attached to the gripping member 31a. The articulated robot 30 is further executed.
As a result, the object to be released that has adhered to the gripping member 31a due to the leveling operation, the gripping operation, and the releasing operation is dropped onto the surface of the object to be released that has been placed on the container, and the object is scattered outside the container. can be prevented from happening.

The control device 40 is
When lowering the gripping member 31a and stopping the lowering, the releasing operation is performed while suddenly stopping the gripping member 31a so that the amount of change in speed before and after the stop is larger than a predetermined value.
As a result, in the case of a sudden stop, the inertia force in the downward direction of the gripping member 31a supported by the articulated robot 30 is canceled out, while the inertia force in the downward direction is maintained for the attached ingredients. It is possible to efficiently drop the material being held.

Note that the above-described embodiments and modified examples are examples of embodiments of the present invention, and various embodiments that realize the functions of the present invention are included within the scope of the present invention.
For example, in the above-described embodiments and modifications, the case where the present invention is applied to a gripping system for serving side dishes has been described as an example, but the present invention can be applied to systems for gripping various objects. . For example, the present invention can be applied to a system for gripping highly viscous or sticky materials such as mixed mortar, concrete, plaster, and clay. The present invention is suitable for gripping an object having a viscosity of medium viscosity or higher (5000 mPa·s) or higher at working temperature or room temperature.
Moreover, it is possible to implement the present invention by appropriately combining the examples described in the above-mentioned embodiments.
The series of processes described above can be executed by hardware or software.
In other words, the functional configuration in FIG. 7 is merely an example and is not particularly limited. That is, it is sufficient that the gripping system 1 is equipped with a function that can execute the series of processes described above as a whole, and what kind of functional blocks are used to realize this function is not particularly limited to the example shown in FIG. 7.
Further, one functional block may be configured by a single piece of hardware, a single piece of software, or a combination thereof.

When a series of processes is executed by software, a program constituting the software is installed on a computer or the like from a network or a recording medium.
The computer may be a computer built into dedicated hardware. Further, the computer may be a computer that can execute various functions by installing various programs, such as a general-purpose personal computer.

The storage medium that stores the program may be a removable medium that is distributed separately from the device itself, or a storage medium that is pre-installed in the device itself. The removable media includes, for example, a magnetic disk, an optical disk, a magneto-optical disk, or a flash memory. Optical disks include, for example, CD-ROMs (Compact Disk-Read Only Memory), DVDs (Digital Versatile Disks), Blu-ray Discs (registered trademark), and the like. The magneto-optical disk is composed of an MD (Mini-Disk) or the like. The flash memory is configured by, for example, a USB (Universal Serial Bus) memory or an SD card. Further, the storage medium pre-installed in the device main body is, for example, a ROM or hard disk in which programs are stored.

Note that in this specification, the step of writing a program to be recorded on a recording medium is not only a process that is performed chronologically in accordance with the order, but also a process that is not necessarily performed chronologically but in parallel or individually. It also includes the processing to be executed.
Furthermore, in this specification, the term system refers to an overall device composed of a plurality of devices, a plurality of means, and the like.

The above embodiment shows an example of applying the present invention, and does not limit the technical scope of the present invention. That is, the present invention can be modified in various ways, such as omissions and substitutions, without departing from the gist of the present invention, and various embodiments other than the above-described embodiments can be adopted. Various embodiments and modifications thereof that the present invention can take are included within the scope of the invention described in the claims and its equivalents.

1 Grasping system, 2 Belt conveyor, 10 Ingredients storage section, 10A Storage space, 20 Container supply section, 21, 30A Weight sensor, 30 Articulated robot, 30B Force sensor, 31 Hand, 31a Gripping member, 32 Robot arm, 40 control device, 50 shielding unit, 151 sensor information acquisition unit, 152 ingredient state determination unit, 153 ingredient amount determination unit, 154 articulated robot control unit, 155 container supply control unit, 156 recording control unit, 171 parameter storage unit, 172 history database (history DB), 711 CPU, 712 ROM, 713 RAM, 714 bus, 715 input section, 716 output section, 717 storage section, 718 communication section, 719 drive, 731 removable media

Claims (6)

A gripping system comprising a robot equipped with a gripping member that opens and closes, and a control device that controls the operation of the robot,
The control device includes:
a gripping operation of gripping an object to be gripped by the gripping member by bringing the gripping member into a closed state;
While lowering the gripping member, when stopping the lowering, the gripping member is brought into an open state while suddenly stopping so that the value of the amount of change in speed before and after the stop is larger than a predetermined value. a releasing operation of releasing the gripped object gripped by the gripping operation from the gripping member;
a leveling operation of leveling the surface of the release target by bringing the gripping member into an open state in a state in which it is in contact with the release target released by the release operation;
A gripping system that causes the robot to perform the following. The control device includes:
In response to performing the releasing operation, the leveling operation is performed on a plurality of regions of the surface of the object to be released whose height is relatively higher than other regions;
The gripping system according to claim 1, characterized in that: The control device includes:
in the releasing operation, releasing the grasped object to the center of a predetermined container in a horizontal plane;
In the leveling operation, the gripping member is brought into an open state with the gripping member in contact with the object to be released at the center of the horizontal plane of the predetermined container;
The gripping system according to claim 2 , characterized in that: The control device includes:
After performing the release operation, raise the gripping member in an open state;
bringing the raised gripping member into a closed state;
lowering the gripping member that has been brought into the closed state after the ascent, bringing the gripping member into an open state with the outer surface of the gripping member in contact with the object to be released;
Perform the leveling operation in the following steps.
The gripping system according to any one of claims 1 to 3, characterized in that: The control device includes:
After performing the leveling operation, by moving the gripping member, at least the object to be released that has adhered to the gripping member due to the leveling operation is removed from the surface of the object to be released that is not attached to the gripping member. further causing the robot to perform a falling motion of dropping the robot to
The gripping system according to any one of claims 1 to 3, characterized in that: A control device comprising a control means for controlling the operation of a robot equipped with a gripping member that opens and closes,
The control means includes:
a gripping operation of gripping an object to be gripped by the gripping member by bringing the gripping member into a closed state;
While lowering the gripping member, when stopping the lowering, the gripping member is brought into an open state while suddenly stopping so that the value of the amount of change in speed before and after the stop is larger than a predetermined value. a releasing operation of releasing the gripped object gripped by the gripping operation from the gripping member;
a leveling operation of leveling the surface of the release target by bringing the gripping member into an open state in a state in which it is in contact with the release target released by the release operation;
A control device that causes the robot to execute.

Images