WO2020189118A1 - Cargo handling apparatus - Google Patents

Cargo handling apparatus Download PDF

Info

Publication number
WO2020189118A1
WO2020189118A1 PCT/JP2020/005773 JP2020005773W WO2020189118A1 WO 2020189118 A1 WO2020189118 A1 WO 2020189118A1 JP 2020005773 W JP2020005773 W JP 2020005773W WO 2020189118 A1 WO2020189118 A1 WO 2020189118A1
Authority
WO
WIPO (PCT)
Prior art keywords
angle
holding
control unit
luggage
load
Prior art date
Application number
PCT/JP2020/005773
Other languages
French (fr)
Japanese (ja)
Inventor
佳秀 大鶴
Original Assignee
株式会社東芝
東芝インフラシステムズ株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社東芝, 東芝インフラシステムズ株式会社 filed Critical 株式会社東芝
Publication of WO2020189118A1 publication Critical patent/WO2020189118A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G43/00Control devices, e.g. for safety, warning or fault-correcting
    • B65G43/08Control devices operated by article or material being fed, conveyed or discharged
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/74Feeding, transfer, or discharging devices of particular kinds or types
    • B65G47/90Devices for picking-up and depositing articles or materials
    • B65G47/91Devices for picking-up and depositing articles or materials incorporating pneumatic, e.g. suction, grippers

Definitions

  • the present invention relates to a cargo handling device.
  • a cargo handling system in which a stored product or the like is taken out by a robot device and unloaded to a belt conveyor or the like.
  • a cargo handling system it may be necessary to lay the load on its side for transportation in order to process it downstream after transportation or to prevent it from tipping over during transportation.
  • a tilting table slope
  • the luggage is dropped onto the tilting table in a tilted state to lay the luggage on its side. ..
  • the problem to be solved by the present invention is to provide a cargo handling device capable of properly laying down a luggage.
  • the cargo handling device of the embodiment includes a holding portion for holding the luggage and an arm for moving the holding portion, and after moving the luggage held by the holding portion onto the carrier for carrying the luggage. , The holding by the holding portion is released, and the load is placed on the carrier.
  • the cargo handling device includes a control unit. When the control unit lays the load on its side and conveys it to the carrier, one of a plurality of angle candidates indicating the angle candidates of the holding section when the load is placed on the tilt table provided on the upstream side of the carrier. The angle candidate of is selected, the angle of the holding unit is controlled to the angle indicated by the selected angle candidate, and the holding by the holding unit is controlled to be released.
  • FIG. 1 is a plan view of the cargo handling system of the first embodiment.
  • FIG. 2 is a side view of the cargo handling system of the first embodiment.
  • FIG. 3 is a diagram showing an example of the hardware configuration of the control device according to the first embodiment.
  • FIG. 4 is a diagram showing an example of the function of the control device of the first embodiment.
  • FIG. 5 is a diagram showing an example of a detailed function of the robot control unit of the first embodiment.
  • FIG. 6 is an explanatory diagram of a method for detecting the size of the luggage in the height direction of the first embodiment.
  • FIG. 7 is a diagram showing an example of a mode of moving luggage according to the first embodiment.
  • FIG. 8 is an explanatory diagram of how to defeat the unloader of the first embodiment.
  • FIG. 1 is a plan view of the cargo handling system of the first embodiment.
  • FIG. 2 is a side view of the cargo handling system of the first embodiment.
  • FIG. 3 is a diagram showing an example of the hardware configuration of the
  • FIG. 9 is a diagram showing an example of a plurality of angle candidates according to the first embodiment.
  • FIG. 10 is a diagram showing an example of a mode in which a load is laid on its side and transported.
  • FIG. 11 is a flowchart showing an operation example of the control device of the first embodiment.
  • FIG. 12 is a diagram showing an example of the function of the control device of the second embodiment.
  • FIG. 13 is a diagram showing an example of a plurality of angle candidates of the second embodiment.
  • FIG. 14 is an explanatory diagram of a mode selection method of the second embodiment.
  • FIG. 15 is an explanatory diagram of a mode selection method of the second embodiment.
  • FIG. 1 is a diagram showing an example of the configuration of the cargo handling system 1 of the present embodiment.
  • the cargo handling system 1 is a system installed in a distribution center or the like, which takes out a baggage from a container (cargage storage container) in which the baggage is stored and puts the taken out baggage on a conveyor for transporting the baggage.
  • FIG. 1 is a plan view of the cargo handling system 1
  • FIG. 2 is a side view of the cargo handling system 1.
  • the cargo handling system 1 controls the robot device 10, the laser range finder (hereinafter referred to as “LRF”) 20, the camera 30, the auxiliary conveyor 40, and the main conveyor 50.
  • LRF laser range finder
  • the robot device 10 is a device that takes out the luggage 80 stored in the luggage storage container 70 under the control of the control device 60 and puts the taken out luggage 80 on the auxiliary conveyor 40.
  • the robot device 10 includes at least a holding unit 11 and an arm 12.
  • the holding unit 11 is a means for holding the luggage 80.
  • the holding unit 11 can be configured to have one or more suction pads.
  • a pump for vacuum suctioning the suction pad is connected to each suction pad via, for example, a hose, and the suction pad is sucked in a state where the suction pad is pressed against the luggage 80.
  • the holding unit 11 may have a structure capable of holding / releasing the luggage 80, and various known techniques can be used.
  • the holding portion 11 may be a mechanism for sandwiching (grasping) the luggage 80.
  • “grasping" can be considered as an aspect of "holding”.
  • the arm 12 is a means for moving the holding portion 11.
  • the arm 12 is an articulated arm, and may have a configuration having a plurality of arm members and a connecting portion for rotatably connecting the plurality of arm members.
  • the tip of the arm 12 is connected to the holding portion 11 and supports the holding portion 11.
  • the arm 220 can move the holding unit 11 to a desired position in the three-dimensional space under the control of the control device 60 (based on the coordinates in the X, Y, and Z directions input from the control device 60). It can.
  • the X direction and the Y direction are directions along the horizontal plane and intersect with each other (for example, substantially orthogonal to each other).
  • the Z direction is the vertical direction.
  • the control device 60 controls the arm 12 so that the position of the holding unit 11 is a position where the luggage 80 to be unloaded stored in the luggage storage container 70 can be held, and the suction of the holding unit 11 is performed at that position.
  • the holding unit 11 can hold the luggage 80 to be unloaded.
  • the control device 60 controls the arm 12 so that the position of the holding portion 11 holding the luggage 80 is the unloading position on the auxiliary conveyor 40 (the position where the luggage 80 is placed on the auxiliary conveyor 40).
  • the suction of the holding unit 11 By controlling the suction of the holding unit 11 to be stopped at the unloading position, the holding by the holding unit 11 can be released, and the load 80 can be dropped and placed on the auxiliary conveyor 40.
  • the specific contents of the control device 60 will be described later.
  • the LRF 20 is a sensor used to detect the size of the load 80 to be unloaded in the height direction (Z direction), and is a sensor that measures a distance using light waves.
  • the elevating mechanism 21 is a device for elevating and lowering the LRF 20 under the control of the control device 60.
  • the camera 30 is a three-dimensional camera capable of capturing a three-dimensional image, and can capture the shape and size of a subject (object) in three dimensions.
  • the camera 30 is arranged above the luggage storage container 70 and images the upper surface of the luggage 80 stored in the luggage storage container 70.
  • the image captured by the camera 30 (three-dimensional image in this example) may be referred to as a “camera image”.
  • the control device 60 detects the size of the load 80 to be unloaded from the measurement result of the LRF 20 and the camera image, and based on the detected size, the load 80 is laid down and conveyed to the auxiliary conveyor 40. Decide whether to let it. Details will be described later.
  • the LRF 20 and the camera 30 function as "detectors" used to detect size information (eg, three-sided size information) about the size of the luggage 80.
  • the auxiliary conveyor 40 is an example of a “conveyor body” for transporting the luggage 80, and transports the luggage 80 received from the robot device 10 toward the main conveyor 50.
  • a tilt table (slope) 41 for laying down the luggage 80 is provided on the upstream side of the auxiliary conveyor 40.
  • the main conveyor 50 conveys the load 80 discharged from the auxiliary conveyor 40 to the main conveyor 50 to the downstream side.
  • the cargo handling system 1 exemplifies a mode in which the detection device (LRF 20 and camera 30), the robot device 10, the auxiliary conveyor 40, the main conveyor 50, and the control device 60 are included as components. It is not limited to this. In short, the cargo handling system 1 may be in a form including at least components related to cargo handling. For example, the cargo handling system 1 may be in a form composed of the detection device, the robot device 10, the auxiliary conveyor 40, and the control device 60 (a form in which the main conveyor 50 is not included), or the detection device and the robot device 10.
  • a form composed of the control device 60 (a form not including the auxiliary conveyor 40 and the main conveyor 50), or a form composed of the robot device 10, the auxiliary conveyor 40, and the control device 60 (the detection device described above).
  • the form in which the main conveyor 50 is not included) may be used.
  • FIG. 3 is a diagram showing an example of the hardware configuration of the control device 60.
  • the control device 60 includes a CPU (Central Processing Unit) 101, a storage unit 102, and an I / F (Interface) unit 103.
  • the minimum hardware elements included in the control device 60 are illustrated, but the present invention is not limited to this, and the control device 60 may be in a form further including other hardware elements. ..
  • the control device 60 may be further provided with a display device for displaying various types of information, or may be further provided with an input device used for various inputs by the user.
  • the CPU 101 comprehensively controls the operation of the control device 60 by executing the program, and realizes various functions of the control device 60. Various functions of the control device 60 will be described later.
  • the storage unit 102 includes, for example, a non-volatile memory (for example, ROM (Read Only Memory)) for storing various data such as a program executed by the CPU 101, and a volatile memory (for example, RAM (Random Access)) having a work area of the CPU 101. Memory)) etc. are included.
  • a non-volatile memory for example, ROM (Read Only Memory)
  • a volatile memory for example, RAM (Random Access) having a work area of the CPU 101. Memory)
  • the I / F unit 103 is an interface for connecting to an external device.
  • the external device include a robot device 10, an LRF 20, an elevating mechanism 21, a camera 30, a drive unit (for example, a motor) that drives the auxiliary conveyor 40, and a drive unit (for example, a motor) that drives the main conveyor 50.
  • FIG. 4 is a diagram showing an example of the functions of the control device 60.
  • the control device 60 includes an elevating control unit 601, an information acquisition unit 602, a robot control unit 603, and a drive control unit 604.
  • the elevating control unit 601 controls the elevating of the elevating mechanism 21.
  • the elevating control unit 601 can control the elevating mechanism 21 so as to adjust the measurement position of the LRF 20 to the height of the luggage storage container 70.
  • the information acquisition unit 602 acquires information such as the measurement result of the LRF 20 and the camera image.
  • the information acquired by the information acquisition unit 602 is input to the robot control unit 603.
  • the information acquisition unit 602 may be in the form of acquiring the measurement result of the LRF20 each time the measurement by the LRF20 is performed, or may be in the form of acquiring the measurement result of the LRF20 at a fixed cycle. It may be in the form of requesting the measurement result from the LRF 20 at an arbitrary timing and acquiring the measurement result of the LRF 20 as a response. The same applies to the method of acquiring the camera image.
  • FIG. 5 is a diagram showing an example of a detailed function of the robot control unit 603.
  • the robot control unit 603 includes an unloading target determination unit 611, a size detection unit 612, a sideways determination unit 613, a selection unit 614, and a control unit 615.
  • the functions related to the main parts of the present embodiment are illustrated, but the functions of the robot control unit 603 are not limited to these.
  • the unloading target determination unit 611 confirms whether or not there is a receivable baggage 80 from the camera image acquired by the information acquisition unit 602, and if there is a receivable baggage 80, the unloading target is to be unloaded. Determine the luggage 80.
  • the unloading target determination unit 611 can determine the package 80 having the highest top surface height among the packages 80 reflected in the camera image as the package 80 to be unloaded.
  • the size detection unit 612 detects the size of the unloading target package 80 determined by the unloading target determination unit 611. More specifically, the size detection unit 612 detects the sizes of the three sides of the package 80 to be unloaded based on the information (camera image and measurement result of the LRF 20) acquired by the information acquisition unit 602.
  • the size detection unit 612 can detect the size of the X-direction and Y-direction sides of the upper surface of the luggage 80 from the camera image. Next, a method of detecting the size of the side of the luggage 80 in the height direction will be described.
  • the size detection unit 612 moves the holding unit 11 upward until the bottom of the luggage 80 exceeds the measurement position of the LRF 20 after the luggage 80 to be unloaded stored in the containment vessel 70 is held by the holding unit 11.
  • the arm 12 is controlled so as to do so.
  • the size detection unit 612 determines the height direction of the luggage 80 from the difference between the measurement position H2 (known) of the LRF 20 and the height H3 of the holding unit 11 when the bottom of the luggage 80 exceeds the measurement position of the LRF 20. The size H1 of the side of can be detected (see FIG. 6).
  • the sideways determination unit 613 determines whether or not to lay the luggage 80 sideways and transport it to the auxiliary conveyor 40 based on the size of the luggage 80 detected by the size detection unit 612.
  • the luggage 80 Is laid on its side and is conveyed to the auxiliary conveyor 40.
  • the sideways determination unit 613 determines the load 80 as the target to be laid down.
  • the robot control unit 603 controls the arm 12 so that the luggage 80 held by the holding portion 11 is moved onto the tilt table 41.
  • the selection unit 614 shown in FIG. 5 is among a plurality of angle candidates indicating the angle candidates of the holding unit 11 when loading (dropping) the load on the tilt table 41 provided on the upstream side of the auxiliary conveyor 40. Select one angle candidate from. More specifically, the selection unit 614 selects one angle candidate from a plurality of angle candidates that does not cause an error when the arm 12 is controlled so that the angle is indicated by the angle candidate.
  • the "error” includes interference with an obstacle or the like and the angle limitation of the joint of the arm 12. That is, the selection unit 614 selects one angle candidate that can avoid interference or angle limitation of the arm joint from the plurality of angle candidates.
  • priorities are set in advance for a plurality of angle candidates, and the selection unit 614 determines whether or not an error occurs in order from the angle candidates having the highest priority. Select the angle candidate with the highest priority without causing an error.
  • backward tilting is to tilt the luggage 80 upstream with respect to the transport direction of the luggage 80 defined in the auxiliary conveyor 40 (conveyor body), and “forwardward” is defined in the auxiliary conveyor 40.
  • the luggage 80 is tilted downstream with respect to the transport direction of the luggage 80.
  • the normal angle of the holding portion 11 in the non-tilted state is set to "0 degree", and the normal direction of the holding portion 11 extends as the direction of the angle of the holding portion 11 of the tilting table 41.
  • the direction approaching the direction (in other words, the direction in which the straight line representing the inclination of the holding portion 11 approaches the extending direction of the tilt table 41) is a positive direction, and the opposite direction is a negative direction.
  • the extending direction of the tilt table 41 is the direction of a straight line representing the inclination of the tilt table 41, and the angle of the straight line corresponds to the inclination angle of the tilt table 41.
  • the method of determining the positive or negative direction of the angle of the holding portion 11 is arbitrary, and may be the opposite of the above.
  • the luggage 80 can be placed on the auxiliary conveyor 40 by the backward tilting. preferable. Further, when the luggage 80 is placed on the auxiliary conveyor 40 by tilting it backward, it is preferable to tilt the holding portion 11 so that the normal direction of the holding portion 11 is as close as possible to the extending direction of the tilting table 41. This is because the load can be reliably laid on its side while mitigating the impact on the luggage 80.
  • the angle is such that the luggage 80 is tilted upstream with respect to the transport direction of the luggage 80 defined in the auxiliary conveyor 40 and is tilted backward.
  • An angle candidate indicating an angle closer to the tilt angle of the tilt table 41 (in other words, an angle in which the normal direction of the holding portion 11 is closer to the extending direction of the tilt table 41) is set in advance so that the priority is higher.
  • FIG. 9 is a diagram showing an example of a plurality of angle candidates whose priorities are set in advance. As shown in FIG. 9, it can be seen that the angle candidate for tilting backward and showing an angle closer to the tilt angle of the tilt table 41 has a higher priority. In the example of FIG.
  • angles for moving backward are tried in descending order of the angle, and if it is not possible to move backward, the angles for moving forward are tried in descending order of the absolute value of the angle, and then moving forward. If this is not possible, select an angle candidate that indicates "0 degrees".
  • the angle of the holding portion 11 is set to be close to the normal direction of the slope of the tilting table 41 (in other words, the straight line representing the tilt of the holding portion 11 is inclined. It is preferable to tilt the holding portion 11 (so that it is close to the normal direction of the slope of the table 41). That is, it is preferable to tilt the holding portion 11 so that the front surface 82 of the holding portion 11 approaches the upper surface (mounting surface) of the auxiliary conveyor 40 (to mitigate the impact on the luggage 80).
  • the angle candidate having a larger absolute value of the angle has a higher priority. Specifically, the priority of the angle candidate indicating "-40 degrees" (third) is higher than the priority of the angle candidate indicating "-20 degrees" (fourth).
  • FIG. 10A is a diagram showing a state in which the load 80 is placed on the auxiliary conveyor 40 and conveyed when the angle candidate selected by the selection unit 614 indicates an angle for tilting backward.
  • FIG. 10B is a diagram showing a state in which the load 80 is placed on the auxiliary conveyor 40 and conveyed when the angle candidate selected by the selection unit 614 indicates an angle for moving forward.
  • control unit 615 controls suction / stop (hold / release) of the holding unit 11, angle control of the holding unit 11, control of the arm 12, and the like, but the control performed by the control unit 615 is the above control. It is not limited to. The above is the function of the robot control unit 603.
  • the drive control unit 604 controls the drive unit of the auxiliary conveyor 40 and the drive unit of the main conveyor 50.
  • the drive control unit 604 has a threshold value of the angle (angle with respect to the normal direction of the holding unit) between the extending direction of the tilt table 41 and the holding unit 11 controlled to the angle indicated by the angle candidate selected by the selection unit 614. In the above case, when the holding by the holding unit 11 is released, the operation of stopping the driving of the auxiliary conveyor 40 is controlled for a certain period of time.
  • the luggage 80 when the angle formed by the extending direction of the tilt table 41 and the normal direction of the holding unit 11 controlled by the angle indicated by the angle candidate selected by the selection unit 614 is equal to or greater than the threshold value, for example, the luggage 80 It is assumed that the angle of the holding portion 11 holding the above is controlled to an angle for moving forward. For example, in the case of moving forward as shown in FIG. 10B, the frictional force due to the rotation of the auxiliary conveyor 40 acts in a direction that hinders the sideways of the load 80. Therefore, the load 80 is stopped by stopping the drive of the auxiliary conveyor 40 for a certain period of time. It can be laid down smoothly.
  • the CPU 101 shown in FIG. 3 executes a program stored in the storage unit 102. It is realized by doing.
  • the present invention is not limited to this, and for example, some or all of the functions of the above-mentioned parts can be realized by a dedicated hardware circuit (for example, a semiconductor integrated circuit).
  • the control device 60 releases the holding by the holding unit 11 after moving the luggage 80 held by the holding unit 11 of the robot device 10 onto the auxiliary conveyor 40 for transporting the luggage 80. Then, the luggage 80 is controlled to be dropped and placed on the auxiliary conveyor, which can be considered as an example of the “cargo handling device”. Further, the present invention is not limited to this, and for example, a combination of the control device 60 and the robot device 10 can be considered as an example of the “cargo handling device”.
  • FIG. 11 is a flowchart showing an operation example of the control device 60 of the present embodiment.
  • the elevating control unit 601 controls the elevating mechanism 21 to elevate and lower so as to match the measurement position of the LRF 20 with the height of the luggage containment vessel 70 (step S1).
  • the drive control unit 604 controls the drive unit of the auxiliary conveyor 40 so that the load 80 placed on the auxiliary conveyor 40 is conveyed in the transport direction (step S2).
  • step S3 the information acquisition unit 602 acquires a camera image
  • step S4 the unloading target determination unit 611 confirms whether or not there is a receivable package 80 from the camera image acquired in step S3 (step S4). If the result of step S4 is negative (step S4: No), the process ends. If the result of step S4 is affirmative (step S4: Yes), the unloading target determination unit 611 determines the unloading target package 80 from the holdable packages 80 (step S5).
  • the size detection unit 612 detects the size of the package 80 to be unloaded determined in step S5 (step S6).
  • the sideways determination unit 613 determines whether or not to lay the luggage 80 sideways and transport it to the auxiliary conveyor 40 based on the size detected in step S6 (step S7).
  • step S7 When the result of step S7 is negative (step S7: No), the robot control unit 603 (for example, control unit 615) has an arm so that the position of the holding unit 11 is a position where the load 80 to be unloaded can be held. After controlling 12 to hold the luggage 80 in the holding portion 11, the position of the holding portion 11 in that state is the region on the upstream side on the upper surface of the auxiliary conveyor 40 where the tilting table 41 is installed. The arm 12 is controlled so as to be located above the downstream region. That is, the robot control unit 603 holds the load 80 to be unloaded by the holding unit 11 and moves it onto the auxiliary conveyor 40 (step S8). Then, the robot control unit 603 (for example, the control unit 615) releases the holding by the holding unit 11 and drops the luggage 80 onto the tilt table 41 (step S9).
  • the robot control unit 603 for example, control unit 615
  • step S7 when the result of step S7 is affirmative (step S7: Yes), in the robot control unit 603 (for example, control unit 615), the position of the holding unit 11 is set to a position where the load 80 to be unloaded can be held. After controlling the arm 12 to hold the load 80 on the holding portion 11, the arm 12 is controlled so that the holding portion 11 in that state is located on the tilt table 41. That is, the robot control unit 603 holds the load 80 to be unloaded by the holding unit 11 and moves it onto the tilt table 41 (step S10).
  • the selection unit 614 selects the angle candidate having the highest priority among the plurality of angle candidates (step S11), and makes an error when controlling the arm 12 so that the angle indicated by the selected angle candidate is obtained. Is determined (step S12). This determination is made by simulation or the like, and the determination is not made by actually controlling the arm 12.
  • step S12 When the result of step S12 is affirmative (step S12: Yes), the selection unit 614 selects the angle candidate having the next highest priority after the angle candidate determined in step S12 (step S13), and repeats the process of step S12. ..
  • step S12: No When the result of step S12 is negative (step S12: No), the selection unit 614 notifies the control unit 615 of the angle candidate at that time as the final selection result, and the control unit 615 has the angle of the holding unit 11 changed. , The arm 12 is controlled so that the angle indicated by the angle candidate notified from the selection unit 614 is obtained (step S14).
  • the robot control unit 603 determines whether or not the angle formed by the extending direction of the tilt table 41 and the normal direction of the holding unit 11 whose angle is controlled in step S14 is equal to or greater than the threshold value (Ste S15). That is, in this example, it is determined whether or not the angle of the holding portion 11 is an angle for moving forward. This determination may be made, for example, by the control unit 615 or by another functional element of the robot control unit 603.
  • step S15 If the result of step S15 is affirmative (step S15: Yes), the robot control unit 603 notifies the drive control unit 604 to that effect, and the drive control unit 604 receiving this notification stops driving the auxiliary conveyor 40. Control is performed (step S16). Then, the robot control unit 603 (control unit 615) releases the holding by the holding unit 11 and drops the luggage 80 onto the tilt table 41 (step S17). After that, the drive control unit 604 controls to stop the drive of the auxiliary conveyor 40 for a certain period of time and then restart the drive of the auxiliary conveyor 40 (step S18). After that, the processing of step S3 and subsequent steps is repeated.
  • step S15 When the result of step S15 is negative (step S15: No), for example, when the angle of the holding unit 11 is an angle for tilting backward, the robot control unit 603 (control unit 615) holds the robot by the holding unit 11. It is released and the luggage 80 is dropped onto the tilt table 41 (step S19). At this time, the auxiliary conveyor 40 continues to be driven. After that, the processing of step S3 and subsequent steps is repeated.
  • the control device 60 of the present embodiment when the luggage 80 is laid on its side and conveyed to the auxiliary conveyor 40, the luggage 80 is placed on the tilt table 41 provided on the upstream side of the auxiliary conveyor 40.
  • One angle candidate is selected from a plurality of angle candidates indicating the angle candidates of the holding unit 11, and the angle of the holding unit 11 is controlled so as to be the angle indicated by the selected angle candidate. Controls to release the holding by. More specifically, the control device 60 selects one angle candidate from the plurality of angle candidates that does not cause an error when the arm 12 is controlled so as to have the angle indicated by the angle candidate. As a result, the luggage 80 can be properly laid down.
  • the priority order is set in advance for the plurality of angle candidates, and the control device 60 determines whether or not an error occurs in order from the angle candidate having the highest priority. Then, select the angle candidate with the highest priority without causing an error. As a result, the holding portion 11 can be tilted at an angle close to the target while avoiding errors such as interference and angle limitation of the joint of the arm 12.
  • the priority order of a plurality of angle candidates is set in advance for each of the plurality of modes corresponding to the method of tilting the luggage 80, and a plurality of angles associated with any one of the plurality of modes. It differs from the above-described first embodiment in that one angle candidate is selected from the candidates.
  • the specific contents will be described below. The parts common to the first embodiment described above will be omitted as appropriate.
  • FIG. 12 is a diagram showing an example of the function of the robot control unit 603 of the present embodiment. As shown in FIG. 12, the robot control unit 603 is different from the above-described first embodiment in that it further includes a second selection unit 620.
  • the second selection unit 620 selects one of a plurality of modes.
  • the plurality of modes include at least a first mode in which the luggage 80 is placed on the auxiliary conveyor 40 in the backward direction and a second mode in which the luggage 80 is placed in the auxiliary conveyor 40 in the forward direction is prioritized.
  • the plurality of angle candidates associated with the first mode are angles for tilting backward, and the angle candidates showing an angle closer to the tilt angle of the tilt table 41 have a higher priority.
  • the plurality of angle candidates associated with the second mode are angles for moving forward, and the angle of the holding portion 11 indicates an angle close to the normal direction of the slope of the tilt table 41. Candidates have higher priority.
  • FIG. 13 is a diagram showing an example of a plurality of angle candidates associated with each mode.
  • a third method corresponding to a tilting method in which the holding portion 11 is tilted with priority given to an angle having a large absolute value regardless of whether the holding portion 11 is tilted backward or forward. Modes are available.
  • the higher the absolute value the higher the priority.
  • the backward-forwarding angle is prioritized.
  • the present invention is not limited to this, and for example, the forward angle can be prioritized.
  • the second selection unit 620 shown in FIG. 12 selects one of a plurality of modes according to the positional relationship between the robot device 10 and the tilt table 41.
  • the position of the holding unit 11 when the held luggage 80 is placed on the tilt table 41 (when dropped) is the main body (arm 12 is connected) of the robot device 10 among the plurality of modes. Priority is given to the mode corresponding to the defeat method that is closest to the main body. Since the method of tilting the holding portion 11 closest to the robot device 10 changes according to the positional relationship between the robot device 10 and the tilting table 41, the second selection unit 620 installs the robot device 10 and the tilting table 41. The mode will be selected according to the environment.
  • the position of the holding portion 11 when tilted to the backward tilting position is higher than the position of the holding portion 11 when tilted to the forward tilting angle.
  • the second selection unit 620 selects the first mode in which the method of placing the luggage 80 backwards on the auxiliary conveyor 40 is prioritized.
  • the position of the holding portion 11 when tilted at an angle for tilting forward is higher than the position of the holding portion 11 when tilted at an angle for tilting backward, as shown in FIG.
  • the second selection unit 620 selects a second mode in which the method of placing the luggage 80 on the auxiliary conveyor 40 in advance is prioritized. Further, for example, the difference between the position of the holding portion 11 when tilted at an angle for tilting forward and the position of the holding portion 11 when tilted at an angle for tilting backward with respect to the main body of the robot device 10 is a reference. If the value is less than the value (when there is almost no difference), the second selection unit 620 selects a third mode corresponding to the tilting method of tilting the holding unit 11 with priority given to an angle having a large absolute value.
  • the position of the holding portion 11 when the held luggage 80 is placed on the tilting table 41 is the robot according to the positional relationship between the robot device 10 and the tilting table 41. Select the mode corresponding to the method of tilting that is closest to the main body of the device 10. Then, the control device 60 selects one angle candidate that does not cause an error from the plurality of angle candidates associated with the selected mode.
  • the mode in which there are few angle candidates that cause an error is selected in advance, one angle candidate can be selected in a short time. Then, the angle of the holding unit 11 is controlled so as to be the angle indicated by the selected angle candidate, and the holding by the holding unit 11 is controlled to be released. According to the present embodiment, it is possible to appropriately select a method of laying down the luggage 80 by reflecting the installation environment of the robot device 10 and the tilting table 41.
  • the above-mentioned sideways determination unit 613 determines that the luggage 80 is to be laid down when the side in the height direction is the longest side among the three sides of the luggage 80 to be unloaded, but the present invention is limited to this. It's not a thing.
  • X / H indicating the ratio of the size X of the width direction side (the side in the X direction or the side in the Y direction) of the luggage 80 to the size H of the side in the height direction is equal to or less than the reference value.
  • the luggage 80 can be determined to be laid down.
  • the drive control unit 604 controls the drive unit of the auxiliary conveyor 40 so that the load 80 mounted on the auxiliary conveyor 40 is conveyed in the direction opposite to the transfer direction.
  • the frictional force due to the rotation of the auxiliary conveyor 40 acts in the direction of promoting the sideways rolling of the luggage 80, so that the luggage 80 can be smoothly turned over.
  • the above-mentioned second selection unit 620 selects any one of a plurality of modes according to the positional relationship between the robot device 10 and the tilt table 41, but is not limited to this.
  • the second selection unit 620 may be in the form of selecting one of the plurality of modes according to the instruction received from the user.
  • the second selection unit 620 acquires characteristic information (information indicating characteristics such as cracks) regarding the characteristics of the package 80 to be unloaded, and among the plurality of modes according to the acquired characteristic information. It may be in the form of selecting either one. For example, when the second selection unit 620 acquires the characteristic information indicating a crack as the characteristic information of the package 80 to be unloaded, the second selection unit 620 corresponds to the first method of tilting, which gives priority to backward tilting in order to alleviate the impact on the package. You can select the mode.
  • the storage destination of the feature information is arbitrary.
  • the corresponding information associated with the feature information of the baggage 80 is stored in the storage unit in the control device 60. It may be stored in 102, or may be stored in a storage device such as an external server.
  • the second selection unit 620 can acquire the feature information associated with the package 80 to be unloaded by referring to the corresponding information.

Abstract

Provided is a cargo handling apparatus with which it is possible to appropriately overturn a cargo sideways. The cargo handling apparatus according to an embodiment is provided with a holding unit that holds a cargo and an arm that causes the holding unit to move, and causes a cargo held by the holding unit to be moved above a conveyor body for conveying the cargo, and then places the cargo on the conveyor body by releasing the holding by the holding unit. The cargo handling apparatus is provided with a control unit. When causing the conveyor body to convey the cargo in a state of being overturned sideways, the control unit selects an angle option from a plurality of angle options indicating options for an angle of the holding unit upon placement of the cargo on a tilted table provided on an upstream side of the conveying body, and carries out a control to release the hold by the holding unit by regulating the angle of the holding unit to an angle indicated by the angle option thus selected.

Description

荷役装置Cargo handling equipment
 本発明は、荷役装置に関する。 The present invention relates to a cargo handling device.
 例えば物流倉庫などにおいて、収納された商品等の荷物をロボット装置によって取り出してベルトコンベアなどへ荷卸しする荷役システムが知られている。このような荷役システムにおいては、搬送後の下流での処理のため、または、搬送中の転倒防止のために、荷物を横倒しにして搬送する必要が生じる場合がある。 For example, in a distribution warehouse or the like, a cargo handling system is known in which a stored product or the like is taken out by a robot device and unloaded to a belt conveyor or the like. In such a cargo handling system, it may be necessary to lay the load on its side for transportation in order to process it downstream after transportation or to prevent it from tipping over during transportation.
 荷物を横倒しにする方法としては、例えばベルトコンベアの荷卸し位置に傾斜台(スロープ)を設け、荷物を傾けた状態で傾斜台へ落下させることで、荷物を横倒しにする技術が知られている。 As a method of laying the luggage on its side, for example, a technique is known in which a tilting table (slope) is provided at the unloading position of the belt conveyor and the luggage is dropped onto the tilting table in a tilted state to lay the luggage on its side. ..
特開2018-158801号公報JP-A-2018-158801
 しかしながら、傾斜台へ落下させる際の荷物の角度によっては、障害物等の干渉またはロボット装置のアームの関節角度の制限を受けて、該角度に制御することができず、荷物を適切に横倒しすることができない場合がある。 However, depending on the angle of the load when it is dropped onto the tilt table, it cannot be controlled to that angle due to interference from obstacles or the limitation of the joint angle of the arm of the robot device, and the load is laid down appropriately. It may not be possible.
 本発明が解決しようとする課題は、荷物を適切に横倒しすることが可能な荷役装置を提供することである。 The problem to be solved by the present invention is to provide a cargo handling device capable of properly laying down a luggage.
 実施形態の荷役装置は、荷物を保持する保持部と、保持部を移動させるアームと、を備え、保持部により保持された荷物を、荷物を搬送するための搬送体の上に移動させた後に、保持部による保持を解放して荷物を前記搬送体へ載せる。荷役装置は、制御部を備える。制御部は、荷物を横倒しにして搬送体に搬送させる場合、搬送体の上流側に設けられた傾斜台へ荷物を載せる際の保持部の角度の候補を示す複数の角度候補の中から、一の角度候補を選択し、保持部の角度を、選択された角度候補が示す角度に制御して、保持部による保持を解放する制御を行う。 The cargo handling device of the embodiment includes a holding portion for holding the luggage and an arm for moving the holding portion, and after moving the luggage held by the holding portion onto the carrier for carrying the luggage. , The holding by the holding portion is released, and the load is placed on the carrier. The cargo handling device includes a control unit. When the control unit lays the load on its side and conveys it to the carrier, one of a plurality of angle candidates indicating the angle candidates of the holding section when the load is placed on the tilt table provided on the upstream side of the carrier. The angle candidate of is selected, the angle of the holding unit is controlled to the angle indicated by the selected angle candidate, and the holding by the holding unit is controlled to be released.
図1は、第1の実施形態の荷役システムの平面図。FIG. 1 is a plan view of the cargo handling system of the first embodiment. 図2は、第1の実施形態の荷役システムの側面図。FIG. 2 is a side view of the cargo handling system of the first embodiment. 図3は、第1の実施形態の制御装置のハードウェア構成の一例を示す図。FIG. 3 is a diagram showing an example of the hardware configuration of the control device according to the first embodiment. 図4は、第1の実施形態の制御装置が有する機能の一例を示す図。FIG. 4 is a diagram showing an example of the function of the control device of the first embodiment. 図5は、第1の実施形態のロボット制御部の詳細な機能の一例を示す図。FIG. 5 is a diagram showing an example of a detailed function of the robot control unit of the first embodiment. 図6は、第1の実施形態の荷物の高さ方向のサイズの検出方法の説明図。FIG. 6 is an explanatory diagram of a method for detecting the size of the luggage in the height direction of the first embodiment. 図7は、第1の実施形態の荷物の移動の態様の一例を示す図。FIG. 7 is a diagram showing an example of a mode of moving luggage according to the first embodiment. 図8は、第1の実施形態の荷卸の倒し方の説明図。FIG. 8 is an explanatory diagram of how to defeat the unloader of the first embodiment. 図9は、第1の実施形態の複数の角度候補の一例を示す図。FIG. 9 is a diagram showing an example of a plurality of angle candidates according to the first embodiment. 図10は、荷物を横倒しにして搬送する態様の一例を示す図。FIG. 10 is a diagram showing an example of a mode in which a load is laid on its side and transported. 図11は、第1の実施形態の制御装置の動作例を示すフローチャート。FIG. 11 is a flowchart showing an operation example of the control device of the first embodiment. 図12は、第2の実施形態の制御装置が有する機能の一例を示す図。FIG. 12 is a diagram showing an example of the function of the control device of the second embodiment. 図13は、第2の実施形態の複数の角度候補の一例を示す図。FIG. 13 is a diagram showing an example of a plurality of angle candidates of the second embodiment. 図14は、第2の実施形態のモードの選択方法の説明図。FIG. 14 is an explanatory diagram of a mode selection method of the second embodiment. 図15は、第2の実施形態のモードの選択方法の説明図。FIG. 15 is an explanatory diagram of a mode selection method of the second embodiment.
 以下、添付図面を参照しながら、実施形態に係る荷役装置を詳細に説明する。 Hereinafter, the cargo handling device according to the embodiment will be described in detail with reference to the attached drawings.
(第1の実施形態)
 図1は、本実施形態の荷役システム1の構成の一例を示す図である。例えば荷役システム1は、物流センターなどに設置され、荷物が収容された容器(荷物格納容器)から荷物を取り出し、その取り出した荷物を、荷物を搬送するコンベアへ載せるシステムである。
(First Embodiment)
FIG. 1 is a diagram showing an example of the configuration of the cargo handling system 1 of the present embodiment. For example, the cargo handling system 1 is a system installed in a distribution center or the like, which takes out a baggage from a container (cargage storage container) in which the baggage is stored and puts the taken out baggage on a conveyor for transporting the baggage.
 図1は荷役システム1の平面図であり、図2は荷役システム1の側面図である。図1および図2に示すように、荷役システム1は、ロボット装置10と、レーザレンジファインダ(以下、「LRF」と称する)20と、カメラ30と、補助コンベア40と、メインコンベア50と、制御装置60と、を含む。 FIG. 1 is a plan view of the cargo handling system 1, and FIG. 2 is a side view of the cargo handling system 1. As shown in FIGS. 1 and 2, the cargo handling system 1 controls the robot device 10, the laser range finder (hereinafter referred to as “LRF”) 20, the camera 30, the auxiliary conveyor 40, and the main conveyor 50. The device 60 and the like.
 ロボット装置10は、制御装置60の制御の下、荷物格納容器70に格納された荷物80を取り出し、その取り出した荷物80を補助コンベア40に載せる装置である。ロボット装置10は、保持部11と、アーム12と、を少なくとも備える。 The robot device 10 is a device that takes out the luggage 80 stored in the luggage storage container 70 under the control of the control device 60 and puts the taken out luggage 80 on the auxiliary conveyor 40. The robot device 10 includes at least a holding unit 11 and an arm 12.
 保持部11は荷物80を保持する手段である。例えば保持部11は、1つ以上の吸着パッドを有する構成とすることができる。この場合、各吸着パッドには、該吸着パッドを真空吸引するポンプが例えばホースなどを介して接続されており、荷物80に対して吸着パッドが押し当てられた状態で吸着パッドを吸引することで荷物80を保持し、該吸引を停止することで保持していた荷物80を解放して落下させることができる。なお、これに限らず、保持部11は荷物80を保持/解放可能な構成であればよく、公知の様々な技術を利用可能である。例えば保持部11は、荷物80を挟み持つ(把持する)機構などであってもよい。ここでは、「把持」は「保持」の一態様であると考えることができる。 The holding unit 11 is a means for holding the luggage 80. For example, the holding unit 11 can be configured to have one or more suction pads. In this case, a pump for vacuum suctioning the suction pad is connected to each suction pad via, for example, a hose, and the suction pad is sucked in a state where the suction pad is pressed against the luggage 80. By holding the luggage 80 and stopping the suction, the held luggage 80 can be released and dropped. Not limited to this, the holding unit 11 may have a structure capable of holding / releasing the luggage 80, and various known techniques can be used. For example, the holding portion 11 may be a mechanism for sandwiching (grasping) the luggage 80. Here, "grasping" can be considered as an aspect of "holding".
 アーム12は、保持部11を移動させる手段である。例えばアーム12は多関節アームであり、複数のアーム部材と、複数のアーム部材を回動可能に連結する連結部と、を有する構成とすることができる。アーム12の先端部は、保持部11に接続され、保持部11を支持している。アーム220は、制御装置60の制御の下(制御装置60から入力される、X方向、Y方向、Z方向の座標に基づき)、3次元空間の所望の位置に保持部11を移動させることができる。ここでは、X方向およびY方向は水平面に沿う方向であり、互いに交差(例えば略直交)する方向である。またZ方向は鉛直方向である。 The arm 12 is a means for moving the holding portion 11. For example, the arm 12 is an articulated arm, and may have a configuration having a plurality of arm members and a connecting portion for rotatably connecting the plurality of arm members. The tip of the arm 12 is connected to the holding portion 11 and supports the holding portion 11. The arm 220 can move the holding unit 11 to a desired position in the three-dimensional space under the control of the control device 60 (based on the coordinates in the X, Y, and Z directions input from the control device 60). it can. Here, the X direction and the Y direction are directions along the horizontal plane and intersect with each other (for example, substantially orthogonal to each other). The Z direction is the vertical direction.
 例えば制御装置60は、保持部11の位置が、荷物格納容器70に格納された荷卸し対象の荷物80を保持可能な位置になるようにアーム12を制御し、該位置で保持部11の吸引を実行する制御を行うことで、荷卸し対象の荷物80を保持部11に保持させることができる。そして、制御装置60は、荷物80を保持した状態の保持部11の位置が補助コンベア40への荷卸し位置(荷物80を補助コンベア40に載せる位置)になるようにアーム12を制御し、該荷卸し位置で保持部11の吸引を停止する制御を行うことで、保持部11による保持を解放して荷物80を落下させて補助コンベア40に載せることができる。制御装置60の具体的な内容については後述する。 For example, the control device 60 controls the arm 12 so that the position of the holding unit 11 is a position where the luggage 80 to be unloaded stored in the luggage storage container 70 can be held, and the suction of the holding unit 11 is performed at that position. By controlling the execution of the above, the holding unit 11 can hold the luggage 80 to be unloaded. Then, the control device 60 controls the arm 12 so that the position of the holding portion 11 holding the luggage 80 is the unloading position on the auxiliary conveyor 40 (the position where the luggage 80 is placed on the auxiliary conveyor 40). By controlling the suction of the holding unit 11 to be stopped at the unloading position, the holding by the holding unit 11 can be released, and the load 80 can be dropped and placed on the auxiliary conveyor 40. The specific contents of the control device 60 will be described later.
 図1の説明を続ける。LRF20は、荷卸し対象の荷物80の高さ方向(Z方向)のサイズ検出に用いられるセンサであり、光波を用いて距離を測定するセンサである。昇降機構21は、制御装置60の制御の下、LRF20を昇降させる装置である。 Continue the explanation of Fig. 1. The LRF 20 is a sensor used to detect the size of the load 80 to be unloaded in the height direction (Z direction), and is a sensor that measures a distance using light waves. The elevating mechanism 21 is a device for elevating and lowering the LRF 20 under the control of the control device 60.
 カメラ30は、3次元画像を撮像可能な3次元カメラであり、被写体(物体)の形状や大きさを三次元で捉えることができる。本実施形態では、カメラ30は、荷物格納容器70の上方に配置され、荷物格納容器70に格納された荷物80の上面を撮像する。以下の説明では、カメラ30により撮像された画像(この例では3次元画像)を「カメラ画像」と称する場合がある。 The camera 30 is a three-dimensional camera capable of capturing a three-dimensional image, and can capture the shape and size of a subject (object) in three dimensions. In the present embodiment, the camera 30 is arranged above the luggage storage container 70 and images the upper surface of the luggage 80 stored in the luggage storage container 70. In the following description, the image captured by the camera 30 (three-dimensional image in this example) may be referred to as a “camera image”.
 本実施形態では、制御装置60は、LRF20の測定結果およびカメラ画像から、荷卸し対象の荷物80のサイズを検出し、その検出したサイズに基づいて、荷物80を横倒しにして補助コンベア40に搬送させるか否かを判断する。詳しくは後述する。この例では、LRF20およびカメラ30は、荷物80のサイズに関するサイズ情報(例えば3辺のサイズ情報)の検出に用いられる「検出装置」として機能する。 In the present embodiment, the control device 60 detects the size of the load 80 to be unloaded from the measurement result of the LRF 20 and the camera image, and based on the detected size, the load 80 is laid down and conveyed to the auxiliary conveyor 40. Decide whether to let it. Details will be described later. In this example, the LRF 20 and the camera 30 function as "detectors" used to detect size information (eg, three-sided size information) about the size of the luggage 80.
 図1の説明を続ける。補助コンベア40は、荷物80を搬送するための「搬送体」の一例であり、ロボット装置10から受け取った荷物80をメインコンベア50へ向けて搬送する。補助コンベア40の上流側には、荷物80を横倒しにするための傾斜台(スロープ)41が設けられる。メインコンベア50は、補助コンベア40からメインコンベア50へ排出された荷物80を下流側に搬送する。 Continue the explanation of Fig. 1. The auxiliary conveyor 40 is an example of a “conveyor body” for transporting the luggage 80, and transports the luggage 80 received from the robot device 10 toward the main conveyor 50. On the upstream side of the auxiliary conveyor 40, a tilt table (slope) 41 for laying down the luggage 80 is provided. The main conveyor 50 conveys the load 80 discharged from the auxiliary conveyor 40 to the main conveyor 50 to the downstream side.
 なお、本実施形態では、荷役システム1は、上記検出装置(LRF20およびカメラ30)、ロボット装置10、補助コンベア40、メインコンベア50、制御装置60を構成要素として含む形態を例示しているが、これに限られるものではない。要するに、荷役システム1は、荷役に関する構成要素を少なくとも含む形態であればよい。例えば荷役システム1は、上記検出装置、ロボット装置10、補助コンベア40、制御装置60から構成される形態(メインコンベア50が含まれない形態)であってもよいし、上記検出装置、ロボット装置10、制御装置60から構成される形態(補助コンベア40、メインコンベア50が含まれない形態)であってもよいし、ロボット装置10、補助コンベア40、制御装置60から構成される形態(上記検出装置、メインコンベア50が含まれない形態)であってもよい。 In the present embodiment, the cargo handling system 1 exemplifies a mode in which the detection device (LRF 20 and camera 30), the robot device 10, the auxiliary conveyor 40, the main conveyor 50, and the control device 60 are included as components. It is not limited to this. In short, the cargo handling system 1 may be in a form including at least components related to cargo handling. For example, the cargo handling system 1 may be in a form composed of the detection device, the robot device 10, the auxiliary conveyor 40, and the control device 60 (a form in which the main conveyor 50 is not included), or the detection device and the robot device 10. , A form composed of the control device 60 (a form not including the auxiliary conveyor 40 and the main conveyor 50), or a form composed of the robot device 10, the auxiliary conveyor 40, and the control device 60 (the detection device described above). , The form in which the main conveyor 50 is not included) may be used.
 図3は、制御装置60のハードウェア構成の一例を示す図である。図3に示すように、制御装置60は、CPU(Central Processing Unit)101と、記憶部102と、I/F(Interface)部103と、を備える。なお、図3の例では、制御装置60が備える最低限のハードウェア要素を例示しているが、これに限らず、制御装置60は、他のハードウェア要素をさらに備える形態であってもよい。例えば制御装置60は、各種の情報を表示する表示デバイスをさらに備える形態であってもよいし、ユーザによる各種の入力に用いられる入力デバイスをさらに備える形態であってもよい。 FIG. 3 is a diagram showing an example of the hardware configuration of the control device 60. As shown in FIG. 3, the control device 60 includes a CPU (Central Processing Unit) 101, a storage unit 102, and an I / F (Interface) unit 103. In the example of FIG. 3, the minimum hardware elements included in the control device 60 are illustrated, but the present invention is not limited to this, and the control device 60 may be in a form further including other hardware elements. .. For example, the control device 60 may be further provided with a display device for displaying various types of information, or may be further provided with an input device used for various inputs by the user.
 CPU101は、プログラムを実行することにより、制御装置60の動作を統括的に制御し、制御装置60が有する各種の機能を実現する。制御装置60が有する各種の機能については後述する。 The CPU 101 comprehensively controls the operation of the control device 60 by executing the program, and realizes various functions of the control device 60. Various functions of the control device 60 will be described later.
 記憶部102は、例えばCPU101が実行するプログラム等の各種データを記憶する不揮発性のメモリ(例えばROM(Read Only Memory))、および、CPU101の作業領域を有する揮発性のメモリ(例えばRAM(Random Access Memory))などを含んで構成される。 The storage unit 102 includes, for example, a non-volatile memory (for example, ROM (Read Only Memory)) for storing various data such as a program executed by the CPU 101, and a volatile memory (for example, RAM (Random Access)) having a work area of the CPU 101. Memory)) etc. are included.
 I/F部103は、外部装置と接続するためのインタフェースである。外部装置としては、例えばロボット装置10、LRF20、昇降機構21、カメラ30、補助コンベア40を駆動する駆動部(例えばモータ)、メインコンベア50を駆動する駆動部(例えばモータ)などが挙げられる。 The I / F unit 103 is an interface for connecting to an external device. Examples of the external device include a robot device 10, an LRF 20, an elevating mechanism 21, a camera 30, a drive unit (for example, a motor) that drives the auxiliary conveyor 40, and a drive unit (for example, a motor) that drives the main conveyor 50.
 図4は、制御装置60が有する機能の一例を示す図である。なお、図4の例では、本実施形態の要部に関する機能のみを例示しているが、制御装置60が有する機能はこれらに限られるものではない。図4に示すように、制御装置60は、昇降制御部601、情報取得部602、ロボット制御部603、駆動制御部604を有する。 FIG. 4 is a diagram showing an example of the functions of the control device 60. In the example of FIG. 4, only the functions related to the main parts of the present embodiment are illustrated, but the functions of the control device 60 are not limited to these. As shown in FIG. 4, the control device 60 includes an elevating control unit 601, an information acquisition unit 602, a robot control unit 603, and a drive control unit 604.
 昇降制御部601は、昇降機構21の昇降を制御する。例えば昇降制御部601は、LRF20の測定位置を荷物格納容器70の高さに合わせるように昇降機構21を昇降させる制御を行うことができる。 The elevating control unit 601 controls the elevating of the elevating mechanism 21. For example, the elevating control unit 601 can control the elevating mechanism 21 so as to adjust the measurement position of the LRF 20 to the height of the luggage storage container 70.
 情報取得部602は、LRF20の測定結果およびカメラ画像などの情報を取得する。情報取得部602により取得された情報はロボット制御部603へ入力される。例えば情報取得部602は、LRF20による測定が行われるたびに、LRF20の測定結果を取得する形態であってもよいし、一定の周期でLRF20の測定結果を取得する形態であってもよいし、任意のタイミングでLRF20に対して測定結果を要求し、その応答としてLRF20の測定結果を取得する形態であってもよい。カメラ画像の取得方法についても同様である。 The information acquisition unit 602 acquires information such as the measurement result of the LRF 20 and the camera image. The information acquired by the information acquisition unit 602 is input to the robot control unit 603. For example, the information acquisition unit 602 may be in the form of acquiring the measurement result of the LRF20 each time the measurement by the LRF20 is performed, or may be in the form of acquiring the measurement result of the LRF20 at a fixed cycle. It may be in the form of requesting the measurement result from the LRF 20 at an arbitrary timing and acquiring the measurement result of the LRF 20 as a response. The same applies to the method of acquiring the camera image.
 ロボット制御部603は、ロボット装置10を制御する。図5は、ロボット制御部603が有する詳細な機能の一例を示す図である。図5に示すように、ロボット制御部603は、荷卸し対象決定部611、サイズ検出部612、横倒し決定部613、選択部614、制御部615を有する。なお、図5の例では、本実施形態の要部に関する機能のみを例示しているが、ロボット制御部603が有する機能はこれらに限られるものではない。 The robot control unit 603 controls the robot device 10. FIG. 5 is a diagram showing an example of a detailed function of the robot control unit 603. As shown in FIG. 5, the robot control unit 603 includes an unloading target determination unit 611, a size detection unit 612, a sideways determination unit 613, a selection unit 614, and a control unit 615. In the example of FIG. 5, only the functions related to the main parts of the present embodiment are illustrated, but the functions of the robot control unit 603 are not limited to these.
 荷卸し対象決定部611は、情報取得部602により取得されたカメラ画像から、保持可能な荷物80が存在するか否かを確認し、保持可能な荷物80が存在する場合は、荷卸し対象の荷物80を決定する。例えば荷卸し対象決定部611は、カメラ画像に映り込んだ荷物80のうち、上面の高さが最も高い荷物80を荷卸し対象の荷物80として決定することができる。 The unloading target determination unit 611 confirms whether or not there is a receivable baggage 80 from the camera image acquired by the information acquisition unit 602, and if there is a receivable baggage 80, the unloading target is to be unloaded. Determine the luggage 80. For example, the unloading target determination unit 611 can determine the package 80 having the highest top surface height among the packages 80 reflected in the camera image as the package 80 to be unloaded.
 サイズ検出部612は、荷卸し対象決定部611により決定された荷卸し対象の荷物80のサイズを検出する。より具体的には、サイズ検出部612は、情報取得部602により取得された情報(カメラ画像およびLRF20の測定結果)に基づいて、荷卸し対象の荷物80の3辺のサイズを検出する。 The size detection unit 612 detects the size of the unloading target package 80 determined by the unloading target determination unit 611. More specifically, the size detection unit 612 detects the sizes of the three sides of the package 80 to be unloaded based on the information (camera image and measurement result of the LRF 20) acquired by the information acquisition unit 602.
 以下、荷物80の3辺のサイズを検出する方法について説明する。サイズ検出部612は、カメラ画像から、荷物80の上面のX方向およびY方向の辺のサイズを検出することができる。次に、荷物80の高さ方向の辺のサイズを検出する方法について説明する。サイズ検出部612は、荷物格納容器70に格納された荷卸し対象の荷物80が保持部11により保持された後、該荷物80の底がLRF20の測定位置を超えるまで保持部11が上方に移動するようにアーム12を制御する。保持部11により保持された荷物80の底がLRF20の測定位置を超えたか否かは、LRF20の測定結果が、LRF20と荷物80との距離Dに相当する値を連続的に示した後に、急峻に異なる値(または測定不能を示すエラー値)に変化したか否かで判断することができる。ここでは、LRF20の測定結果は、荷物80の底がLRF20の測定位置を超えたか否かの判断に用いられる。そして、サイズ検出部612は、LRF20の測定位置H2(既知)と、荷物80の底がLRF20の測定位置を超えたときの保持部11の高さH3との差分から、荷物80の高さ方向の辺のサイズH1を検出することができる(図6参照)。 The method of detecting the size of the three sides of the luggage 80 will be described below. The size detection unit 612 can detect the size of the X-direction and Y-direction sides of the upper surface of the luggage 80 from the camera image. Next, a method of detecting the size of the side of the luggage 80 in the height direction will be described. The size detection unit 612 moves the holding unit 11 upward until the bottom of the luggage 80 exceeds the measurement position of the LRF 20 after the luggage 80 to be unloaded stored in the containment vessel 70 is held by the holding unit 11. The arm 12 is controlled so as to do so. Whether or not the bottom of the luggage 80 held by the holding unit 11 exceeds the measurement position of the LRF 20 is steep after the measurement result of the LRF 20 continuously shows a value corresponding to the distance D between the LRF 20 and the luggage 80. It can be judged whether or not the value has changed to a different value (or an error value indicating unmeasurable). Here, the measurement result of the LRF 20 is used to determine whether or not the bottom of the luggage 80 exceeds the measurement position of the LRF 20. Then, the size detection unit 612 determines the height direction of the luggage 80 from the difference between the measurement position H2 (known) of the LRF 20 and the height H3 of the holding unit 11 when the bottom of the luggage 80 exceeds the measurement position of the LRF 20. The size H1 of the side of can be detected (see FIG. 6).
 図5に戻って説明を続ける。横倒し決定部613は、サイズ検出部612により検出された荷物80のサイズに基づいて、荷物80を横倒しにして補助コンベア40に搬送させるか否かを判定する。ここでは、搬送中の転倒防止のために、荷卸し対象の荷物80の幅方向(X方向またはY方向)の辺に対して高さ方向(Z方向)の辺が大きい場合は、該荷物80を横倒しにして補助コンベア40に搬送させることを決定する。この例では、横倒し決定部613は、荷卸し対象の荷物80の3辺のうち、高さ方向の辺が最長辺である場合に、該荷物80を横倒し対象として決定する。 Return to Fig. 5 and continue the explanation. The sideways determination unit 613 determines whether or not to lay the luggage 80 sideways and transport it to the auxiliary conveyor 40 based on the size of the luggage 80 detected by the size detection unit 612. Here, in order to prevent the luggage from tipping over during transportation, if the side in the height direction (Z direction) is larger than the side in the width direction (X direction or Y direction) of the luggage 80 to be unloaded, the luggage 80 Is laid on its side and is conveyed to the auxiliary conveyor 40. In this example, when the side in the height direction is the longest side among the three sides of the load 80 to be unloaded, the sideways determination unit 613 determines the load 80 as the target to be laid down.
 本実施形態では、横倒し決定部613により、荷卸し対象の荷物80を横倒しにして補助コンベア40に搬送させると決定された場合、図7に示すように、ロボット制御部603(例えば制御部615でもよいし、他の機能要素であってもよい)は、保持部11により保持された荷物80を、傾斜台41の上に移動させるようにアーム12を制御する。 In the present embodiment, when the sideways determination unit 613 determines that the load 80 to be unloaded is to be laid down and conveyed to the auxiliary conveyor 40, as shown in FIG. 7, the robot control unit 603 (for example, the control unit 615 also) Alternatively, it may be another functional element) controls the arm 12 so that the luggage 80 held by the holding portion 11 is moved onto the tilt table 41.
 そして、図5に示す選択部614は、補助コンベア40の上流側に設けられた傾斜台41へ荷物を載せる際(落下させる際)の保持部11の角度の候補を示す複数の角度候補の中から、一の角度候補を選択する。より具体的には、選択部614は、複数の角度候補の中から、該角度候補が示す角度になるようにアーム12を制御する際にエラーが発生しない一の角度候補を選択する。ここでは、「エラー」には、障害物等との干渉やアーム12の関節の角度制限を受けることなどが含まれる。つまり、選択部614は、複数の角度候補の中から、干渉またはアームの関節の角度制限を回避可能な一の角度候補を選択する。本実施形態では、複数の角度候補に対しては予め優先順位が設定されており、選択部614は、優先順位が高い角度候補から順番に、エラーが発生するか否かを判断していき、エラーが発生せず、かつ、最も優先順位が高い角度候補を選択する。 Then, the selection unit 614 shown in FIG. 5 is among a plurality of angle candidates indicating the angle candidates of the holding unit 11 when loading (dropping) the load on the tilt table 41 provided on the upstream side of the auxiliary conveyor 40. Select one angle candidate from. More specifically, the selection unit 614 selects one angle candidate from a plurality of angle candidates that does not cause an error when the arm 12 is controlled so that the angle is indicated by the angle candidate. Here, the "error" includes interference with an obstacle or the like and the angle limitation of the joint of the arm 12. That is, the selection unit 614 selects one angle candidate that can avoid interference or angle limitation of the arm joint from the plurality of angle candidates. In the present embodiment, priorities are set in advance for a plurality of angle candidates, and the selection unit 614 determines whether or not an error occurs in order from the angle candidates having the highest priority. Select the angle candidate with the highest priority without causing an error.
 また、図8に示すように、本実施形態では、保持部11に保持された荷卸し対象の荷物80が有する、補助コンベア40の搬送方向において互いに対向する2つの面81、82のうち、搬送方向上流側の面81を「背面81」と称し、搬送方向下流側の面82を「前面82」と称する。そして、荷物80の背面81を補助コンベア40へ向けて倒すことを「後ろ倒し」と称し、荷物80の前面82を補助コンベア40へ向けて倒すことを「前倒し」と称する。言い換えれば、「後ろ倒し」は、補助コンベア40(搬送体)に規定される荷物80の搬送方向に対し荷物80を上流側へ倒すことであり、「前倒し」は、補助コンベア40に規定される荷物80の搬送方向に対し荷物80を下流側へ倒すことである。また、本実施形態では、傾けていない状態の保持部11の法線の角度を「0度」とし、保持部11の角度の方向として、保持部11の法線方向が傾斜台41の延在方向に近づく方向(言い換えれば、保持部11の傾きを表す直線が傾斜台41の延在方向に近づく方向)を正の方向とし、その反対の方向を負の方向とする。ここでは、傾斜台41の延在方向とは、傾斜台41の傾きを表す直線の方向であり、その直線の角度が傾斜台41の傾斜角に相当する。なお、保持部11の角度の方向の正負の決め方は任意であり、上記と反対であってもよい。 Further, as shown in FIG. 8, in the present embodiment, of the two surfaces 81 and 82 facing each other in the transport direction of the auxiliary conveyor 40, which the load 80 to be unloaded held by the holding portion 11 has, is conveyed. The surface 81 on the upstream side in the direction is referred to as "back surface 81", and the surface 82 on the downstream side in the transport direction is referred to as "front surface 82". Then, tilting the back surface 81 of the luggage 80 toward the auxiliary conveyor 40 is referred to as "backward tilting", and tilting the front surface 82 of the luggage 80 toward the auxiliary conveyor 40 is referred to as "forward tilting". In other words, "backward tilting" is to tilt the luggage 80 upstream with respect to the transport direction of the luggage 80 defined in the auxiliary conveyor 40 (conveyor body), and "forwardward" is defined in the auxiliary conveyor 40. The luggage 80 is tilted downstream with respect to the transport direction of the luggage 80. Further, in the present embodiment, the normal angle of the holding portion 11 in the non-tilted state is set to "0 degree", and the normal direction of the holding portion 11 extends as the direction of the angle of the holding portion 11 of the tilting table 41. The direction approaching the direction (in other words, the direction in which the straight line representing the inclination of the holding portion 11 approaches the extending direction of the tilt table 41) is a positive direction, and the opposite direction is a negative direction. Here, the extending direction of the tilt table 41 is the direction of a straight line representing the inclination of the tilt table 41, and the angle of the straight line corresponds to the inclination angle of the tilt table 41. The method of determining the positive or negative direction of the angle of the holding portion 11 is arbitrary, and may be the opposite of the above.
 ここで、後ろ倒しのほうが前倒しに比べて、荷物80に対する衝撃を緩和できるため、干渉またはアーム12の関節の角度制限を回避できるのであれば、後ろ倒しで荷物80を補助コンベア40に載せることが好ましい。また、後ろ倒しで荷物80を補助コンベア40に載せる場合、保持部11の法線方向が、できるだけ傾斜台41の延在方向に近くなるように保持部11を傾けることが好ましい。荷物80に対する衝撃を緩和しつつ確実に横倒しにすることができるためである。 Here, since the rearward tilting can reduce the impact on the luggage 80 as compared with the forward tilting, if interference or the angle limitation of the joint of the arm 12 can be avoided, the luggage 80 can be placed on the auxiliary conveyor 40 by the backward tilting. preferable. Further, when the luggage 80 is placed on the auxiliary conveyor 40 by tilting it backward, it is preferable to tilt the holding portion 11 so that the normal direction of the holding portion 11 is as close as possible to the extending direction of the tilting table 41. This is because the load can be reliably laid on its side while mitigating the impact on the luggage 80.
 そこで、本実施形態では、複数の角度候補のうち、補助コンベア40に規定される荷物80の搬送方向に対し荷物80を上流側へ倒して、後ろ倒しにするための角度であって、かつ、傾斜台41の傾斜角に近い角度(言い換えれば、保持部11の法線方向が傾斜台41の延在方向に近い角度)を示す角度候補ほど優先順位が高くなるように予め設定される。図9は、予め優先順位が設定された複数の角度候補の一例を示す図である。図9に示すように、後ろ倒しにするための角度であって、かつ、傾斜台41の傾斜角に近い角度を示す角度候補ほど優先順位が高いことが分かる。図9の例では、角度が大きい順に、後ろ倒しにするための角度を試していき、後ろ倒しができない場合は、角度の絶対値が大きい順に、前倒しにするための角度を試していき、前倒しができない場合は、「0度」を示す角度候補を選択する。 Therefore, in the present embodiment, among the plurality of angle candidates, the angle is such that the luggage 80 is tilted upstream with respect to the transport direction of the luggage 80 defined in the auxiliary conveyor 40 and is tilted backward. An angle candidate indicating an angle closer to the tilt angle of the tilt table 41 (in other words, an angle in which the normal direction of the holding portion 11 is closer to the extending direction of the tilt table 41) is set in advance so that the priority is higher. FIG. 9 is a diagram showing an example of a plurality of angle candidates whose priorities are set in advance. As shown in FIG. 9, it can be seen that the angle candidate for tilting backward and showing an angle closer to the tilt angle of the tilt table 41 has a higher priority. In the example of FIG. 9, the angles for moving backward are tried in descending order of the angle, and if it is not possible to move backward, the angles for moving forward are tried in descending order of the absolute value of the angle, and then moving forward. If this is not possible, select an angle candidate that indicates "0 degrees".
 なお、前倒しで荷物80を補助コンベア40に載せる場合は、保持部11の角度が、傾斜台41の斜面の法線方向に近くなるように(言い換えれば、保持部11の傾きを表す直線が傾斜台41の斜面の法線方向に近くなるように)保持部11を傾けることが好ましい。つまり、保持部11の前面82が補助コンベア40の上面(載置面)に近づくように、保持部11を傾けることが好ましい(荷物80に対する衝撃緩和のため)。図9の例では、負の値を示す角度候補(前倒しに対応する角度候補)のうち、角度の絶対値が大きい角度候補ほど優先順位が高い。具体的には、「-40度」を示す角度候補の優先順位(3番目)は、「-20度」を示す角度候補の優先順位(4番目)よりも高い。 When the luggage 80 is placed on the auxiliary conveyor 40 ahead of schedule, the angle of the holding portion 11 is set to be close to the normal direction of the slope of the tilting table 41 (in other words, the straight line representing the tilt of the holding portion 11 is inclined. It is preferable to tilt the holding portion 11 (so that it is close to the normal direction of the slope of the table 41). That is, it is preferable to tilt the holding portion 11 so that the front surface 82 of the holding portion 11 approaches the upper surface (mounting surface) of the auxiliary conveyor 40 (to mitigate the impact on the luggage 80). In the example of FIG. 9, among the angle candidates showing negative values (angle candidates corresponding to advancement), the angle candidate having a larger absolute value of the angle has a higher priority. Specifically, the priority of the angle candidate indicating "-40 degrees" (third) is higher than the priority of the angle candidate indicating "-20 degrees" (fourth).
 図5に戻って説明を続ける。制御部615は、保持部11の角度を、選択部614により選択された角度候補が示す角度に制御して、保持部11による保持を解放する制御を行う。図10(A)は、選択部614により選択された角度候補が、後ろ倒しにするための角度を示すときに、荷物80を補助コンベア40に載せて搬送する様子を示す図である。図10(B)は、選択部614により選択された角度候補が、前倒しにするための角度を示すときに、荷物80を補助コンベア40に載せて搬送する様子を示す図である。 Return to Fig. 5 and continue the explanation. The control unit 615 controls the angle of the holding unit 11 to the angle indicated by the angle candidate selected by the selection unit 614, and controls to release the holding by the holding unit 11. FIG. 10A is a diagram showing a state in which the load 80 is placed on the auxiliary conveyor 40 and conveyed when the angle candidate selected by the selection unit 614 indicates an angle for tilting backward. FIG. 10B is a diagram showing a state in which the load 80 is placed on the auxiliary conveyor 40 and conveyed when the angle candidate selected by the selection unit 614 indicates an angle for moving forward.
 この例では、制御部615は、保持部11の吸引/停止(保持/解放)の制御、保持部11の角度制御およびアーム12の制御などを行うが、制御部615が行う制御は、上記制御に限られるものではない。以上が、ロボット制御部603が有する機能である。 In this example, the control unit 615 controls suction / stop (hold / release) of the holding unit 11, angle control of the holding unit 11, control of the arm 12, and the like, but the control performed by the control unit 615 is the above control. It is not limited to. The above is the function of the robot control unit 603.
 図4に戻って説明を続ける。駆動制御部604は、補助コンベア40の駆動部、および、メインコンベア50の駆動部を制御する。駆動制御部604は、傾斜台41の延在方向と、選択部614により選択された角度候補が示す角度に制御された保持部11との角度(保持部の法線方向との角度)が閾値以上の場合は、保持部11による保持を解放する際に、一定時間にわたって補助コンベア40の駆動を停止する制御を行う。 Return to Fig. 4 and continue the explanation. The drive control unit 604 controls the drive unit of the auxiliary conveyor 40 and the drive unit of the main conveyor 50. The drive control unit 604 has a threshold value of the angle (angle with respect to the normal direction of the holding unit) between the extending direction of the tilt table 41 and the holding unit 11 controlled to the angle indicated by the angle candidate selected by the selection unit 614. In the above case, when the holding by the holding unit 11 is released, the operation of stopping the driving of the auxiliary conveyor 40 is controlled for a certain period of time.
 ここでは、傾斜台41の延在方向と、選択部614により選択された角度候補が示す角度に制御された保持部11の法線方向とのなす角度が閾値以上の場合とは、例えば荷物80を保持した保持部11の角度を、前倒しをするための角度に制御した場合などが想定される。例えば図10(B)に示す前倒しの場合、補助コンベア40の回転による摩擦力が荷物80の横倒しを阻害する方向に働くため、補助コンベア40の駆動を一定期間にわたって停止することで、荷物80をスムーズに横倒しすることができる。 Here, when the angle formed by the extending direction of the tilt table 41 and the normal direction of the holding unit 11 controlled by the angle indicated by the angle candidate selected by the selection unit 614 is equal to or greater than the threshold value, for example, the luggage 80 It is assumed that the angle of the holding portion 11 holding the above is controlled to an angle for moving forward. For example, in the case of moving forward as shown in FIG. 10B, the frictional force due to the rotation of the auxiliary conveyor 40 acts in a direction that hinders the sideways of the load 80. Therefore, the load 80 is stopped by stopping the drive of the auxiliary conveyor 40 for a certain period of time. It can be laid down smoothly.
 以上に説明した制御装置60が有する昇降制御部601、情報取得部602、ロボット制御部603、駆動制御部604の各々の機能は、図3に示すCPU101が記憶部102に格納されたプログラムを実行することにより実現される。ただし、これに限らず、例えば上述した各部の機能の一部または全部を専用のハードウェア回路(例えば半導体集積回路等)で実現することもできる。 For each function of the elevating control unit 601, the information acquisition unit 602, the robot control unit 603, and the drive control unit 604 of the control device 60 described above, the CPU 101 shown in FIG. 3 executes a program stored in the storage unit 102. It is realized by doing. However, the present invention is not limited to this, and for example, some or all of the functions of the above-mentioned parts can be realized by a dedicated hardware circuit (for example, a semiconductor integrated circuit).
 上述したように、制御装置60は、ロボット装置10の保持部11により保持された荷物80を、荷物80を搬送するための補助コンベア40の上に移動させた後に、保持部11による保持を解放して荷物80を落下させて補助コンベアへ載せる制御を行っており、「荷役装置」の一例であると考えることができる。また、これに限らず、例えば制御装置60とロボット装置10との組み合わせが「荷役装置」の一例であると考えることもできる。 As described above, the control device 60 releases the holding by the holding unit 11 after moving the luggage 80 held by the holding unit 11 of the robot device 10 onto the auxiliary conveyor 40 for transporting the luggage 80. Then, the luggage 80 is controlled to be dropped and placed on the auxiliary conveyor, which can be considered as an example of the “cargo handling device”. Further, the present invention is not limited to this, and for example, a combination of the control device 60 and the robot device 10 can be considered as an example of the “cargo handling device”.
 図11は、本実施形態の制御装置60の動作例を示すフローチャートである。図11に示すように、まず昇降制御部601は、LRF20の測定位置を荷物格納容器70の高さに合わせるように、昇降機構21を昇降させる制御を行う(ステップS1)。次に、駆動制御部604は、補助コンベア40に載せられた荷物80が搬送方向に搬送されるように、補助コンベア40の駆動部を制御する(ステップS2)。 FIG. 11 is a flowchart showing an operation example of the control device 60 of the present embodiment. As shown in FIG. 11, first, the elevating control unit 601 controls the elevating mechanism 21 to elevate and lower so as to match the measurement position of the LRF 20 with the height of the luggage containment vessel 70 (step S1). Next, the drive control unit 604 controls the drive unit of the auxiliary conveyor 40 so that the load 80 placed on the auxiliary conveyor 40 is conveyed in the transport direction (step S2).
 次に、情報取得部602は、カメラ画像を取得する(ステップS3)。次に、荷卸し対象決定部611は、ステップS3で取得されたカメラ画像から、保持可能な荷物80が存在するか否かを確認する(ステップS4)。ステップS4の結果が否定の場合(ステップS4:No)、処理は終了する。ステップS4の結果が肯定の場合(ステップS4:Yes)、荷卸し対象決定部611は、保持可能な荷物80の中から、荷卸し対象の荷物80を決定する(ステップS5)。 Next, the information acquisition unit 602 acquires a camera image (step S3). Next, the unloading target determination unit 611 confirms whether or not there is a receivable package 80 from the camera image acquired in step S3 (step S4). If the result of step S4 is negative (step S4: No), the process ends. If the result of step S4 is affirmative (step S4: Yes), the unloading target determination unit 611 determines the unloading target package 80 from the holdable packages 80 (step S5).
 次に、サイズ検出部612は、ステップS5で決定した荷卸し対象の荷物80のサイズを検出する(ステップS6)。次に、横倒し決定部613は、ステップS6で検出されたサイズに基づいて、荷物80を横倒しにして補助コンベア40に搬送させるか否かを判断する(ステップS7)。 Next, the size detection unit 612 detects the size of the package 80 to be unloaded determined in step S5 (step S6). Next, the sideways determination unit 613 determines whether or not to lay the luggage 80 sideways and transport it to the auxiliary conveyor 40 based on the size detected in step S6 (step S7).
 ステップS7の結果が否定の場合(ステップS7:No)、ロボット制御部603(例えば制御部615)は、保持部11の位置が、荷卸し対象の荷物80を保持可能な位置になるようにアーム12を制御して該荷物80を保持部11に保持させた後、その状態の保持部11の位置が、補助コンベア40の上面における上流側の領域のうち、傾斜台41が設置された領域の下流側の領域の上に位置するようにアーム12を制御する。つまり、ロボット制御部603は、荷卸し対象の荷物80を保持部11に保持させて、補助コンベア40の上に移動させる(ステップS8)。そして、ロボット制御部603(例えば制御部615)は、保持部11による保持を解放して荷物80を傾斜台41へ落下させる(ステップS9)。 When the result of step S7 is negative (step S7: No), the robot control unit 603 (for example, control unit 615) has an arm so that the position of the holding unit 11 is a position where the load 80 to be unloaded can be held. After controlling 12 to hold the luggage 80 in the holding portion 11, the position of the holding portion 11 in that state is the region on the upstream side on the upper surface of the auxiliary conveyor 40 where the tilting table 41 is installed. The arm 12 is controlled so as to be located above the downstream region. That is, the robot control unit 603 holds the load 80 to be unloaded by the holding unit 11 and moves it onto the auxiliary conveyor 40 (step S8). Then, the robot control unit 603 (for example, the control unit 615) releases the holding by the holding unit 11 and drops the luggage 80 onto the tilt table 41 (step S9).
 一方、ステップS7の結果が肯定の場合(ステップS7:Yes)、ロボット制御部603(例えば制御部615)は、保持部11の位置が、荷卸し対象の荷物80を保持可能な位置になるようにアーム12を制御して該荷物80を保持部11に保持させた後、その状態の保持部11が傾斜台41の上に位置するようにアーム12を制御する。つまり、ロボット制御部603は、荷卸し対象の荷物80を保持部11に保持させて傾斜台41の上に移動させる(ステップS10)。次に、選択部614は、複数の角度候補のうち、優先順位が最も高い角度候補を選択し(ステップS11)、その選択した角度候補が示す角度になるようにアーム12を制御する際にエラーが発生するか否かを判断する(ステップS12)。この判断はシミュレーションなどによって行われ、実際にアーム12を制御して判断するものではない。 On the other hand, when the result of step S7 is affirmative (step S7: Yes), in the robot control unit 603 (for example, control unit 615), the position of the holding unit 11 is set to a position where the load 80 to be unloaded can be held. After controlling the arm 12 to hold the load 80 on the holding portion 11, the arm 12 is controlled so that the holding portion 11 in that state is located on the tilt table 41. That is, the robot control unit 603 holds the load 80 to be unloaded by the holding unit 11 and moves it onto the tilt table 41 (step S10). Next, the selection unit 614 selects the angle candidate having the highest priority among the plurality of angle candidates (step S11), and makes an error when controlling the arm 12 so that the angle indicated by the selected angle candidate is obtained. Is determined (step S12). This determination is made by simulation or the like, and the determination is not made by actually controlling the arm 12.
 ステップS12の結果が肯定の場合(ステップS12:Yes)、選択部614は、ステップS12で判断した角度候補の次に優先順位が高い角度候補を選択し(ステップS13)、ステップS12の処理を繰り返す。ステップS12の結果が否定の場合(ステップS12:No)、選択部614はそのときの角度候補を、最終的な選択結果として制御部615へ通知し、制御部615は、保持部11の角度が、選択部614から通知された角度候補が示す角度になるようにアーム12を制御する(ステップS14)。 When the result of step S12 is affirmative (step S12: Yes), the selection unit 614 selects the angle candidate having the next highest priority after the angle candidate determined in step S12 (step S13), and repeats the process of step S12. .. When the result of step S12 is negative (step S12: No), the selection unit 614 notifies the control unit 615 of the angle candidate at that time as the final selection result, and the control unit 615 has the angle of the holding unit 11 changed. , The arm 12 is controlled so that the angle indicated by the angle candidate notified from the selection unit 614 is obtained (step S14).
 ステップS14の後、ロボット制御部603は、傾斜台41の延在方向と、ステップS14で角度制御された保持部11の法線方向とのなす角度が閾値以上であるか否かを判断する(ステップS15)。つまり、この例では、保持部11の角度が前倒しをするための角度であるか否かを判断する。この判断は、例えば制御部615が行う形態であってもよいし、ロボット制御部603の他の機能要素が行ってもよい。 After step S14, the robot control unit 603 determines whether or not the angle formed by the extending direction of the tilt table 41 and the normal direction of the holding unit 11 whose angle is controlled in step S14 is equal to or greater than the threshold value ( Step S15). That is, in this example, it is determined whether or not the angle of the holding portion 11 is an angle for moving forward. This determination may be made, for example, by the control unit 615 or by another functional element of the robot control unit 603.
 ステップS15の結果が肯定の場合(ステップS15:Yes)、ロボット制御部603は、その旨を駆動制御部604に通知し、この通知を受けた駆動制御部604は、補助コンベア40の駆動を停止する制御を行う(ステップS16)。そして、ロボット制御部603(制御部615)は、保持部11による保持を解放して、荷物80を傾斜台41へ落下させる(ステップS17)。その後、駆動制御部604は、一定時間にわたって補助コンベア40の駆動を停止した後、補助コンベア40の駆動を再開する制御を行う(ステップS18)。以降は、ステップS3以降の処理を繰り返す。 If the result of step S15 is affirmative (step S15: Yes), the robot control unit 603 notifies the drive control unit 604 to that effect, and the drive control unit 604 receiving this notification stops driving the auxiliary conveyor 40. Control is performed (step S16). Then, the robot control unit 603 (control unit 615) releases the holding by the holding unit 11 and drops the luggage 80 onto the tilt table 41 (step S17). After that, the drive control unit 604 controls to stop the drive of the auxiliary conveyor 40 for a certain period of time and then restart the drive of the auxiliary conveyor 40 (step S18). After that, the processing of step S3 and subsequent steps is repeated.
 ステップS15の結果が否定の場合(ステップS15:No)、例えば保持部11の角度が後ろ倒しにするための角度である場合、ロボット制御部603(制御部615)は、保持部11による保持を解放して、荷物80を傾斜台41へ落下させる(ステップS19)。このとき、補助コンベア40の駆動は継続している。以降は、ステップS3以降の処理を繰り返す。 When the result of step S15 is negative (step S15: No), for example, when the angle of the holding unit 11 is an angle for tilting backward, the robot control unit 603 (control unit 615) holds the robot by the holding unit 11. It is released and the luggage 80 is dropped onto the tilt table 41 (step S19). At this time, the auxiliary conveyor 40 continues to be driven. After that, the processing of step S3 and subsequent steps is repeated.
 以上に説明したように、本実施形態の制御装置60は、荷物80を横倒しにして補助コンベア40に搬送させる場合、補助コンベア40の上流側に設けられた傾斜台41へ荷物80を載せる際の保持部11の角度の候補を示す複数の角度候補の中から、一の角度候補を選択し、その選択した角度候補が示す角度になるように保持部11の角度を制御して、保持部11による保持を解放する制御を行う。より具体的には、制御装置60は、複数の角度候補の中から、該角度候補が示す角度になるようにアーム12を制御する際にエラーが発生しない一の角度候補を選択する。これにより、荷物80を適切に横倒しすることができる。 As described above, in the control device 60 of the present embodiment, when the luggage 80 is laid on its side and conveyed to the auxiliary conveyor 40, the luggage 80 is placed on the tilt table 41 provided on the upstream side of the auxiliary conveyor 40. One angle candidate is selected from a plurality of angle candidates indicating the angle candidates of the holding unit 11, and the angle of the holding unit 11 is controlled so as to be the angle indicated by the selected angle candidate. Controls to release the holding by. More specifically, the control device 60 selects one angle candidate from the plurality of angle candidates that does not cause an error when the arm 12 is controlled so as to have the angle indicated by the angle candidate. As a result, the luggage 80 can be properly laid down.
 また、上述したように、複数の角度候補に対しては予め優先順位が設定されており、制御装置60は、優先順位が高い角度候補から順番に、エラーが発生するか否かを判断していき、エラーが発生せず、かつ、最も優先順位が高い角度候補を選択する。これにより、干渉やアーム12の関節の角度制限などのエラーを回避しつつ目標に近い角度で保持部11を傾けることができる。 Further, as described above, the priority order is set in advance for the plurality of angle candidates, and the control device 60 determines whether or not an error occurs in order from the angle candidate having the highest priority. Then, select the angle candidate with the highest priority without causing an error. As a result, the holding portion 11 can be tilted at an angle close to the target while avoiding errors such as interference and angle limitation of the joint of the arm 12.
(第2の実施形態)
 次に、第2の実施形態について説明する。本実施形態では、荷物80の倒し方に対応する複数のモードごとに、複数の角度候補の優先順位が予め設定され、複数のモードのうちの何れか1つのモードに紐付けられた複数の角度候補の中から、一の角度候補を選択する点で上述の第1の実施形態と相異する。以下、具体的な内容を説明する。なお、上述の第1の実施形態と共通する部分については適宜に説明を省略する。
(Second Embodiment)
Next, the second embodiment will be described. In the present embodiment, the priority order of a plurality of angle candidates is set in advance for each of the plurality of modes corresponding to the method of tilting the luggage 80, and a plurality of angles associated with any one of the plurality of modes. It differs from the above-described first embodiment in that one angle candidate is selected from the candidates. The specific contents will be described below. The parts common to the first embodiment described above will be omitted as appropriate.
 図12は、本実施形態のロボット制御部603が有する機能の一例を示す図である。図12に示すように、ロボット制御部603は、第2選択部620をさらに有する点で上述の第1の実施形態と相異する。 FIG. 12 is a diagram showing an example of the function of the robot control unit 603 of the present embodiment. As shown in FIG. 12, the robot control unit 603 is different from the above-described first embodiment in that it further includes a second selection unit 620.
 第2選択部620は、複数のモードのうちの何れかのモードを選択する。複数のモードは、荷物80を後ろ倒しに補助コンベア40に載せる倒し方を優先する第1のモードと、荷物80を前倒しに補助コンベア40に載せる倒し方を優先する第2のモードと、を少なくとも含む。第1のモードに紐付けられた複数の角度候補は、後ろ倒しにするための角度であって、かつ、傾斜台41の傾斜角に近い角度を示す角度候補ほど前記優先順位が高い。また、第2のモードに紐付けられた複数の角度候補は、前倒しにするための角度であって、かつ、保持部11の角度が傾斜台41の斜面の法線方向に近い角度を示す角度候補ほど優先順位が高い。 The second selection unit 620 selects one of a plurality of modes. The plurality of modes include at least a first mode in which the luggage 80 is placed on the auxiliary conveyor 40 in the backward direction and a second mode in which the luggage 80 is placed in the auxiliary conveyor 40 in the forward direction is prioritized. Including. The plurality of angle candidates associated with the first mode are angles for tilting backward, and the angle candidates showing an angle closer to the tilt angle of the tilt table 41 have a higher priority. Further, the plurality of angle candidates associated with the second mode are angles for moving forward, and the angle of the holding portion 11 indicates an angle close to the normal direction of the slope of the tilt table 41. Candidates have higher priority.
 図13は、各モードに紐付けられた複数の角度候補の一例を示す図である。図13の例では、第1のモード、第2のモードに加えて、後ろ倒しか前倒しかは問わずに、絶対値の大きい角度を優先して保持部11を傾ける倒し方に対応する第3のモードが用意されている。図13の例では、第3のモードは、絶対値の大きい角度ほど優先順位が高い。この例では、荷物80に対する衝撃緩和の観点から、前倒しの角度と後ろ倒しの角度の絶対値が同じ値を示す場合は、後ろ倒しの角度を優先している。ただし、これに限らず、例えば前倒しの角度を優先することもできる。 FIG. 13 is a diagram showing an example of a plurality of angle candidates associated with each mode. In the example of FIG. 13, in addition to the first mode and the second mode, a third method corresponding to a tilting method in which the holding portion 11 is tilted with priority given to an angle having a large absolute value regardless of whether the holding portion 11 is tilted backward or forward. Modes are available. In the example of FIG. 13, in the third mode, the higher the absolute value, the higher the priority. In this example, from the viewpoint of cushioning the impact on the luggage 80, when the absolute values of the forward-forwarding angle and the backward-forwarding angle show the same value, the backward-forwarding angle is prioritized. However, the present invention is not limited to this, and for example, the forward angle can be prioritized.
 図12に示す第2選択部620は、ロボット装置10と傾斜台41との位置関係に応じて、複数のモードのうちの何れかを選択する。この例では、第2選択部620は、複数のモードのうち、保持した荷物80を傾斜台41へ載せる際(落下させる際)の保持部11の位置がロボット装置10の本体(アーム12が接続された本体)に最も近くなる倒し方に対応するモードを優先して選択する。保持部11の位置がロボット装置10に最も近くなる倒し方は、ロボット装置10と傾斜台41との位置関係に応じて変わるため、第2選択部620は、ロボット装置10および傾斜台41の設置環境に応じたモードを選択することになる。 The second selection unit 620 shown in FIG. 12 selects one of a plurality of modes according to the positional relationship between the robot device 10 and the tilt table 41. In this example, in the second selection unit 620, the position of the holding unit 11 when the held luggage 80 is placed on the tilt table 41 (when dropped) is the main body (arm 12 is connected) of the robot device 10 among the plurality of modes. Priority is given to the mode corresponding to the defeat method that is closest to the main body. Since the method of tilting the holding portion 11 closest to the robot device 10 changes according to the positional relationship between the robot device 10 and the tilting table 41, the second selection unit 620 installs the robot device 10 and the tilting table 41. The mode will be selected according to the environment.
 例えば図14に示すように、前倒しにするための角度に傾けたときの保持部11の位置よりも、後ろ倒しにするための角度に傾けたときの保持部11の位置の方がロボット装置10の本体に近くなる位置関係の場合、第2選択部620は、荷物80を後ろ倒しに補助コンベア40に載せる倒し方を優先する第1のモードを選択する。また、例えば図15に示すように、後ろ倒しにするための角度に傾けたときの保持部11の位置よりも、前倒しにするための角度に傾けたときの保持部11の位置の方がロボット装置10の本体に近くなる位置関係の場合、第2選択部620は、荷物80を前倒しに補助コンベア40に載せる倒し方を優先する第2のモードを選択する。また、例えばロボット装置10の本体に対する、前倒しにするための角度に傾けたときの保持部11の位置と、後ろ倒しにするための角度に傾けたときの保持部11の位置との差が基準値未満の場合(ほぼ差が無い場合)、第2選択部620は、絶対値の大きい角度を優先して保持部11を傾ける倒し方に対応する第3のモードを選択する。 For example, as shown in FIG. 14, the position of the holding portion 11 when tilted to the backward tilting position is higher than the position of the holding portion 11 when tilted to the forward tilting angle. In the case of the positional relationship close to the main body of the above, the second selection unit 620 selects the first mode in which the method of placing the luggage 80 backwards on the auxiliary conveyor 40 is prioritized. Further, for example, as shown in FIG. 15, the position of the holding portion 11 when tilted at an angle for tilting forward is higher than the position of the holding portion 11 when tilted at an angle for tilting backward, as shown in FIG. In the case of a positional relationship close to the main body of the device 10, the second selection unit 620 selects a second mode in which the method of placing the luggage 80 on the auxiliary conveyor 40 in advance is prioritized. Further, for example, the difference between the position of the holding portion 11 when tilted at an angle for tilting forward and the position of the holding portion 11 when tilted at an angle for tilting backward with respect to the main body of the robot device 10 is a reference. If the value is less than the value (when there is almost no difference), the second selection unit 620 selects a third mode corresponding to the tilting method of tilting the holding unit 11 with priority given to an angle having a large absolute value.
 以上の第2選択部620によるモードの選択が行われた後、図11に示す処理が開始されることになる。 After the mode is selected by the second selection unit 620, the process shown in FIG. 11 is started.
 以上に説明したように、本実施形態の制御装置60は、ロボット装置10と傾斜台41との位置関係に応じて、保持した荷物80を傾斜台41へ載せる際の保持部11の位置がロボット装置10の本体に最も近くなる倒し方に対応するモードを選択する。そして、制御装置60は、その選択したモードに紐付けられた複数の角度候補の中から、エラーが発生しない一の角度候補を選択する。ここで、本実施形態では、エラーとなる角度候補が少ないモードを事前に選択しているので、一の角度候補を短時間で選択することができる。そして、その選択した角度候補が示す角度になるよう保持部11の角度を制御して、保持部11による保持を解放する制御を行う。本実施形態によれば、ロボット装置10および傾斜台41の設置環境も反映させて、適切に荷物80を横倒しする方法を選択することができる。 As described above, in the control device 60 of the present embodiment, the position of the holding portion 11 when the held luggage 80 is placed on the tilting table 41 is the robot according to the positional relationship between the robot device 10 and the tilting table 41. Select the mode corresponding to the method of tilting that is closest to the main body of the device 10. Then, the control device 60 selects one angle candidate that does not cause an error from the plurality of angle candidates associated with the selected mode. Here, in the present embodiment, since the mode in which there are few angle candidates that cause an error is selected in advance, one angle candidate can be selected in a short time. Then, the angle of the holding unit 11 is controlled so as to be the angle indicated by the selected angle candidate, and the holding by the holding unit 11 is controlled to be released. According to the present embodiment, it is possible to appropriately select a method of laying down the luggage 80 by reflecting the installation environment of the robot device 10 and the tilting table 41.
 以上、本発明の実施形態を説明したが、上述の実施形態は例として提示したものであり、発明の範囲を限定することは意図していない。これら新規な実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら新規な実施形態やその変形は、発明の範囲や要旨に含まれるとともに、請求の範囲に記載された発明とその均等の範囲に含まれる。 Although the embodiments of the present invention have been described above, the above-described embodiments are presented as examples, and the scope of the invention is not intended to be limited. These novel embodiments can be implemented in various other embodiments, and various omissions, replacements, and changes can be made without departing from the gist of the invention. These novel embodiments and modifications thereof are included in the scope and gist of the invention, and are also included in the scope of the invention described in the claims and the equivalent scope thereof.
 以下、変形例を記載する。以下の変形例は上述の各実施形態と適宜に組み合わせることもできるし、変形例同士を適宜に組み合わせることもできる。 The following is a modified example. The following modified examples can be appropriately combined with each of the above-described embodiments, or the modified examples can be appropriately combined with each other.
(1)変形例1
 上述の横倒し決定部613は、荷卸し対象の荷物80の3辺のうち、高さ方向の辺が最長辺である場合に、該荷物80を横倒し対象として決定しているが、これに限られるものではない。例えば横倒し決定部613は、荷物80の幅方向の辺(X方向の辺またはY方向の辺)のサイズXと高さ方向の辺のサイズHとの比を示すX/Hが基準値以下の場合に、該荷物80を横倒し対象として決定することもできる。
(1) Modification 1
The above-mentioned sideways determination unit 613 determines that the luggage 80 is to be laid down when the side in the height direction is the longest side among the three sides of the luggage 80 to be unloaded, but the present invention is limited to this. It's not a thing. For example, in the sideways determination unit 613, X / H indicating the ratio of the size X of the width direction side (the side in the X direction or the side in the Y direction) of the luggage 80 to the size H of the side in the height direction is equal to or less than the reference value. In some cases, the luggage 80 can be determined to be laid down.
(2)変形例2
 上述の駆動制御部604は、傾斜台41の延在方向と、選択部614により選択された角度候補が示す角度に制御された保持部11との角度が閾値以上の場合は、保持部11による保持を解放する際に、一定時間にわたって補助コンベア40の駆動を停止する制御を行っているが、これに限られるものではない。例えば駆動制御部604は、傾斜台41の延在方向と、選択部614により選択された角度候補が示す角度に制御された保持部11との角度が閾値以上の場合は、保持部11による保持を解放する際に、一定時間にわたって荷物80の搬送方向とは逆の方向に補助コンベア40を駆動する制御を行う。この場合、駆動制御部604は、補助コンベア40に載せられた荷物80が搬送方向とは逆の方向に搬送されるよう、補助コンベア40の駆動部を制御する。これにより、補助コンベア40の回転による摩擦力が荷物80の横倒しを促進する方向に働くため、荷物80をスムーズに横倒しすることができる。
(2) Modification example 2
When the angle between the extending direction of the tilting table 41 and the holding unit 11 controlled to the angle indicated by the angle candidate selected by the selection unit 614 is equal to or greater than the threshold value, the drive control unit 604 uses the holding unit 11. When the holding is released, the operation of the auxiliary conveyor 40 is stopped for a certain period of time, but the control is not limited to this. For example, the drive control unit 604 is held by the holding unit 11 when the angle between the extending direction of the tilting table 41 and the holding unit 11 controlled to the angle indicated by the angle candidate selected by the selection unit 614 is equal to or greater than the threshold value. The auxiliary conveyor 40 is controlled to be driven in the direction opposite to the transport direction of the luggage 80 for a certain period of time. In this case, the drive control unit 604 controls the drive unit of the auxiliary conveyor 40 so that the load 80 mounted on the auxiliary conveyor 40 is conveyed in the direction opposite to the transfer direction. As a result, the frictional force due to the rotation of the auxiliary conveyor 40 acts in the direction of promoting the sideways rolling of the luggage 80, so that the luggage 80 can be smoothly turned over.
(3)変形例3
 上述の第2選択部620は、ロボット装置10と傾斜台41との位置関係に応じて、複数のモードのうちの何れかを選択しているが、これに限られるものではない。例えば第2選択部620は、ユーザから受け付けた指示に従って、複数のモードのうちの何れかを選択する形態であってもよい。
(3) Modification 3
The above-mentioned second selection unit 620 selects any one of a plurality of modes according to the positional relationship between the robot device 10 and the tilt table 41, but is not limited to this. For example, the second selection unit 620 may be in the form of selecting one of the plurality of modes according to the instruction received from the user.
 また、例えば第2選択部620は、荷卸し対象の荷物80の特徴に関する特徴情報(例えばワレモノなどの特徴を示す情報)を取得し、その取得した特徴情報に応じて、複数のモードのうちの何れかを選択する形態であってもよい。例えば第2選択部620は、荷卸し対象の荷物80の特徴情報として、ワレモノを示す特徴情報を取得した場合、荷物に対する衝撃緩和のために、後ろ倒しを優先する倒し方に対応する第1のモードを選択することができる。 Further, for example, the second selection unit 620 acquires characteristic information (information indicating characteristics such as cracks) regarding the characteristics of the package 80 to be unloaded, and among the plurality of modes according to the acquired characteristic information. It may be in the form of selecting either one. For example, when the second selection unit 620 acquires the characteristic information indicating a crack as the characteristic information of the package 80 to be unloaded, the second selection unit 620 corresponds to the first method of tilting, which gives priority to backward tilting in order to alleviate the impact on the package. You can select the mode.
 なお、特徴情報の格納先は任意であり、例えば荷物格納容器70に格納される複数の荷物80ごとに、該荷物80の特徴情報が対応付けられた対応情報を、制御装置60内の記憶部102に記憶する形態であってもよいし、外部のサーバなどの記憶装置に記憶する形態であってもよい。例えば第2選択部620は、対応情報を参照して、荷卸し対象の荷物80に対応付けられた特徴情報を取得することができる。 The storage destination of the feature information is arbitrary. For example, for each of the plurality of packages 80 stored in the baggage storage container 70, the corresponding information associated with the feature information of the baggage 80 is stored in the storage unit in the control device 60. It may be stored in 102, or may be stored in a storage device such as an external server. For example, the second selection unit 620 can acquire the feature information associated with the package 80 to be unloaded by referring to the corresponding information.
1   荷役システム
10  ロボット装置
11  保持部
12  アーム
20  LRF
21  昇降機構
30  カメラ
40  補助コンベア
41  傾斜台
50  メインコンベア
60  制御装置
70  荷物格納容器
80  荷物
101 CPU
102 記憶部
103 I/F部
601 昇降制御部
602 情報取得部
603 ロボット制御部
604 駆動制御部
611 荷卸し対象決定部
612 サイズ検出部
613 横倒し決定部
614 選択部
615 制御部
620 第2選択部
1 Cargo handling system 10 Robot device 11 Holding unit 12 Arm 20 LRF
21 Elevating mechanism 30 Camera 40 Auxiliary conveyor 41 Tilt 50 Main conveyor 60 Control device 70 Luggage containment vessel 80 Luggage 101 CPU
102 Storage unit 103 I / F unit 601 Elevation control unit 602 Information acquisition unit 603 Robot control unit 604 Drive control unit 611 Unloading target determination unit 612 Size detection unit 613 Sideways determination unit 614 Selection unit 615 Control unit 620 Second selection unit

Claims (10)

  1.  荷物を保持する保持部と、前記保持部を移動させるアームと、を備え、前記保持部により保持された荷物を、前記荷物を搬送するための搬送体の上に移動させた後に、前記保持部による保持を解放して前記荷物を前記搬送体に載せる荷役装置であって、
     前記荷物を横倒しにして前記搬送体に搬送させる場合、前記搬送体の上流側に設けられた傾斜台へ前記荷物を載せる際の前記保持部の角度の候補を示す複数の角度候補の中から、一の角度候補を選択し、
     前記保持部の角度を、選択された前記角度候補が示す角度に制御して、前記保持部による保持を解放する制御を行う制御部を備える、
     荷役装置。
    The holding portion is provided with a holding portion for holding the luggage and an arm for moving the holding portion, and after the luggage held by the holding portion is moved onto a carrier for transporting the luggage, the holding portion is provided. It is a cargo handling device that releases the holding by the carrier and puts the load on the carrier.
    When the load is laid on its side and transported to the transport body, among a plurality of angle candidates indicating the angle candidates of the holding portion when the load is placed on the tilt table provided on the upstream side of the transport body. Select one angle candidate,
    The control unit includes a control unit that controls the angle of the holding unit to an angle indicated by the selected angle candidate to release the holding by the holding unit.
    Cargo handling equipment.
  2.  前記制御部は、前記複数の角度候補の中から、該角度候補が示す角度になるように前記アームを制御する際にエラーが発生しない一の角度候補を選択する、
     請求項1に記載の荷役装置。
    The control unit selects one angle candidate from the plurality of angle candidates that does not cause an error when controlling the arm so that the angle is indicated by the angle candidate.
    The cargo handling device according to claim 1.
  3.  前記複数の角度候補に対しては予め優先順位が設定されており、
     前記選択部は、前記優先順位が高い角度候補から順番に、前記エラーが発生するか否かを判断していき、前記エラーが発生せず、かつ、最も前記優先順位が高い角度候補を選択する、
     請求項2に記載の荷役装置。
    Priorities are set in advance for the plurality of angle candidates.
    The selection unit determines whether or not the error occurs in order from the angle candidate having the highest priority, and selects the angle candidate having the highest priority without causing the error. ,
    The cargo handling device according to claim 2.
  4.  前記複数の角度候補のうち、前記搬送体に規定される前記荷物の搬送方向に対し前記荷物を上流側に倒して、後ろ倒しに前記搬送体に載せるための角度であって、かつ、前記傾斜台の傾斜角に近い角度を示す角度候補ほど前記優先順位が高い、
     請求項3に記載の荷役装置。
    Among the plurality of angle candidates, the angle at which the load is tilted upstream with respect to the transport direction of the load defined by the transport body and placed on the transport body backward and tilted. An angle candidate showing an angle closer to the tilt angle of the table has a higher priority.
    The cargo handling device according to claim 3.
  5.  前記荷物の倒し方に対応する複数のモードごとに、前記複数の角度候補の前記優先順位が予め設定され、
     前記制御部は、前記複数のモードのうちの何れかのモードを選択し、
     前記モードに紐付けられた複数の角度候補の中から、一の角度候補を選択する、
     請求項3に記載の荷役装置。
    The priority of the plurality of angle candidates is preset for each of the plurality of modes corresponding to the method of tilting the luggage.
    The control unit selects one of the plurality of modes, and the control unit selects one of the plurality of modes.
    Select one angle candidate from a plurality of angle candidates associated with the mode.
    The cargo handling device according to claim 3.
  6.  前記複数のモードは、前記荷物を前記後ろ倒しに前記搬送体に載せる倒し方を優先する第1のモードと、前記搬送体に規定される前記荷物の搬送方向に対し前記荷物を下流側へ倒して、前倒しに前記荷物を前記搬送体に載せる倒し方を優先する第2のモードと、を含み、
     前記第1のモードに紐付けられた複数の角度候補は、前記後ろ倒しにするための角度であって、かつ、前記傾斜台の傾斜角に近い角度を示す角度候補ほど前記優先順位が高く、
     前記第2のモードに紐付けられた複数の角度候補は、前記前倒しにするための角度であって、かつ、前記保持部の角度が前記傾斜台の斜面の法線方向に近い角度を示す角度候補ほど前記優先順位が高い、
     請求項5に記載の荷役装置。
    The plurality of modes include a first mode in which the method of placing the load on the carrier in the backward direction is prioritized, and the first mode in which the load is tilted downstream with respect to the transport direction of the load specified in the carrier. Including a second mode in which the method of placing the load on the carrier in advance is prioritized.
    The plurality of angle candidates associated with the first mode are angles for tilting backward, and an angle candidate showing an angle closer to the tilt angle of the tilt table has a higher priority.
    The plurality of angle candidates associated with the second mode are angles for moving forward, and the angle of the holding portion indicates an angle close to the normal direction of the slope of the tilt table. Candidates have higher priority,
    The cargo handling device according to claim 5.
  7.  前記制御部は、前記ロボット装置と前記傾斜台との位置関係に応じて、前記複数のモードのうちの何れかを選択する、
     請求項5または6に記載の荷役装置。
    The control unit selects one of the plurality of modes according to the positional relationship between the robot device and the tilt table.
    The cargo handling device according to claim 5 or 6.
  8.  前記搬送体はコンベアであり、
     前記コンベアの駆動を制御する駆動制御部をさらに備え、
     前記駆動制御部は、
     前記傾斜台の延在方向と、前記選択部により選択された角度候補が示す角度に制御された前記保持部との角度が閾値以上の場合は、前記保持部による保持を解放する際に、一定時間にわたって前記コンベアの駆動を停止する制御を行う、
     請求項1乃至7のうちの何れか1項に記載の荷役装置。
    The carrier is a conveyor
    A drive control unit that controls the drive of the conveyor is further provided.
    The drive control unit
    When the angle between the extending direction of the tilting table and the holding portion controlled by the angle indicated by the angle candidate selected by the selecting portion is equal to or greater than the threshold value, it is constant when the holding by the holding portion is released. Control to stop driving the conveyor over time.
    The cargo handling device according to any one of claims 1 to 7.
  9.  前記搬送体はコンベアであり、
     前記コンベアの駆動を制御する駆動制御部をさらに備え、
     前記駆動制御部は、
     前記傾斜台の延在方向と、前記選択部により選択された角度候補が示す角度に制御された前記保持部との角度が閾値以上の場合は、前記保持部による保持を解放する際に、一定時間にわたって前記荷物の搬送方向とは逆の方向に前記コンベアを駆動する制御を行う、
     請求項1乃至7のうちの何れか1項に記載の荷役装置。
    The carrier is a conveyor
    A drive control unit that controls the drive of the conveyor is further provided.
    The drive control unit
    When the angle between the extending direction of the tilt table and the holding portion controlled to the angle indicated by the angle candidate selected by the selecting portion is equal to or greater than the threshold value, it is constant when the holding by the holding portion is released. Control is performed to drive the conveyor in a direction opposite to the transport direction of the load over time.
    The cargo handling device according to any one of claims 1 to 7.
  10.  前記制御部は、荷物のサイズに基づいて、前記荷物を横倒しにして前記搬送体に搬送させるか否かを判定する、
     請求項1乃至9のうちの何れか1項に記載の荷役装置。
    Based on the size of the load, the control unit determines whether or not to lay the load on its side and transport it to the carrier.
    The cargo handling device according to any one of claims 1 to 9.
PCT/JP2020/005773 2019-03-15 2020-02-14 Cargo handling apparatus WO2020189118A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019048418A JP7249826B2 (en) 2019-03-15 2019-03-15 cargo handling equipment
JP2019-048418 2019-03-15

Publications (1)

Publication Number Publication Date
WO2020189118A1 true WO2020189118A1 (en) 2020-09-24

Family

ID=72431650

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/005773 WO2020189118A1 (en) 2019-03-15 2020-02-14 Cargo handling apparatus

Country Status (2)

Country Link
JP (1) JP7249826B2 (en)
WO (1) WO2020189118A1 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000006064A (en) * 1998-06-18 2000-01-11 Mecs Corp Substrate carrier robot
JP4121257B2 (en) * 2001-07-11 2008-07-23 富士フイルム株式会社 Sheet body handling device
WO2018173441A1 (en) * 2017-03-23 2018-09-27 株式会社 東芝 Conveyance system

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000006064A (en) * 1998-06-18 2000-01-11 Mecs Corp Substrate carrier robot
JP4121257B2 (en) * 2001-07-11 2008-07-23 富士フイルム株式会社 Sheet body handling device
WO2018173441A1 (en) * 2017-03-23 2018-09-27 株式会社 東芝 Conveyance system

Also Published As

Publication number Publication date
JP7249826B2 (en) 2023-03-31
JP2020147427A (en) 2020-09-17

Similar Documents

Publication Publication Date Title
US10947057B2 (en) Article loading facility
EP3453656B1 (en) Unloading apparatus and unloading method
JP6833580B2 (en) Transport system
TWI803624B (en) Picking facility
US10106340B2 (en) Article loading facility
JP2019151421A (en) Article transfer device and loading position detection device
JP2018203527A (en) Cargo handling device, and operation method of cargo handling device
JP6804900B2 (en) Transport equipment, transport method, and program
JP7059115B2 (en) Unloading system, unloading control device, unloading system control method and unloading control program
WO2020189118A1 (en) Cargo handling apparatus
WO2020100908A1 (en) Article loading facility
JP2021127252A (en) Extracting device and method
JP6963753B2 (en) Transfer device
JP7247400B2 (en) Unloading control device, unloading control method and unloading control program
JP6229600B2 (en) Existence determination device
JP7400469B2 (en) Conveyance device and method of controlling the conveyance device
JP6743601B2 (en) Transfer system
US20210395025A1 (en) Article Transport Facility
JP2015203596A (en) position determination device
JP2022009289A (en) Unloading device and detecting method of cargo

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20774279

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20774279

Country of ref document: EP

Kind code of ref document: A1