WO2024190300A1 - Workpiece attachment/detachment system - Google Patents
Workpiece attachment/detachment system Download PDFInfo
- Publication number
- WO2024190300A1 WO2024190300A1 PCT/JP2024/005778 JP2024005778W WO2024190300A1 WO 2024190300 A1 WO2024190300 A1 WO 2024190300A1 JP 2024005778 W JP2024005778 W JP 2024005778W WO 2024190300 A1 WO2024190300 A1 WO 2024190300A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- workpiece
- robot
- clamper
- camera
- control device
- Prior art date
Links
- 238000003384 imaging method Methods 0.000 claims abstract 3
- 238000003754 machining Methods 0.000 claims description 9
- 238000004140 cleaning Methods 0.000 claims description 4
- 238000012545 processing Methods 0.000 abstract description 11
- 238000000034 method Methods 0.000 description 44
- 239000000463 material Substances 0.000 description 27
- 210000000078 claw Anatomy 0.000 description 23
- 238000004519 manufacturing process Methods 0.000 description 11
- 230000007257 malfunction Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000003860 storage Methods 0.000 description 2
- 230000003213 activating effect Effects 0.000 description 1
- WYTGDNHDOZPMIW-RCBQFDQVSA-N alstonine Natural products C1=CC2=C3C=CC=CC3=NC2=C2N1C[C@H]1[C@H](C)OC=C(C(=O)OC)[C@H]1C2 WYTGDNHDOZPMIW-RCBQFDQVSA-N 0.000 description 1
- 238000007664 blowing Methods 0.000 description 1
- 239000013256 coordination polymer Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q17/00—Arrangements for observing, indicating or measuring on machine tools
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q3/00—Devices holding, supporting, or positioning work or tools, of a kind normally removable from the machine
- B23Q3/02—Devices holding, supporting, or positioning work or tools, of a kind normally removable from the machine for mounting on a work-table, tool-slide, or analogous part
- B23Q3/06—Work-clamping means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
Definitions
- the present invention relates to a workpiece attachment/detachment system.
- Patent Document 1 discloses a processing system that uses a robot to attach and detach a workpiece to and from a machine tool. This allows the workpiece to be attached and detached in a short time.
- This processing system is configured to detect the position of the workpiece from the rotation angle of the drive motor of the holding member and the robot arm, and to correct any misalignment. For this reason, in order to control the position of the workpiece, it is necessary to position the robot in a fixed position.
- the present invention aims to provide a workpiece attachment/detachment system that can efficiently attach and detach workpieces using a robot.
- a workpiece mounting/removal system for mounting/removing a workpiece for machining includes a workpiece mounting table for mounting the workpiece, a workpiece mounting device having a clamper for mounting or removing the workpiece from the workpiece mounting table by operating a movable member and a fixed member fixed near the clamper, a robot having a hand configured to grasp the workpiece and a camera configured to photograph the movable member and the fixed member at a photographing position, a moving body on which the robot is placed and which can move in any direction to move the robot to the photographing position, and a control device for operating the clamper, robot, and camera, which determines the mounting/removal state of the workpiece on the workpiece mounting table based on an image captured by the camera, and the camera is characterized in that it photographs the movable member and the fixed member simultaneously.
- a first image capturing unit may be formed on a movable member and the orientation of which changes when the movable member is actuated
- a second image capturing unit may be formed on a fixed member, and the first image capturing unit and the second image capturing unit may face the camera in the same direction, and the camera may capture images of the first image capturing unit and the second image capturing unit simultaneously.
- control device may be configured to determine whether the clamper is in a clamped state in which the workpiece is attached to the workpiece mounting table, or in an unclamped state in which the workpiece is removed from the workpiece mounting table, based on the relative positions of the first and second photographing units in an image captured by the camera, and to operate a cleaning means to clean the area around the clamper and the workpiece if it determines that the movable member has deviated from the reference position in the clamped or unclamped state by more than a threshold value.
- the work mounting table may be equipped with a pressure gauge for displaying the pressure supplied to the clamper using the hydraulic/pneumatic pressure supply device, and the control device may be configured to detect the pressure value of the clamper from an image of the pressure gauge captured by the camera, and remove the work from the work mounting table if the pressure value is below a threshold value.
- the robot has a hand configured to be able to grasp the workpiece, and can be moved by a moving body that can move in any direction. Therefore, the control device can move the robot to the workpiece mounting device by operating the moving body on which the robot is placed, and can place the workpiece on the workpiece mounting table by operating the hand of the robot. This allows the robot to be moved appropriately to the workpiece mounting device that requires the workpiece to be mounted/removed, rather than disposing the robot for each workpiece mounting device, and can efficiently mount and remove the workpiece using the robot.
- the robot has a camera configured to be able to photograph the movable member and the fixed member at the shooting position, and can be moved to the shooting position by the moving body. Therefore, the control device can move the robot to the shooting position by operating the moving body on which the robot is placed, and can simultaneously photograph the movable member and the fixed member by operating the camera.
- the control device can determine the mounting/removal state of the workpiece on the workpiece mounting table based on the image taken by the camera. Therefore, for example, when it is determined that the workpiece is properly mounted on the workpiece mounting table, processing can be continued.
- control device can include, for example, a process of operating the clamper and robot to remove the workpiece and then reattach it, or a process of interrupting processing to improve the attachment. This allows the process of checking for and resolving any malfunctions in the workpiece mounting device to be included, allowing the robot to efficiently mount and remove the workpiece.
- FIG. 2 is a perspective view of an example of a workpiece mounting table according to the present embodiment, illustrating a state in which a workpiece is clamped.
- FIG. 2 is a perspective view of an example of a workpiece mounting table according to the present embodiment, illustrating an unclamped state of a workpiece.
- 10 is an enlarged view of an example of a first photographing portion and a second photographing portion formed on the movable member and the fixed member according to the embodiment, showing a clamped state of a workpiece.
- FIG. 11 is an enlarged view of an example of a first photographing portion and a second photographing portion formed on the movable member and the fixed member according to the present embodiment, showing a state in which the workpiece is unclamped.
- FIG. 8 shows an example of a circuit diagram of the workpiece mounting device according to this embodiment.
- FIG. 2 is a perspective view of the pressure gauge according to the embodiment, showing a case where the pressure is equal to or greater than a threshold value.
- FIG. 2 is a perspective view of the pressure gauge according to the embodiment, showing a case where the pressure is equal to or lower than a threshold value.
- FIG. 10 shows a flowchart of the workpiece mounting and unmounting process by the workpiece mounting and unmounting system according to this embodiment.
- FIG. 11 is a perspective view of a workpiece mounting table according to a modified example.
- FIG. 1 shows a perspective view of a workpiece mounting/removal system 10 arranged in a manufacturing area MA (see FIG. 3) of a factory or the like.
- FIG. 2 shows a plan view of the workpiece mounting/removal system 10.
- the workpiece mounting/removal system 10 includes workpiece setting stations 14, 15 (hereinafter referred to as station 14) as workpiece mounting devices that mount a workpiece W and supply it to machine tools 12, 13.
- Stations 14, 15 may be configured independently and connected to machine tools 12, 13 such as machining centers, or may be configured integrally with machine tools 12, 13.
- a workpiece mounting table 16 (see FIG. 6a) is arranged for mounting a workpiece W to be machined by machine tools 12, 13.
- the station 14 has an entrance 18 for moving the workpiece W into the station 14, i.e., for bringing it in and out of the station 14, and a door 20 formed to be slidable for opening and closing the entrance 18.
- the door 20 is fitted with a door handle 20a for gripping when opening and closing.
- a material placement table 22 for loading the unprocessed workpiece W and a work placement table 24 for loading the processed workpiece W are arranged.
- the material placement table 22 is formed with a temporary placement table 23 for temporarily placing the workpiece W.
- the material placement table 22 and the work placement table 24 each have four legs 22a, 24a, and are configured so that the height position of the workpiece W placed on the material placement table 22 and the work placement table 24 is approximately the same as the height position of the robot hand 42 as a hand described later. This prevents the movement distance of the robot hand 42 from increasing, allowing it to operate efficiently.
- an oil and air pressure supply device 26 is located adjacent to the outside of the station 14 to supply oil and air pressure to the work mounting table 16.
- the workpiece attachment/detachment system 10 also includes a robot 30 for loading and unloading the workpiece W.
- the robot 30 loads the unprocessed workpiece W on the material placement table 22 onto the workpiece mounting table 16 in the station 14, and loads the processed workpiece W from the workpiece mounting table 16 onto the workpiece placement table 24.
- the robot 30 is attached to a base 34 on the upper surface of an automated guided vehicle 32 as a moving body, and is configured to be movable within the manufacturing area MA.
- the robot 30 further includes a cylindrical support 36 configured to be rotatable around an axis perpendicular to the base 34, here an axis along the vertical direction, and an arm unit 40, one end of which is rotatably attached to the support 36, and multiple arms 40a connected via multiple joints 38 are configured to be rotatable around the joints 38.
- a robot hand 42 is detachably connected to the other end of the arm 40 of the robot 30 as a hand for gripping the workpiece W.
- the robot hand 42 is configured to be rotatable around the axis of the arm 40a so that the orientation can be adjusted when gripping the workpiece W.
- a robot hand holder 44 is attached to the base 34, and the robot hand 42 is stored in this robot hand holder 44 when not in use.
- the workpiece attachment/detachment system 10 also includes a camera 46 arranged on the other end of the arm section 40, i.e., on the side of the robot hand 42.
- the camera 46 is arranged so as to capture an image of the side of the robot hand 42 gripping the workpiece W, and is configured to be rotatable around the axis of the arm 40a together with the robot hand 42.
- the camera 46 may be of any type, such as a stereo camera or a three-dimensional camera, as long as it can provide a predetermined resolution.
- a robot control device 31 is provided inside the base section 34 as a control device for controlling the behavior of the robot 30 and the camera 46.
- the workpiece attachment/detachment system 10 includes a host control system 48 as a control device for controlling the stations 14, 15, the robot 30, and the automated guided vehicle 32 in the manufacturing area MA.
- the host control system 48 is connected to the stations 14, 15, the robot 30, and the automated guided vehicle 32 wirelessly and/or by wire for communication.
- the automated guided vehicle 32 is operated by the host control system 48 and is configured to automatically travel to a specified destination on the floor surface FS of the manufacturing area MA without a human driver.
- a Mecanum wheel (not shown) is rotatably attached to the lower side of the automated guided vehicle 32.
- the wheel can be formed by a combination of a normal tire and a wheel, but is preferably formed by a Mecanum wheel.
- the Mecanum wheel can turn using the rotation difference of the wheels.
- the upper control system 48 is also electrically connected to the machine tools 12, 13 and stations 14, 15, and can detect whether a workpiece W is attached in station 14 and whether the machine tool 12 for machining the workpiece W is operating. For this reason, the upper control system 48 operates the robot 30 to carry an unmachined workpiece W into station 14 on one of the machine tools 12, and then operates the automated guided vehicle 32 to move the workpiece W to the other machine tool 13 side where machining is not being performed while the machine tool 12 is machining the workpiece W (T1 in FIG. 2). The upper control system 48 moves the robot 30 and the automated guided vehicle 32 to the other machine tool 13 side, and then operates the robot 30 to carry the unmachined workpiece W into the other station 15.
- the host control system 48 detects that one of the machine tools 12 has completed machining the workpiece W, it moves the robot 30 and the automated guided vehicle 32 to the side of the one of the machine tools 12 (T2 in FIG. 2), or when the one of the machine tools 12 has not completed machining the workpiece W, it moves the robot 30 and the automated guided vehicle 32 to the side of another machine tool (see FIG. 3) to which the workpiece W is not attached (T3 in FIG. 2). In this way, the host control system 48 appropriately moves the automated guided vehicle 32 to the machine tools 12, 13 that require work by the robot 30.
- FIG. 3 shows an example of the floor layout of a manufacturing area having a workpiece attachment/detachment system 10.
- the upper control system 48 operates the automated guided vehicle 32 and the robot 30 in the manufacturing area MA. For this reason, the upper control system 48 operates the automated guided vehicle 32 to move it to the material stocker 54 in the manufacturing area MA, and operates the robot 30 to take out unprocessed workpieces W from the material stocker 54 and place them on the upper surface of the automated guided vehicle 32 as many as required. Furthermore, when the required number of workpieces W are placed on the automated guided vehicle 32, the upper control system 48 moves the automated guided vehicle 32 to the side of the station 14 and the material placement table 22, and operates the robot 30 to place the carried workpieces W on the material placement table 22. This allows new workpieces W to be automatically supplied to the material placement table 22 where the unprocessed workpieces W had disappeared.
- the host control system 48 can also operate the robot 30 to place the machined workpiece W on the workpiece placement table 24 on the upper surface of the automated guided vehicle 32. After the workpiece W is placed on the host control system 48, it can operate the automated guided vehicle 32 to move it to a workpiece stocker 56 in the manufacturing area MA, and operate the robot 30 to store the machined workpiece W that it has brought in the workpiece stocker 56. This allows the machined workpiece W that is loaded on the workpiece placement table 24 to be automatically stored in the workpiece stocker 56.
- the upper control system 48 determines, for example, that the robot hand 42 attached to the robot 30 is not suitable for the size of the workpiece W, or that a different tool should be attached instead of the robot hand 42 based on the shape of the workpiece W, it can operate the automated guided vehicle 32 to move it to a hand locker 58 or tool locker 60 in the manufacturing area MA. Once the robot 30 has moved to the hand locker 58 or tool locker 60, it can attach a different robot hand 42 or tool in place of the attached robot hand 42. This makes it possible to automatically attach a robot hand 42 or tool to the robot 30 according to the size and shape of the workpiece W.
- the material placement table 22 has a temporary placement table 23 on which the work W is temporarily placed.
- a placement table position mark 50 and a placement table information mark 52 are formed on the material placement table 22 and the work placement table 24 to serve as a reference when aligning using an image captured by the camera 46 of the robot 30.
- the placement table position mark 50 is a plate colored in a different color from the material placement table 22 and the work placement table 24, or a bolt of a different color screwed into them.
- the placement table position mark 50 and the placement table information mark 52 may be a sticker, tape, or the like that can be attached.
- the placement table position mark 50 displays a letter, symbol, or mark (the letter "M” in FIG. 4) that can confirm the orientation.
- a QR code registered trademark
- a QR code registered trademark
- the placement table information mark 52 is used for the placement table information mark 52, and the corresponding part number, the state of the workpiece W to be loaded, and the workpiece vacancy number indicating the vacant space for the workpiece W are recorded. This allows the robot 30 and the automated guided vehicle 32 to photograph the material placement table 22 and the workpiece placement table 24 with the camera 46, align them relative to each other, and confirm the corresponding part number of the workpiece W.
- FIGS. 5a and 5b show perspective views of the door 20 of the station 14 in the closed and open states, respectively.
- the automated guided vehicle 32 moves to a position facing the door 20 of the station 14, i.e., in front of the door 20, it photographs the station 14 with the camera 46 of the robot 30.
- the robot control device 31 is configured to determine whether the robot 30 attached to the automated guided vehicle 32 is positioned in an appropriate position from the photographed image of the station 14.
- the robot control device 31 is also configured to determine whether the door 20 is in an open or closed state from the photographed image of the station 14.
- buttons are arranged along the vertical direction of the station 14 beside the door 20.
- a lock operation button 66a for locking or unlocking the door 20
- a work clamp button 66b for clamping or unclamping the work W placed on the work mounting table 16 are arranged.
- a work set completion button 66c for transmitting to the machine tool 12 (see FIG. 3) that the work W has been attached to the work mounting table 16 and clamped
- a supply device button 66d for connecting or disconnecting the hydraulic and pneumatic supply device 26 for supplying hydraulic and pneumatic pressure to the work mounting table 16 are arranged.
- an air nozzle 68 as a cleaning means is arranged below the four operation buttons 66a, 66b, 66c, and 66d beside the door 20.
- the air nozzle 68 can blow away and suck up dirt and dust around the machine by air blowing and vacuuming. It has a retractable hose (not shown) that can be pulled out by the robot hand 42 or a person. Therefore, by operating the robot hand 42 to clamp the air nozzle 68 and pull it out to the inside of the station 14, and spraying air, it is possible to clean the inside of the station 14 and the area around the workpiece W clamped to the workpiece mounting table 16.
- the robot control device 31 can operate the robot hand 42 to slide open the door 20, and then use the robot hand 42 to grasp the unmachined workpiece W loaded on the material placement table 22 and move, i.e., carry, it to the workpiece mounting table 16 inside the station 14. In addition, when the moved workpiece W is attached to the workpiece mounting table 16, the robot control device 31 can operate the robot hand 42 to clamp the door handle 20a and slide the door 20 to close it.
- the robot control device 31 can operate the robot hand 42 to press the lock operation button 66a to lock the door 20, and can also operate the robot hand 42 to press the work set completion button 66c, thereby communicating to the machine tool 12 that the setting of the workpiece W has been completed.
- FIGS 6a and 6b show perspective views of the workpiece mounting table 16 in a state where the workpiece W is clamped by the clamper 74 (hereafter referred to as the clamped state) and in an unclamped state (hereafter referred to as the unclamped state), respectively.
- the workpiece mounting table 16 is composed of a plate base 70 and an angle plate 72 that is placed on the plate base 70 and extends perpendicular to the plate base 70, in this case in the vertical direction.
- multiple clampers 74 here four, are arranged for clamping the four corners of the workpiece W to fix it in place.
- the angle plate 72 also has a workpiece mounting portion 76 for stably mounting the workpiece W before clamping.
- the clamper 74 has a movable member 78 that is operable by hydraulic pressure or air pressure supplied from the hydraulic/pneumatic supply device 26.
- the movable member 78 has a cylindrical shaft member 80 that extends in a direction perpendicular to the angle plate 72, in this case, horizontally, and a rectangular claw member 82 that is connected to the end of the shaft member 80.
- the shaft member 80 is configured to be slidable along its axial direction. Therefore, it can be pulled out to the outside of the angle plate 72 or pulled back to the inside depending on the thickness of the workpiece W.
- the shaft member 80 is also configured to be rotatable around an axis along its axial direction.
- the angle plate 72 also has a fixed member 84 that is fixed near the clamper 74 to check the relative positional relationship with the movable member 78.
- the angle plate 72 also has a nozzle connection part 90 on its side for connecting the hydraulic and pneumatic pressure supply device 26 for supplying hydraulic and pneumatic pressure to the clamper 74.
- the robot control device 31 is configured to operate the robot hand 42 and press the supply device button 66d to connect or disconnect the nozzle connection part 90 and the hydraulic and pneumatic pressure supply device 26.
- FIG. 7a and 7b show enlarged views of a position mark 86 as a first photographing portion formed on the claw member 82 of the movable member 78 and an information mark 88 as a second photographing portion formed on the fixed member 84.
- a circular position mark 86 is formed on the claw member 82 to serve as a reference position when checking the clamped state (FIG. 7a) and unclamped state (FIG. 7b) of the clamper 74 using images captured by the camera 46 of the robot 30.
- a rectangular information mark 88 is also formed on the fixed member 84 to serve as a reference position when checking the unclamped state and clamped state of the clamper 74.
- the display surfaces of the position mark 86 and the information mark 88 are displayed facing the same direction, here from the angle plate 72 toward the door 20, so that they can be photographed simultaneously by the camera 46 of the robot 30.
- the position mark 86 is a plate colored a different color from the claw member 82 and the fixed member 84, or a bolt of a different color screwed into them.
- the position mark 86 and the information mark 88 may be stickers, tapes, etc. that can be attached.
- the position mark 86 displays a letter, symbol, or mark (the letter "M" in Figs. 7a and 7b) that allows the orientation of the rotatably configured claw member 82 to be confirmed.
- a QR code registered trademark
- the information mark 88 uses a QR code (registered trademark) and records a corresponding part number. This allows the robot 30 to photograph the movable member 78 and the fixed member 84 with the camera 46, confirm the unclamped and clamped states of the clamper 74, and confirm the corresponding part number of the work mounting table 16.
- the position mark 86 is formed in a circular shape when viewed from the front
- the information mark 88 is formed in a rectangular shape when viewed from the front, but this is not limited to the above, and the position mark and the information mark may be formed in other shapes such as a polygonal shape other than a circle or a rectangle.
- the robot 30 is configured to check the unclamped and clamped states of the clamper 74, i.e., to judge the state, by comparing a reference image previously recorded in the robot control device 31 with an image captured by the camera 46. Specifically, the relative positional relationship between the position mark 86 and the information mark 88 in the captured image is compared with the relative positional relationship in the reference image. The comparison with the reference image is also performed based on the images of the movable member 78 and the fixed member 84. The first center point 86b of the position mark 86 and each side of the information mark 88 are used as the reference positions, i.e., the reference points, for comparison. If the position mark is not circular, another reference point may be provided in place of the first center point 86b.
- a point identified by another logic such as the topmost or bottommost vertex of the information mark.
- the horizontal lateral distance XC and the vertical distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image, and the horizontal front-back distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 are used.
- the unclamped state as shown in FIG.
- FIG. 8 shows a circuit diagram of the oil/air pressure supply device 26.
- the oil/air pressure supply device 26 is equipped with an oil/air pressure unit HP for setting the oil/air pressure, and a pressure switch PS configured to switch between open and closed when the oil/air pressure reaches a set pressure.
- a solenoid valve SN and a pressure reducing valve RV are attached between the oil/air pressure unit HP and the oil/air pressure supply device 26, and are configured to open and close according to the oil/air pressure inside the oil/air pressure supply device 26.
- a pressure gauge 92 for monitoring the pressure of the clamper 74 is disposed on the upper surface side of the angle plate 72.
- an analog pressure gauge 92 having a guide needle 94 is used here.
- the guide needle 94 points to the right of the reference scale SS when viewed from the front, at about 12 o'clock in the figure.
- the guide needle 94 points to the left of the reference scale SS when viewed from the front, at about 8 o'clock in the figure.
- the robot control device 31 is configured to operate the camera 46 to photograph the pressure gauge 92 and determine whether a predetermined pressure is being supplied to the clamper 74 from the positional relationship between the guide needle 94 and the reference scale SS.
- the pressure gauge 92 has been described here as being analog, this is not limiting, and the pressure gauge may be digital, for example, and may be configured to determine whether a predetermined pressure is being supplied from an image of the digitally displayed pressure value captured by a camera.
- step S001 the upper control system 48 moves the automatic guided vehicle 32 to a reference position in front of the station 14.
- step S002 the camera 46 photographs the station 14, and compares it with reference image data when the automatic guided vehicle 32 stops at the reference position, which is stored in advance in the robot control device 31, and if there is a deviation from the reference position, the distance of the deviation is confirmed (A in Fig. 10).
- a threshold A1 in Fig.
- step S003 the automatic guided vehicle 32 is moved so as to reduce the distance of the deviation, the camera 46 photographs the station 14, and the image is compared with the reference image data.
- step S004 the position of the robot hand 42 is corrected so as to further reduce the deviation, and then the process proceeds to step S005.
- step S005 the camera 46 photographs the workpiece placement stage 24's placement stage position mark 50 and placement stage information mark 52, and compares this with reference image data stored in advance in the robot control device 31 when the automated guided vehicle 32 is in a reference position relative to the workpiece placement stage 24, and if there is any deviation from the reference position, the distance of deviation is confirmed (B in Figure 10). Also, the robot control device 31 records the part number to be loaded on the workpiece placement stage 24. Furthermore, the robot control device 31 confirms whether or not a workpiece W is loaded on the workpiece placement stage 24 based on the image of the workpiece placement stage 24 photographed by the camera 46.
- step S006 If a workpiece W is loaded on the workpiece placement stage 24 of the workpiece W, the vacant workpiece number of the part to be loaded is recorded in the robot control device 31. If the deviation from the workpiece placement table 24 is equal to or greater than the threshold value, or if the comparison is not possible because the workpiece placement table 24 is not installed (B1 in FIG. 10), the process proceeds to step S006, and the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has output the alarm moves the automated guided vehicle 32 to another station 15. If the deviation from the workpiece placement table 24 is less than the threshold value (B2 in FIG. 10), in step S007, the robot control device 31 corrects the position of the robot hand 42 to further reduce the deviation, completes positioning, and proceeds to step S008.
- step S008 the door 20 of the station 14 is photographed by the camera 46, and compared with the reference image data of the door 20 when it is open and when it is closed, which are stored in advance in the robot control device 31, to confirm the state of the door 20 (C in FIG. 10). If there is a deviation between the reference image of the door 20 when it is closed and the deviation distance is less than a threshold, it is determined that the door 20 is closed, and the process proceeds to step S009 (C1 in FIG. 10). In step S009, the robot control device 31 operates the robot hand 42 to press the lock operation button 66a. This releases the door lock, and the process proceeds to step S010.
- step S008 if the deviation distance from the reference image of the door 20 when it is open and when it is closed is equal to or greater than a threshold, that is, if it is in an intermediate position between the open state and the closed state (C2 in FIG. 10), the process also proceeds to step S010.
- step S010 the robot control device 31 operates the robot hand 42 to open the door 20. Specifically, the robot hand 42 moves from a position slightly to the left of the door handle 20a attached to the door 20 (the side that closes the door 20) to the right (the side that opens the door 20) while contacting the door handle 20a, and opens the door 20 by sliding it.
- the process proceeds to step S011, where the camera 46 takes an image of the door 20 and compares it with the reference image data when the door 20 is open to confirm whether the door 20 is open or not (D in FIG. 10).
- step S012 if the distance by which the door 20 has shifted from the reference position when the door 20 is open is equal to or greater than the threshold value, the process proceeds to step S012, where the robot control device 31 outputs an alarm to the upper control system 48.
- the upper control system 48 that has output the alarm moves the automatic guided vehicle 32 to another station 15 (D1 in FIG. 10).
- step S008 the distance by which the door 20 has shifted from the reference position when the door 20 is open is less than the threshold value (C3 in FIG. 10), or if, in step S011, it is confirmed that the door 20 is open (D2 in FIG. 10), the process proceeds to step S013.
- step S013 the robot control device 31 operates the robot hand 42 to press the supply device button 66d. This connects the nozzle connection part 90 of the angle plate 72 in the station 15 to the hydraulic/pneumatic supply device 26.
- the robot control device 31 also operates the camera 46 to take an image of the information mark 88 of the fixed member 84 on the angle plate 72, and compares it with reference image data of the fixed member 84 previously stored in the robot control device 31 to confirm the distance displaced from the reference position. If the displaced distance is greater than a predetermined threshold, the upper control system 48 operates the robot hand 42 to correct the position of the robot hand 42.
- the camera 46 takes an image of the corresponding part number displayed on the fixed member 84 and records it in the robot control device 31. It is confirmed whether this matches the corresponding part number of the workpiece placement table 24 previously recorded in the robot control device 31 (E in FIG. 10). If the corresponding part number displayed on the fixed member 84 does not match the corresponding part number on the workpiece placement table 24 (E1 in FIG. 10), the process proceeds to step S014, and the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has received the alarm moves the automatic guided vehicle 32 to another station 15.
- step S015 if a machined workpiece W is fixed to the angle plate 72, the robot control device 31 operates the robot hand 42 to press the workpiece clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, disengaging the claw member 82 from the workpiece W, and the clamper 74 enters an unclamped state.
- step S016 the robot control device 31 simultaneously photographs the information mark 88 of the fixing member 84 of the angle plate 72 and the position mark 86 of the claw member 82 to check whether the unclamped state has been reached normally.
- two-way images, a plan view and a front view of the information mark 88 and the position mark 86 are obtained by photographing from two directions, the vertical upper side and the horizontal front side. Note that when a 3D camera or a stereo camera is used as the camera 46, the image obtained in one photographing may be decomposed into two-way images, for example, an image from the front and an image from the depth direction, and used.
- step S017 the relative positional relationship between the position mark 86 and the information mark 88 in the reference image of the unclamped state stored in advance in the robot control device 31 is compared with the relative positional relationship between the position mark 86 and the information mark 88 in the photographed image (F in FIG. 10). Specifically, the horizontal lateral distance XU and the vertical distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image in the unclamped state, and the horizontal front-rear distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 (see FIG.
- the process proceeds to step S018, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b.
- the movable member 78 of the clamper 74 rotates, and the claw member 82 engages with the work W, so that the clamper 74 is in the clamped state.
- step S019 the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and disengage the claw member 82 from the workpiece W, causing the clamper 74 to return to the unclamped state.
- step S020 the robot control device 31 again operates the camera 46 to simultaneously photograph the information mark 88 of the fixed member 84 of the angle plate 72 and the position mark 86 of the claw member 82 from the vertically upward side and the horizontally forward side.
- step S021 the horizontal lateral distance XU and the vertical distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image, as well as the horizontal front-back distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88, are compared with the photographed image to confirm the distance difference (G in FIG. 10).
- the process proceeds to step S022, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and clamp the workpiece W. Furthermore, the robot control device 31 outputs an alarm to the upper control system 48.
- the upper control system 48 that has received the alarm output moves the automated guided vehicle 32 to another station 15.
- step S023 the robot control device 31 determines that the workpiece W has been properly unclamped, and proceeds to step S024.
- step S024 the robot 30 operates the robot hand 42 to grasp the unclamped workpiece W, and moves to the workpiece placement table 24 by the automated guided vehicle 32, where the workpiece W is stored.
- step S025 the robot control device 31 operates the camera 46 to take an image of the placement table position mark 50 and placement table information mark 52 on the material placement table 22, and compares the image with reference image data when the unmanned transport vehicle 32 is in a reference position relative to the material placement table 22, which is stored in advance in the robot control device 31, and checks the distance of deviation from the reference position if there is any deviation. If the distance of deviation is equal to or greater than a threshold, the robot control device 31 operates the robot hand 42 to correct its position.
- the robot control device 31 records the corresponding part numbers in the robot control device 31, and checks whether these corresponding part numbers match the corresponding part numbers displayed on the fixed member 84 (H in FIG. 10). If the corresponding part numbers displayed on the fixed member 84 do not match the corresponding part numbers on the material placement table 22 (H1 in FIG. 10), the robot control device 31 moves to step S026 and outputs an alarm to the upper control system 48.
- the host control system 48 which has received the alarm output moves the automated guided vehicle 32 to another station 15 .
- step S027 the robot control device 31 actuates the robot hand 42 to grip the unmachined workpiece W on the material placement table 22 and place the workpiece W on the workpiece placement portion 76 of the angle plate 72.
- step S028 the robot control device 31 actuates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and the claw members 82 to engage with the workpiece W, so that the clamper 74 enters a clamped state.
- the robot control device 31 operates the camera 46 to simultaneously photograph the information mark 88 of the fixing member 84 of the angle plate 72 and the position mark 86 of the claw member 82.
- the photographs are taken from two directions: from above in the vertical direction so that the photographed image is a plan view of these, and from the front in the horizontal direction so that the photographed image is a front view of these.
- the robot control device 31 compares the relative positional relationship between the position mark 86 and the information mark 88 in a reference image of the clamped state that has been stored in advance in the upper control system 48 with the relative positional relationship between the position mark 86 and the information mark 88 in the photographed image (J1 in Figure 10). Specifically, the horizontal lateral distance XC and vertical distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image in the clamped state, as well as the horizontal front-to-back distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 (all see FIG. 7a) are compared with the captured image to check the difference from the reference distance, i.e., the distance difference.
- the process proceeds to step S030, and the robot control device 31 records the position of the clamper 74 where the difference in the distance is equal to or greater than the threshold value.
- the process proceeds to step S031, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, and the engagement of the claw member 82 with the work W is released, so that the clamper 74 is in an unclamped state.
- step S032 the process proceeds to step S032, and the robot control device 31 operates the robot hand 42 to grasp the work W and temporarily move it to the temporary placement table 23 on the material placement table 22.
- step S033 the robot control device 31 operates the robot hand 42 to pull out the air nozzle 68 from the storage position of the station 14, and cleans the clamper 74 and the attachment position of the work W and the surrounding areas thereof. This can eliminate any problem in the clamper 74 that would prevent it from being properly clamped due to dirt or the like being caught in it.
- step S034 the robot control device 31 operates the robot hand 42 to grasp the workpiece W on the temporary placement table 23 and place it on the workpiece placement section 76.
- step S035 the robot control device 31 operates the robot hand 42 to press the workpiece clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and the claw members 82 to engage with the workpiece W, so that the clamper 74 is in a clamped state.
- step S036 the camera 46 simultaneously photographs the information mark 88 of the fixed member 84 of the angle plate 72 and the position mark 86 of the claw member 82 to check whether the workpiece has been clamped normally.
- the photographs are taken from two directions: from above in the vertical direction so that the photographed image is a plan view of these, and from the front in the horizontal direction so that the photographed image is a front view of these.
- the relative positional relationship between the position mark 86 and the information mark 88 in a reference image of the clamped state that is pre-stored in the robot control device 31 is compared with the relative positional relationship between the position mark 86 and the information mark 88 in the photographed image (K in Figure 10). Specifically, the horizontal lateral distance XC and vertical distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image in the clamped state, as well as the horizontal front-to-back distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 (all see FIG. 7a) are compared with the captured image to confirm the distance difference.
- step S037 the robot hand 42 is operated to press the work clamp button 66b.
- the robot hand 42 operates the robot hand 42 to clamp the unclamped work W and return the work W to the temporary placement table 23 of the material placement table 22.
- the robot control device 31 outputs an alarm to the upper control system 48.
- the upper control system 48 that has output the alarm moves the automated guided vehicle 32 to another station 15 (K1 in FIG. 10).
- step S0308 the robot control device 31 operates the camera 46 to photograph the pressure gauge 92, and determines whether or not a pressure equal to or greater than the threshold is being supplied to the clamper 74 based on the photographed image (L in FIG. 10). If the pressure is less than the threshold, the process proceeds to step S039, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b.
- the robot control device 31 operates the robot hand 42 to clamp the work W and move it to the temporary placement table 23 on the material placement table 22.
- the robot control device 31 outputs an alarm to the upper control system 48.
- the host control system 48 that received the alarm output moves the automated guided vehicle 32 to another station 15 (L1 in Figure 10).
- step S038 the robot control device 31 determines that a pressure equal to or greater than the threshold is being supplied to the clamper 74
- the process proceeds to step S040, where the robot control device 31 operates the robot hand 42 to press the supply device button 66d to disconnect the nozzle connection part 90 of the angle plate 72 from the hydraulic and pneumatic supply device 26.
- the robot control device 31 operates the camera 46 to photograph the pressure gauge 92, and determines based on the photographed image whether or not a pressure equal to or greater than the threshold is being supplied to the clamper 74 even after the hydraulic and pneumatic supply device 26 has been disconnected (M in FIG. 10).
- step S041 the robot control device 31 operates the robot hand 42 to press the supply device button 66d to reconnect the nozzle connection part 90 of the angle plate 72 to the hydraulic/pneumatic supply device 26.
- the robot control device 31 also operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, and the claw member 82 to disengage from the work W, so that the clamper 74 enters an unclamped state.
- the robot control device 31 also operates the robot hand 42 to clamp the unclamped work W and move it to the temporary placement table 23 on the material placement table 22.
- the upper control system 48 that has output the alarm moves the automated guided vehicle 32 to another station 15 (M1 in FIG. 10).
- step S042 the robot control device 31 activates the robot hand 42 to close the door 20.
- the robot hand 42 moves from a position slightly to the right of the door handle 20a (the side that opens the door 20) to the left (the side that closes the door 20) while contacting the door handle 20a, and closes the door 20 by sliding the door 20.
- the robot control device 31 When the robot control device 31 has closed the door 20, it activates the robot hand 42 to press the lock operation button 66a to lock the door 20.
- the work set complete button 66c it is possible to communicate to the machine tool 12 that the setting of the workpiece W has been completed.
- the robot 30 has a robot hand 42 configured to be able to grasp the workpiece W, and can be moved by an automated guided vehicle 32 that can move in any direction. Therefore, the upper control system 48 operates the automated guided vehicle 32 on which the robot 30 is placed to move the robot 30 to the stations 14 and 15, and the robot control device 31 operates the robot hand 42 of the robot 30 to place the workpiece W on the workpiece mounting table 16. This allows the robot 30 to be moved appropriately to the stations 14 and 15 where the workpiece W needs to be attached or detached, rather than placing the robot 30 at each of the stations 14 and 15, and allows the robot 30 to be used to efficiently attach and detach the workpiece W.
- the robot 30 has a camera 46 configured to be able to photograph the movable member 78 and the fixed member 84 at a reference position for photographing, and can be moved to the photographing position by the automatic guided vehicle 32.
- the upper control system 48 moves the robot 30 to the photographing position by operating the automatic guided vehicle 32 on which the robot 30 is placed, and the robot control device 31 can simultaneously photograph the movable member 78 and the fixed member 84 by operating the camera 46.
- the robot control device 31 can determine the mounting/removal state of the workpiece W with respect to the workpiece mounting table 16 based on the images of the movable member 78 and the fixed member 84 that have been photographed, and can continue processing if it is determined that the workpiece W is properly mounted on the workpiece mounting table 16.
- the upper control system 48 can include, for example, a process of operating the clamper 74 and the robot 30 to once unclamp the workpiece W and then clamp it again, or a process of interrupting processing to improve clamping. This allows the process of checking for and resolving malfunctions in stations 14 and 15 to be included, and allows the robot 30 to efficiently load and unload the workpiece W.
- the movable member 78 is formed with a position mark 86 whose orientation changes when the movable member 78 is actuated.
- the fixed member 84 is formed with an information mark 88.
- the display surfaces of the position mark 86 and the information mark 88 are both displayed facing the direction from the angle plate 72 toward the door 20, and can be photographed simultaneously by the camera 46. This makes it possible to clarify the reference position of the image photographed by the camera 46.
- the comparison with the reference image is performed here based on images of the movable member 78 and the fixed member 84 photographed from the vertically upward side and the horizontally forward side. This makes it possible to reliably determine the relative positional relationship between the movable member 78 and the fixed member 84, i.e., the clamped or unclamped state, and efficiently mount and remove the workpiece W using the robot 30.
- the robot control device 31 determines that the workpiece W is not properly clamped, i.e. that the workpiece W is not properly clamped, it operates the robot hand 42 to grasp the workpiece W and temporarily move it to the temporary placement table 23 on the material placement table 22.
- the robot control device 31 is configured to operate the robot hand 42 to pull out the air nozzle 68 from its storage position in the station 14 and clean the clamper 74 and the attachment position of the workpiece W and their surroundings. Therefore, if the clamper 74 is not properly clamped due to the presence of dirt or the like, this can be resolved. This allows the workpiece W to be stably and reliably clamped, and the workpiece W can be efficiently attached and detached using the robot 30.
- the workpiece mounting table 16 is provided with a pressure gauge 92 for displaying the pressure supplied to the clamper 74 by the hydraulic and pneumatic supply device 26.
- the robot control device 31 operates the camera 46 to photograph the pressure gauge 92, and can determine whether or not a pressure equal to or greater than the threshold value is being supplied to the clamper 74 even after the hydraulic and pneumatic supply device 26 is disconnected, based on the photographed image.
- the robot control device 31 is configured to operate the robot hand 42 to press the supply device button 66d, thereby reconnecting the nozzle connection part 90 of the angle plate 72 to the hydraulic and pneumatic supply device 26.
- the robot control device 31 is configured to operate the robot hand 42 to press the workpiece clamp button 66b, thereby rotating the movable member 78 of the clamper 74 to release the engagement of the claw member 82 with the workpiece W, and to place the clamper 74 in an unclamped state.
- the robot control device 31 is configured to operate the robot hand 42 to clamp the unclamped workpiece W and move it onto the temporary placement table 23 of the material placement table 22. This allows the processing of the workpiece W to be interrupted in order to prioritize resolving any malfunctions found in stations 14 and 15, and allows the robot 30 to efficiently load and unload the workpiece W.
- the workpiece mounting/removal system 10 can efficiently mount and remove the workpiece W using the robot 30.
- a pallet 102 extending horizontally is placed on the plate base 70 of the workpiece mounting table 16.
- the four clampers 74 are arranged above the pallet 102 and are configured to clamp the workpiece W placed on the upper surface of the pallet 102.
- the pressure gauge 92 is arranged above the nozzle connection part 90.
- the robot 30 is configured to confirm, i.e., judge, the unclamped and clamped states of the clamper 74 by comparing a reference image previously recorded in the robot control device 31 with an image captured by the camera 46. Specifically, the relative positional relationship between the position mark 86 and the information mark 88 in the captured image is compared with the relative positional relationship in the reference image.
- the horizontal lateral distance XC and horizontal front-to-back distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image captured from above, and the vertical distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 in the reference image captured from the front are used.
- the horizontal lateral distance XU and horizontal front-to-back distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image captured from above, as well as the vertical distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 in the reference image captured from the front, are used.
- the robot control device 31 can determine the mounting/removal state of the workpiece W on the workpiece mounting table 16 based on the image captured by the camera 46, and can continue processing if it determines that the workpiece W is properly mounted on the workpiece mounting table 16. Furthermore, if the robot control device 31 determines that the workpiece W is not properly mounted on the workpiece mounting table 16, the upper control system 48 can suspend processing if it determines that the workpiece W is not properly mounted, even if, for example, the clamper 74 and the robot 30 are operated to unclamp the workpiece W and then clamp it again. This makes it possible to include a process for resolving any defects found in the stations 14 and 15, and to efficiently mount and remove the workpiece W using the robot 30.
- the robot hand 42 presses the four operation buttons 66a, 66b, 66c, and 66d located on the side of the door 20, but this is not limiting and may be automated, for example, by communication from a higher-level control system.
- hydraulic and pneumatic supply device 26 has been described here as being connected from the side of the work mounting table 16, but this is not limited thereto, and it may be, for example, an upper online hydraulic supply device that is connected to the upper side of the work mounting table.
- clamper 74 has been described here as rotating the shaft member 80 to engage the claw member 82 with the workpiece W, but this is not limited to the above, and other types of clampers, such as a link clamp or a linear clamp, may also be used.
- work mounting table 16 has been described here as being disposed inside the stations 14 and 15, this is not limiting, and for example, the work mounting table may be used alone.
- Workpiece mounting/removal system 14 Station (workpiece mounting device) 15 Station (Work mounting device) 16 Workpiece mounting table 30 Robot 31 Robot control device (control device) 32 Automated guided vehicle (mobile body) 42 Robot Hand (Hand) 46 Camera 48 Upper control system (control device) 68 Air nozzle (cleaning means) 74: clamper; 78: movable member; 84: fixed member; 86: position mark (first photographing unit) 88 Information mark (second photographing part) 92 Pressure gauge 100 Work mounting stand W Work
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
- Jigs For Machine Tools (AREA)
- Machine Tool Sensing Apparatuses (AREA)
Abstract
A workpiece attachment/detachment system (10) for attaching/detaching a workpiece (W) for processing comprises a workpiece attachment platform (16), a station (14, 15) including a clamper (74) for actuating a movable member (78) to mount/remove the workpiece (W) onto/from the workpiece attachment platform (16) and a fixed member (84) fixed in the vicinity of the clamper (74), a robot (30) having a camera (46) and a robot hand (42) capable of gripping the workpiece (W), an unmanned conveying vehicle (32) on which the robot (30) is placed and which is capable of moving in order to move to an imaging position, and a robot control device (31) and a higher-level control system (48) for determining an attachment/detachment state of the workpiece (W) with respect to the workpiece attachment platform (16) on the basis of an image captured by the camera (46), characterized in that the camera (46) simultaneously images the movable member (78) and the fixed member (84).
Description
本発明は、ワーク着脱システムに関する。
The present invention relates to a workpiece attachment/detachment system.
特許文献1には、ロボットを用いて工作機械にワークを着脱する加工システムが開示されている。これによって、ワークの取り付けおよび取り外しを短時間に行うことができる。この加工システムでは、保持部材及びロボットアームの駆動モータの回転角からワークの位置を検出し、位置がずれている場合はこれを補正するように構成されている。このため、ワークの位置制御をするためには、ロボットを位置固定して配置する必要がある。
Patent Document 1 discloses a processing system that uses a robot to attach and detach a workpiece to and from a machine tool. This allows the workpiece to be attached and detached in a short time. This processing system is configured to detect the position of the workpiece from the rotation angle of the drive motor of the holding member and the robot arm, and to correct any misalignment. For this reason, in order to control the position of the workpiece, it is necessary to position the robot in a fixed position.
しかしながら、ロボットを位置固定して配置しようとすると、製造エリアに工作機械が複数設置されている場合には、工作機械1台ごとにロボット1台が必要になる。このように配置されたロボットは、工作機械が加工している間は停止状態になる。さらに、工作機械に隣接してロボットを配置することになるため、ロボットが配置されている側からは、ワークを取り付けるためのパレット等の搬入及び搬出をすることができず、ロボットを設置していない側に別途搬出入口を設ける必要が生じる。また、ワークの着脱時に、パレットと油空圧供給装置が接続解除される場合に、油空圧の圧力確認を容易にすることができないため、圧力降下が発生していたとしても直ぐに発見することができない。このため、ロボットを用いたワークの着脱を効率的に行う上で改善の余地がある。
However, if a robot is placed in a fixed position, and there are multiple machine tools installed in a manufacturing area, one robot is required for each machine tool. A robot placed in this way is stopped while the machine tools are processing. Furthermore, since the robot is placed adjacent to the machine tools, pallets for mounting workpieces cannot be loaded and unloaded from the side where the robot is installed, and a separate loading/unloading entrance must be provided on the side where the robot is not installed. Also, when the pallet and hydraulic/pneumatic supply device are disconnected when a workpiece is attached or detached, it is not easy to check the hydraulic/pneumatic pressure, so even if a pressure drop occurs, it cannot be immediately detected. For this reason, there is room for improvement in efficiently attaching and detaching workpieces using a robot.
本発明は、上記事情を鑑み、ロボットを用いたワークの着脱を効率的に行うことができるワーク着脱システムの提供を目的とする。
In consideration of the above circumstances, the present invention aims to provide a workpiece attachment/detachment system that can efficiently attach and detach workpieces using a robot.
本発明の一の態様によれば、加工のためにワークを着脱するワーク着脱システムであって、ワークを取付けるためのワーク取付台と、可動部材を作動することによってワークをワーク取付台に対して取り付ける、又は、取り外すためのクランパと、クランパの近傍に固定された固定部材とを有するワーク取付装置と、ワークを把持可能に構成されたハンドと、撮影位置において可動部材及び固定部材を撮影可能に構成されたカメラとを有するロボットと、ロボットを載置し、ロボットを撮影位置へ移動するために、任意の方向に移動可能な移動体と、クランパ、ロボット及びカメラを作動するための制御装置であって、カメラで撮影した画像に基づいて、ワーク取付台に対するワークの着脱状態を判断する制御装置と、を備え、カメラは、可動部材及び固定部材を同時に撮影することを特徴とする。
According to one aspect of the present invention, a workpiece mounting/removal system for mounting/removing a workpiece for machining includes a workpiece mounting table for mounting the workpiece, a workpiece mounting device having a clamper for mounting or removing the workpiece from the workpiece mounting table by operating a movable member and a fixed member fixed near the clamper, a robot having a hand configured to grasp the workpiece and a camera configured to photograph the movable member and the fixed member at a photographing position, a moving body on which the robot is placed and which can move in any direction to move the robot to the photographing position, and a control device for operating the clamper, robot, and camera, which determines the mounting/removal state of the workpiece on the workpiece mounting table based on an image captured by the camera, and the camera is characterized in that it photographs the movable member and the fixed member simultaneously.
また、本発明の一の態様によれば、可動部材に形成され、可動部材が作動することによって向きが変化する第1の撮影部と、固定部材に形成された第2の撮影部と、を備えてもよく、第1の撮影部と第2の撮影部とは同じ方向でカメラと対向し、カメラは、第1の撮影部及び第2の撮影部を同時に撮影してもよい。
In addition, according to one aspect of the present invention, a first image capturing unit may be formed on a movable member and the orientation of which changes when the movable member is actuated, and a second image capturing unit may be formed on a fixed member, and the first image capturing unit and the second image capturing unit may face the camera in the same direction, and the camera may capture images of the first image capturing unit and the second image capturing unit simultaneously.
さらに、本発明の一の態様によれば、制御装置は、カメラで撮影した画像における第1の撮影部と第2の撮影部との位置関係から、クランパがワークをワーク取付台に取り付けるクランプ状態、又は、ワークをワーク取付台から取り外すアンクランプ状態にあることを判断し、可動部材がクランプ状態又はアンクランプ状態の基準位置から閾値以上ずれていると判断した場合は、清掃手段を作動して、クランパ及びワークの周辺を清掃するように構成されてもよい。
Furthermore, according to one aspect of the present invention, the control device may be configured to determine whether the clamper is in a clamped state in which the workpiece is attached to the workpiece mounting table, or in an unclamped state in which the workpiece is removed from the workpiece mounting table, based on the relative positions of the first and second photographing units in an image captured by the camera, and to operate a cleaning means to clean the area around the clamper and the workpiece if it determines that the movable member has deviated from the reference position in the clamped or unclamped state by more than a threshold value.
また、本発明の一の態様によれば、ワーク取付台は、油空圧供給装置を用いてクランパに供給された圧力を表示するための圧力計を備えてもよく、制御装置は、カメラによって撮影された圧力計の画像からクランパの圧力値を検出し、圧力値が閾値以下の場合は、ワークをワーク取付台から取り外すように構成されてもよい。
Furthermore, according to one aspect of the present invention, the work mounting table may be equipped with a pressure gauge for displaying the pressure supplied to the clamper using the hydraulic/pneumatic pressure supply device, and the control device may be configured to detect the pressure value of the clamper from an image of the pressure gauge captured by the camera, and remove the work from the work mounting table if the pressure value is below a threshold value.
本発明の一の態様に係るワーク着脱システムによると、ロボットは、ワークを把持可能に構成されたハンドを有し、任意の方向に移動可能な移動体によって移動することができる。このため、制御装置は、ロボットを載置した移動体を作動させることによってロボットをワーク取付装置まで移動させ、ロボットのハンドを作動させることによってワークをワーク取付台に配置することができる。これによって、ワーク取付装置ごとにロボットを配置するのではなく、ワークの着脱を必要とするワーク取付装置へ適宜ロボットを移動すればよく、ロボットを用いたワークの着脱を効率的に行うことができる。さらに、ロボットは、撮影位置において可動部材及び固定部材を撮影可能に構成されたカメラを有し、移動体によって撮影位置まで移動することができる。このため、制御装置は、ロボットを載置した移動体を作動させることによってロボットを撮影位置へ移動させ、カメラを作動させることによって可動部材及び固定部材を同時に撮影することができる。制御装置は、カメラで撮影した画像に基づいて、ワーク取付台に対するワークの着脱状態を判断することができる。このため、例えば、ワーク取付台にワークが適切に取り付けられていると判断した場合には加工を継続することができる。また、ワーク取付台にワークが適切に取り付けられていないと判断した場合には、制御装置は、例えば、クランパ及びロボットを作動してワークを一旦取り外した上で再度取り付ける工程や、取り付けを改善するために加工を中断するといった工程を含めることができる。これによって、ワーク取付装置の不具合の確認やその解消のための工程を含めることができ、ロボットを用いたワークの着脱を効率的に行うことができる。
In the workpiece mounting/removal system according to one aspect of the present invention, the robot has a hand configured to be able to grasp the workpiece, and can be moved by a moving body that can move in any direction. Therefore, the control device can move the robot to the workpiece mounting device by operating the moving body on which the robot is placed, and can place the workpiece on the workpiece mounting table by operating the hand of the robot. This allows the robot to be moved appropriately to the workpiece mounting device that requires the workpiece to be mounted/removed, rather than disposing the robot for each workpiece mounting device, and can efficiently mount and remove the workpiece using the robot. Furthermore, the robot has a camera configured to be able to photograph the movable member and the fixed member at the shooting position, and can be moved to the shooting position by the moving body. Therefore, the control device can move the robot to the shooting position by operating the moving body on which the robot is placed, and can simultaneously photograph the movable member and the fixed member by operating the camera. The control device can determine the mounting/removal state of the workpiece on the workpiece mounting table based on the image taken by the camera. Therefore, for example, when it is determined that the workpiece is properly mounted on the workpiece mounting table, processing can be continued. Furthermore, if it is determined that the workpiece is not properly attached to the workpiece mounting table, the control device can include, for example, a process of operating the clamper and robot to remove the workpiece and then reattach it, or a process of interrupting processing to improve the attachment. This allows the process of checking for and resolving any malfunctions in the workpiece mounting device to be included, allowing the robot to efficiently mount and remove the workpiece.
以下、添付図面を参照して、実施形態に係るワーク着脱システム10を説明する。同様な又は対応する要素には同一の符号を付し、重複する説明は省略する。理解を容易にするために、図の縮尺を変更して説明する場合がある。
The workpiece mounting/removal system 10 according to the embodiment will be described below with reference to the attached drawings. Similar or corresponding elements are given the same reference numerals, and duplicated explanations will be omitted. To facilitate understanding, the scale of the drawings may be changed for explanation.
図1には、工場等の製造エリアMA(図3参照)に配置されたワーク着脱システム10の斜視図を示す。また、図2には、ワーク着脱システム10の平面図を示す。ワーク着脱システム10は、ワークWを取り付けて工作機械12、13へ供給するワーク取付装置としてのワークセッティングステーション14、15(以下、ステーション14と称する)を備える。ステーション14、15は、単独で構成されて、例えば、マシニングセンタ等の工作機械12、13と接続されてもよく、又は、工作機械12、13と一体で構成されてもよい。ステーション14、15の内部には、工作機械12、13によって加工されるワークWを取り付けるためのワーク取付台16(図6a参照)が配置されている。
FIG. 1 shows a perspective view of a workpiece mounting/removal system 10 arranged in a manufacturing area MA (see FIG. 3) of a factory or the like. FIG. 2 shows a plan view of the workpiece mounting/removal system 10. The workpiece mounting/removal system 10 includes workpiece setting stations 14, 15 (hereinafter referred to as station 14) as workpiece mounting devices that mount a workpiece W and supply it to machine tools 12, 13. Stations 14, 15 may be configured independently and connected to machine tools 12, 13 such as machining centers, or may be configured integrally with machine tools 12, 13. Inside stations 14, 15, a workpiece mounting table 16 (see FIG. 6a) is arranged for mounting a workpiece W to be machined by machine tools 12, 13.
図1に示すように、ステーション14は、ワークWをステーション14内部に移動、すなわち搬入し、内部から移動、すなわち搬出するための搬出入口18及び搬出入口18を開閉するためのスライド可能に形成されたドア20を有する。ドア20には、開閉する際に把持するためのドアハンドル20aが取り付けられている。ドア20の近傍には、未加工のワークWを積載するための材料置き台22と、加工後のワークWを積載するためのワーク置き台24とが配置されている。材料置き台22には、ワークWを一時的に載置するための仮置台23が形成されている。また、材料置き台22及びワーク置き台24は、それぞれ4本の脚部22a、24aを有し、材料置き台22及びワーク置き台24に配置されたワークWの高さ位置が後述するハンドとしてのロボットハンド42の高さ位置とほぼ同一になるように構成されている。これによって、ロボットハンド42の移動距離が増加することを抑制し、効率的に作動させることができる。また、ステーション14の外側には、これに隣接して、ワーク取付台16に油空圧を供給するための油空圧供給装置26が配置されている。
As shown in FIG. 1, the station 14 has an entrance 18 for moving the workpiece W into the station 14, i.e., for bringing it in and out of the station 14, and a door 20 formed to be slidable for opening and closing the entrance 18. The door 20 is fitted with a door handle 20a for gripping when opening and closing. Near the door 20, a material placement table 22 for loading the unprocessed workpiece W and a work placement table 24 for loading the processed workpiece W are arranged. The material placement table 22 is formed with a temporary placement table 23 for temporarily placing the workpiece W. In addition, the material placement table 22 and the work placement table 24 each have four legs 22a, 24a, and are configured so that the height position of the workpiece W placed on the material placement table 22 and the work placement table 24 is approximately the same as the height position of the robot hand 42 as a hand described later. This prevents the movement distance of the robot hand 42 from increasing, allowing it to operate efficiently. Additionally, an oil and air pressure supply device 26 is located adjacent to the outside of the station 14 to supply oil and air pressure to the work mounting table 16.
ワーク着脱システム10は、また、ワークWを搬出入するためのロボット30を備える。ロボット30は、材料置き台22上の未加工のワークWをステーション14内のワーク取付台16へと搬入し、加工済みのワークWをワーク取付台16からワーク置き台24上へと搬出する。ロボット30は、移動体としての無人搬送車32の上面にその台座部34に取り付けられており、製造エリアMA内を移動可能に構成されている。さらに、ロボット30は、台座部34に対して垂直となる軸線回り、ここでは鉛直方向に沿った軸線回りに回動可能に構成された外形円柱状の支柱36と、一方の端部が支柱36に対して回動可能に取り付けられ、複数の関節部38を介して連結された複数のアーム40aが互いに関節部38回りに回動可能に構成されているアーム部40とを備える。
The workpiece attachment/detachment system 10 also includes a robot 30 for loading and unloading the workpiece W. The robot 30 loads the unprocessed workpiece W on the material placement table 22 onto the workpiece mounting table 16 in the station 14, and loads the processed workpiece W from the workpiece mounting table 16 onto the workpiece placement table 24. The robot 30 is attached to a base 34 on the upper surface of an automated guided vehicle 32 as a moving body, and is configured to be movable within the manufacturing area MA. The robot 30 further includes a cylindrical support 36 configured to be rotatable around an axis perpendicular to the base 34, here an axis along the vertical direction, and an arm unit 40, one end of which is rotatably attached to the support 36, and multiple arms 40a connected via multiple joints 38 are configured to be rotatable around the joints 38.
ロボット30のアーム部40の他方の端部には、ワークWを把持するためのハンドとしてのロボットハンド42が脱着可能に連結されている。ロボットハンド42は、ワークWを把持するときに向きを調整することができるように、アーム40aの軸線回りに回動可能に構成されている。また、台座部34には、ロボットハンドホルダ44が取り付けられており、ロボットハンド42を使用しないときには、このロボットハンドホルダ44に収容する。
A robot hand 42 is detachably connected to the other end of the arm 40 of the robot 30 as a hand for gripping the workpiece W. The robot hand 42 is configured to be rotatable around the axis of the arm 40a so that the orientation can be adjusted when gripping the workpiece W. In addition, a robot hand holder 44 is attached to the base 34, and the robot hand 42 is stored in this robot hand holder 44 when not in use.
ワーク着脱システム10は、また、アーム部40の他方の端部側、すなわちロボットハンド42の側に配置されたカメラ46を備える。カメラ46は、ワークWを把持するロボットハンド42の側を撮影するように配置されており、ロボットハンド42と共にアーム40aの軸線回りに回動可能に構成されている。カメラ46は、所定の解像度が得られるものであればステレオカメラ、3次元カメラ等種類を問わない。また、台座部34の内部には、ロボット30の挙動及びカメラ46を制御するための制御装置としてのロボット制御装置31を備える。
The workpiece attachment/detachment system 10 also includes a camera 46 arranged on the other end of the arm section 40, i.e., on the side of the robot hand 42. The camera 46 is arranged so as to capture an image of the side of the robot hand 42 gripping the workpiece W, and is configured to be rotatable around the axis of the arm 40a together with the robot hand 42. The camera 46 may be of any type, such as a stereo camera or a three-dimensional camera, as long as it can provide a predetermined resolution. In addition, a robot control device 31 is provided inside the base section 34 as a control device for controlling the behavior of the robot 30 and the camera 46.
図2に示すように、ワーク着脱システム10は、製造エリアMA内に、ステーション14、15、ロボット30及び無人搬送車32を制御するための制御装置としての上位制御システム48を備える。上位制御システム48は、ステーション14、15、ロボット30及び無人搬送車32と無線及び/又は有線で通信可能に接続されている。無人搬送車32は、上位制御システム48によって作動され、製造エリアMAの床面FS上を人が運転操作をしなくても指示された目的地まで自動走行することができるように構成されている。無人搬送車32の下方側には、図示しないメカナムホイールが回転可能に取り付けられている。ホイールは、通常のタイヤとホイールの組み合わせによって形成することができるが、好ましくは、メカナムホイールによって形成される。メカナムホイールはホイールの回転差を用いて旋回を行うことができる。また、ホイールの回転差を制御することによって、通常のホイールのようにホイールの回転方向への直線移動だけでなく、全方向への平行移動や直進旋回を行うことができる。これによって、無人搬送車32は、直行、横行、斜行、曲行、旋回、蛇行及びクランク等の複数の挙動の動作モードで移動することができる。
As shown in FIG. 2, the workpiece attachment/detachment system 10 includes a host control system 48 as a control device for controlling the stations 14, 15, the robot 30, and the automated guided vehicle 32 in the manufacturing area MA. The host control system 48 is connected to the stations 14, 15, the robot 30, and the automated guided vehicle 32 wirelessly and/or by wire for communication. The automated guided vehicle 32 is operated by the host control system 48 and is configured to automatically travel to a specified destination on the floor surface FS of the manufacturing area MA without a human driver. A Mecanum wheel (not shown) is rotatably attached to the lower side of the automated guided vehicle 32. The wheel can be formed by a combination of a normal tire and a wheel, but is preferably formed by a Mecanum wheel. The Mecanum wheel can turn using the rotation difference of the wheels. In addition, by controlling the rotation difference of the wheels, it is possible to perform not only linear movement in the rotation direction of the wheel like a normal wheel, but also parallel movement in all directions and straight turns. This allows the automated guided vehicle 32 to move in multiple operating modes, including straight, lateral, diagonal, curving, turning, serpentine, and cranking.
上位制御システム48は、工作機械12、13及びステーション14、15とも電気的に接続されており、ステーション14内のワークWの取り付けの有無及びワークWを加工するための工作機械12の稼働の有無を検知することができる。このため、上位制御システム48は、ロボット30を作動させて、一方の工作機械12側のステーション14に未加工のワークWを搬入すると、工作機械12がワークWを加工している間に、無人搬送車32を作動させてワークWの加工が行われていない他方の工作機械13側へ移動させる(図2中T1)。上位制御システム48は、ロボット30及び無人搬送車32を他方の工作機械13側へ移動させると、ロボット30を作動させて未加工のワークWを他方のステーション15内へ搬入する。さらに、上位制御システム48は、例えば、一方の工作機械12がワークWの加工を完了したことを検知すると、ロボット30及び無人搬送車32を一方の工作機械12側へ移動させる(図2中T2)、又は、一方の工作機械12がワークWの加工を完了していない場合には、ロボット30及び無人搬送車32をワークWが取り付けられていない別の工作機械(図3参照)側へ移動させる(図2中T3)。このように、上位制御システム48は、ロボット30による作業を必要とする工作機械12、13へ適宜無人搬送車32を移動させる。
The upper control system 48 is also electrically connected to the machine tools 12, 13 and stations 14, 15, and can detect whether a workpiece W is attached in station 14 and whether the machine tool 12 for machining the workpiece W is operating. For this reason, the upper control system 48 operates the robot 30 to carry an unmachined workpiece W into station 14 on one of the machine tools 12, and then operates the automated guided vehicle 32 to move the workpiece W to the other machine tool 13 side where machining is not being performed while the machine tool 12 is machining the workpiece W (T1 in FIG. 2). The upper control system 48 moves the robot 30 and the automated guided vehicle 32 to the other machine tool 13 side, and then operates the robot 30 to carry the unmachined workpiece W into the other station 15. Furthermore, when the host control system 48 detects that one of the machine tools 12 has completed machining the workpiece W, it moves the robot 30 and the automated guided vehicle 32 to the side of the one of the machine tools 12 (T2 in FIG. 2), or when the one of the machine tools 12 has not completed machining the workpiece W, it moves the robot 30 and the automated guided vehicle 32 to the side of another machine tool (see FIG. 3) to which the workpiece W is not attached (T3 in FIG. 2). In this way, the host control system 48 appropriately moves the automated guided vehicle 32 to the machine tools 12, 13 that require work by the robot 30.
図3には、ワーク着脱システム10を有する製造エリアのフロアレイアウトの一例を示す。上位制御システム48は、製造エリアMA内の無人搬送車32及びロボット30を作動させる。このため、上位制御システム48は、無人搬送車32を作動させ、製造エリアMA内の材料ストッカ54へと移動させると共に、ロボット30を作動して、材料ストッカ54から未加工のワークWを取り出し、必要とする個数だけ無人搬送車32の上面に載置させることができる。さらに、上位制御システム48は、必要な個数のワークWが無人搬送車32に載置されると、無人搬送車32をステーション14及び材料置き台22の側へと移動させ、ロボット30を作動させることによって運んできたワークWを材料置き台22上に配置することができる。これによって、未加工のワークWが無くなっていた材料置き台22上に新たなワークWを自動で供給することができる。
FIG. 3 shows an example of the floor layout of a manufacturing area having a workpiece attachment/detachment system 10. The upper control system 48 operates the automated guided vehicle 32 and the robot 30 in the manufacturing area MA. For this reason, the upper control system 48 operates the automated guided vehicle 32 to move it to the material stocker 54 in the manufacturing area MA, and operates the robot 30 to take out unprocessed workpieces W from the material stocker 54 and place them on the upper surface of the automated guided vehicle 32 as many as required. Furthermore, when the required number of workpieces W are placed on the automated guided vehicle 32, the upper control system 48 moves the automated guided vehicle 32 to the side of the station 14 and the material placement table 22, and operates the robot 30 to place the carried workpieces W on the material placement table 22. This allows new workpieces W to be automatically supplied to the material placement table 22 where the unprocessed workpieces W had disappeared.
また、上位制御システム48は、ロボット30を作動させてワーク置き台24上にある加工済みのワークWを無人搬送車32の上面に載置させることができる。さらに、上位制御システム48は、ワークWを載置すると、無人搬送車32を作動させて製造エリアMA内のワークストッカ56へと移動させ、ロボット30を作動させて運んできた加工済みのワークWをワークストッカ56に収納することができる。これによって、ワーク置き台24上に積載された加工済みのワークWをワークストッカ56内に自動的に収納することができる。
The host control system 48 can also operate the robot 30 to place the machined workpiece W on the workpiece placement table 24 on the upper surface of the automated guided vehicle 32. After the workpiece W is placed on the host control system 48, it can operate the automated guided vehicle 32 to move it to a workpiece stocker 56 in the manufacturing area MA, and operate the robot 30 to store the machined workpiece W that it has brought in the workpiece stocker 56. This allows the machined workpiece W that is loaded on the workpiece placement table 24 to be automatically stored in the workpiece stocker 56.
さらに、上位制御システム48は、例えば、ロボット30に装着されたロボットハンド42がワークWの大きさに適合していないと判断した場合やワークWの形状からロボットハンド42に替えて他のツールを装着すべきであると判断した場合は、無人搬送車32を作動させて製造エリアMA内のハンドロッカ58又はツールロッカ60へと移動させることができる。ハンドロッカ58又はツールロッカ60へ移動したロボット30は、装着しているロボットハンド42に替えて別のロボットハンド42又はツールを装着することができる。これによって、ロボット30にワークWの大きさ及び形状に応じたロボットハンド42又はツールを自動的に装着させることができる。
Furthermore, if the upper control system 48 determines, for example, that the robot hand 42 attached to the robot 30 is not suitable for the size of the workpiece W, or that a different tool should be attached instead of the robot hand 42 based on the shape of the workpiece W, it can operate the automated guided vehicle 32 to move it to a hand locker 58 or tool locker 60 in the manufacturing area MA. Once the robot 30 has moved to the hand locker 58 or tool locker 60, it can attach a different robot hand 42 or tool in place of the attached robot hand 42. This makes it possible to automatically attach a robot hand 42 or tool to the robot 30 according to the size and shape of the workpiece W.
図4には、材料置き台22及びワーク置き台24を上方側から見た斜視図を示す。材料置き台22は、ワークWを一時的に載置するための仮置台23を有する。また、材料置き台22及びワーク置き台24上には、ロボット30のカメラ46によって撮影した画像を用いて位置合わせをする際にその基準にするための置き台位置マーク50及び置き台情報マーク52が形成されている。置き台位置マーク50は、材料置き台22及びワーク置き台24とは異なる色に着色されたプレート、又は、これらに螺入された異なる色のボルトとされている。なお、置き台位置マーク50及び置き台情報マーク52は、貼付け可能なシール、テープ等とされてもよい。置き台位置マーク50には、向きを確認することができる文字、記号、マーク(図4では「M」の文字)が表示される。なお、置き台位置マークとしてQRコード(登録商標)を用いてもよい。また、ここでは、置き台情報マーク52には、QRコード(登録商標)が使用され、対応部品番号や積載されるワークWの状態、ワークWの空き場所を示すワーク空き番号が記録されている。これによって、ロボット30及び無人搬送車32は、材料置き台22及びワーク置き台24をカメラ46で撮影し、これらに対して位置合わせをすることができると共に、ワークWの対応部品番号を確認することができる。
4 shows an oblique view of the material placement table 22 and the work placement table 24 seen from above. The material placement table 22 has a temporary placement table 23 on which the work W is temporarily placed. In addition, a placement table position mark 50 and a placement table information mark 52 are formed on the material placement table 22 and the work placement table 24 to serve as a reference when aligning using an image captured by the camera 46 of the robot 30. The placement table position mark 50 is a plate colored in a different color from the material placement table 22 and the work placement table 24, or a bolt of a different color screwed into them. The placement table position mark 50 and the placement table information mark 52 may be a sticker, tape, or the like that can be attached. The placement table position mark 50 displays a letter, symbol, or mark (the letter "M" in FIG. 4) that can confirm the orientation. A QR code (registered trademark) may be used as the placement table position mark. Here, a QR code (registered trademark) is used for the placement table information mark 52, and the corresponding part number, the state of the workpiece W to be loaded, and the workpiece vacancy number indicating the vacant space for the workpiece W are recorded. This allows the robot 30 and the automated guided vehicle 32 to photograph the material placement table 22 and the workpiece placement table 24 with the camera 46, align them relative to each other, and confirm the corresponding part number of the workpiece W.
図5a及び図5bに、閉鎖状態及び開放状態におけるステーション14のドア20の斜視図をそれぞれ示す。無人搬送車32は、ステーション14のドア20に対向する位置、すなわち、ドア20の正面に移動すると、ロボット30のカメラ46によってステーション14を撮影する。ロボット制御装置31は、撮影したステーション14の画像から無人搬送車32に取り付けられたロボット30が適切な位置に配置されているかどうかを判定するように構成されている。また、ロボット制御装置31は、撮影したステーション14の画像からドア20の開放状態及び閉鎖状態を判定するように構成されている。
FIGS. 5a and 5b show perspective views of the door 20 of the station 14 in the closed and open states, respectively. When the automated guided vehicle 32 moves to a position facing the door 20 of the station 14, i.e., in front of the door 20, it photographs the station 14 with the camera 46 of the robot 30. The robot control device 31 is configured to determine whether the robot 30 attached to the automated guided vehicle 32 is positioned in an appropriate position from the photographed image of the station 14. The robot control device 31 is also configured to determine whether the door 20 is in an open or closed state from the photographed image of the station 14.
ドア20の横には、ステーション14の上下方向に沿って複数、ここでは、4つの操作ボタンが配置されている。具体的には、上方側には、ドア20をロック又はアンロックするためのロック操作ボタン66a、及び、ワーク取付台16に配置したワークWをクランプ又はアンクランプするためのワーククランプボタン66bが配置されている。さらに、その下方側には、ワークWのワーク取付台16への取り付け及びクランプの完了したことを工作機械12(図3参照)へ伝達するためのワークセット完了ボタン66c、及び、ワーク取付台16に油空圧を供給するための油空圧供給装置26を接続又は接続解除するための供給装置ボタン66dが配置されている。また、ドア20の横において4つの操作ボタン66a、66b、66c、66dの下方側には、清掃手段としてのエアノズル68が配置されている。エアノズル68は、エアブロー及びバキュームによって機械周辺のごみや埃を吹き飛ばし、かつ、吸い込んだりすることができる。ロボットハンド42又は人が引き出せるように伸縮自在のホース(図示省略)を有する。このため、ロボットハンド42を作動してエアノズル68を挟持してステーション14の内部までこれを引き出し、エア噴射することによって、ステーション14の内部及びワーク取付台16にクランプされたワークWの周囲を清掃することができる。
A number of operation buttons, four in this case, are arranged along the vertical direction of the station 14 beside the door 20. Specifically, on the upper side, a lock operation button 66a for locking or unlocking the door 20, and a work clamp button 66b for clamping or unclamping the work W placed on the work mounting table 16 are arranged. Furthermore, on the lower side, a work set completion button 66c for transmitting to the machine tool 12 (see FIG. 3) that the work W has been attached to the work mounting table 16 and clamped, and a supply device button 66d for connecting or disconnecting the hydraulic and pneumatic supply device 26 for supplying hydraulic and pneumatic pressure to the work mounting table 16 are arranged. In addition, an air nozzle 68 as a cleaning means is arranged below the four operation buttons 66a, 66b, 66c, and 66d beside the door 20. The air nozzle 68 can blow away and suck up dirt and dust around the machine by air blowing and vacuuming. It has a retractable hose (not shown) that can be pulled out by the robot hand 42 or a person. Therefore, by operating the robot hand 42 to clamp the air nozzle 68 and pull it out to the inside of the station 14, and spraying air, it is possible to clean the inside of the station 14 and the area around the workpiece W clamped to the workpiece mounting table 16.
ロボット制御装置31は、ロボットハンド42を作動してドア20をスライドさせて開放した後、材料置き台22上に積載された未加工のワークWをロボットハンド42によって把持し、ステーション14内部のワーク取付台16へ移動、すなわち搬入することができる。また、ロボット制御装置31は、移動したワークWがワーク取付台16に取り付けられると、ロボットハンド42を作動してドアハンドル20aを挟持し、ドア20をスライドさせて閉鎖することができる。
The robot control device 31 can operate the robot hand 42 to slide open the door 20, and then use the robot hand 42 to grasp the unmachined workpiece W loaded on the material placement table 22 and move, i.e., carry, it to the workpiece mounting table 16 inside the station 14. In addition, when the moved workpiece W is attached to the workpiece mounting table 16, the robot control device 31 can operate the robot hand 42 to clamp the door handle 20a and slide the door 20 to close it.
また、ロボット制御装置31は、ドア20の閉鎖後、ロボットハンド42を作動してロック操作ボタン66aを押してドア20をロックし、ロボットハンド42を作動してワークセット完了ボタン66cを押すことによって、ワークWのセットが完了したことを工作機械12に伝達することができる。
In addition, after the door 20 is closed, the robot control device 31 can operate the robot hand 42 to press the lock operation button 66a to lock the door 20, and can also operate the robot hand 42 to press the work set completion button 66c, thereby communicating to the machine tool 12 that the setting of the workpiece W has been completed.
図6a及び図6bに、クランパ74によってワークWをクランプした状態(以下、クランプ状態と称する)及びアンクランプした状態(以下、アンクランプ状態と称する)のワーク取付台16の斜視図をそれぞれ示す。ワーク取付台16は、プレート台座70と、プレート台座70上に配置され、プレート台座70に対して垂直に、ここでは鉛直方向に延在するアングルプレート72とによって構成されている。アングルプレート72のワークWを取り付ける側には、ワークWの四隅をクランプしてこれを固定するための複数、ここでは4つのクランパ74が配置されている。また、アングルプレート72には、クランプする前にワークWを安定して載置するためのワーク載置部76を有する。
Figures 6a and 6b show perspective views of the workpiece mounting table 16 in a state where the workpiece W is clamped by the clamper 74 (hereafter referred to as the clamped state) and in an unclamped state (hereafter referred to as the unclamped state), respectively. The workpiece mounting table 16 is composed of a plate base 70 and an angle plate 72 that is placed on the plate base 70 and extends perpendicular to the plate base 70, in this case in the vertical direction. On the side of the angle plate 72 where the workpiece W is attached, multiple clampers 74, here four, are arranged for clamping the four corners of the workpiece W to fix it in place. The angle plate 72 also has a workpiece mounting portion 76 for stably mounting the workpiece W before clamping.
クランパ74は、油空圧供給装置26から供給された油圧又は空気圧によって作動可能に構成された可動部材78を有する。可動部材78は、アングルプレート72に対して直交する方向、ここでは、水平方向に延在する円柱状の軸部材80と、軸部材80の端部に連結された直方体状の爪部材82とを有する。軸部材80は、その軸方向に沿ってスライド可能に構成されている。このため、ワークWの厚みに応じて、アングルプレート72の外側へ引き出したり、その内側へ引き戻したりすることができる。また、軸部材80は、その軸方向に沿った軸線回りに回動可能に構成されている。爪部材82は、一方の端部が軸部材80と連結されており、軸部材80の回動に合わせて回動可能に構成されている。軸部材80の回動によって、爪部材82がワークWの側へ向けて90度回動し、爪部材82の他方の端部がワーク載置部76に載置されたワークWに係合するように構成されている。また、アングルプレート72は、可動部材78との相対位置関係を確認するためにクランパ74の近傍に固定して形成された固定部材84を有する。
The clamper 74 has a movable member 78 that is operable by hydraulic pressure or air pressure supplied from the hydraulic/pneumatic supply device 26. The movable member 78 has a cylindrical shaft member 80 that extends in a direction perpendicular to the angle plate 72, in this case, horizontally, and a rectangular claw member 82 that is connected to the end of the shaft member 80. The shaft member 80 is configured to be slidable along its axial direction. Therefore, it can be pulled out to the outside of the angle plate 72 or pulled back to the inside depending on the thickness of the workpiece W. The shaft member 80 is also configured to be rotatable around an axis along its axial direction. One end of the claw member 82 is connected to the shaft member 80 and is configured to be rotatable in accordance with the rotation of the shaft member 80. When the shaft member 80 rotates, the claw member 82 rotates 90 degrees toward the workpiece W, and the other end of the claw member 82 is configured to engage with the workpiece W placed on the workpiece placement section 76. The angle plate 72 also has a fixed member 84 that is fixed near the clamper 74 to check the relative positional relationship with the movable member 78.
アングルプレート72は、また、その側部においてクランパ74に油空圧を供給するための油空圧供給装置26を接続するためのノズル連結部90を有する。ロボット制御装置31がロボットハンド42を作動して供給装置ボタン66dを押すことによって、ノズル連結部90と油空圧供給装置26とが接続又は接続解除するように構成されている。
The angle plate 72 also has a nozzle connection part 90 on its side for connecting the hydraulic and pneumatic pressure supply device 26 for supplying hydraulic and pneumatic pressure to the clamper 74. The robot control device 31 is configured to operate the robot hand 42 and press the supply device button 66d to connect or disconnect the nozzle connection part 90 and the hydraulic and pneumatic pressure supply device 26.
図7a及び図7bには、可動部材78の爪部材82に形成された第1の撮影部としての位置マーク86及び固定部材84に形成された第2の撮影部としての情報マーク88の拡大図を示す。爪部材82には、ロボット30のカメラ46によって撮影した画像を用いてクランパ74のクランプ状態(図7a)及びアンクランプ状態(図7b)を確認する際の基準位置とするための円形状の位置マーク86が形成されている。また、固定部材84にも、クランパ74のアンクランプ状態及びクランプ状態を確認する際の基準位置とするための矩形状の情報マーク88が形成されている。位置マーク86及び情報マーク88の表示面は、ロボット30のカメラ46によって同時に撮影ができるように表示面が同じ方向、ここではアングルプレート72からドア20の方向へ向けて表示されている。位置マーク86は、爪部材82及び固定部材84とは異なる色に着色されたプレート、又は、これらに螺入された異なる色のボルトとされている。なお、位置マーク86及び情報マーク88は、貼付け可能なシール、テープ等とされてもよい。位置マーク86には、回動可能に構成された爪部材82の向きを確認することができる文字、記号、マーク(図7a及び図7bでは「M」の文字)が表示される。なお、位置マークとしてQRコード(登録商標)を用いてもよい。また、情報マーク88には、QRコード(登録商標)が使用され、対応部品番号が記録されている。これによって、ロボット30は、可動部材78及び固定部材84をカメラ46で撮影し、クランパ74のアンクランプ状態及びクランプ状態を確認できると共に、ワーク取付台16の対応部品番号を確認することができる。なお、以下の説明では、位置マーク86は正面から見た場合に円形状に形成され、情報マーク88は正面から見た場合に矩形状に形成されているとして説明するが、これに限らず、位置マーク及び情報マークは、円形又は矩形以外の多角形状等他の形状とされてもよい。
7a and 7b show enlarged views of a position mark 86 as a first photographing portion formed on the claw member 82 of the movable member 78 and an information mark 88 as a second photographing portion formed on the fixed member 84. A circular position mark 86 is formed on the claw member 82 to serve as a reference position when checking the clamped state (FIG. 7a) and unclamped state (FIG. 7b) of the clamper 74 using images captured by the camera 46 of the robot 30. A rectangular information mark 88 is also formed on the fixed member 84 to serve as a reference position when checking the unclamped state and clamped state of the clamper 74. The display surfaces of the position mark 86 and the information mark 88 are displayed facing the same direction, here from the angle plate 72 toward the door 20, so that they can be photographed simultaneously by the camera 46 of the robot 30. The position mark 86 is a plate colored a different color from the claw member 82 and the fixed member 84, or a bolt of a different color screwed into them. The position mark 86 and the information mark 88 may be stickers, tapes, etc. that can be attached. The position mark 86 displays a letter, symbol, or mark (the letter "M" in Figs. 7a and 7b) that allows the orientation of the rotatably configured claw member 82 to be confirmed. A QR code (registered trademark) may be used as the position mark. The information mark 88 uses a QR code (registered trademark) and records a corresponding part number. This allows the robot 30 to photograph the movable member 78 and the fixed member 84 with the camera 46, confirm the unclamped and clamped states of the clamper 74, and confirm the corresponding part number of the work mounting table 16. In the following description, the position mark 86 is formed in a circular shape when viewed from the front, and the information mark 88 is formed in a rectangular shape when viewed from the front, but this is not limited to the above, and the position mark and the information mark may be formed in other shapes such as a polygonal shape other than a circle or a rectangle.
ロボット30は、クランパ74のアンクランプ状態及びクランプ状態の確認、すなわち状態の判断を、予めロボット制御装置31に記録した基準画像をカメラ46で撮影した画像と比較することによって行うように構成されている。具体的には、撮影した画像における位置マーク86と情報マーク88との相対位置関係を基準画像における相対位置関係と比較する。また、基準画像との比較は、可動部材78及び固定部材84の画像に基づいて行われる。比較のための基準位置、すなわち基準点としては、位置マーク86の第1の中心点86bと情報マーク88の各辺とを用いている。なお、位置マークが円形状でない場合は、第1の中心点86bに替えて別の基準点が設けられてもよい。また、例えば、情報マークの最上位又は最下位の頂点といったように別のロジックで識別された点が用いられてもよい。これらの基準点の相対位置関係としては、クランプ状態では、図7aに示すように、基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XC及び上下方向の間隔YC並びに位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの水平前後方向の間隔ZCを用いる。アンクランプ状態では、図7bに示すように、位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XU及び上下方向の間隔YU並びに位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの水平前後方向の間隔ZUを用いる。
The robot 30 is configured to check the unclamped and clamped states of the clamper 74, i.e., to judge the state, by comparing a reference image previously recorded in the robot control device 31 with an image captured by the camera 46. Specifically, the relative positional relationship between the position mark 86 and the information mark 88 in the captured image is compared with the relative positional relationship in the reference image. The comparison with the reference image is also performed based on the images of the movable member 78 and the fixed member 84. The first center point 86b of the position mark 86 and each side of the information mark 88 are used as the reference positions, i.e., the reference points, for comparison. If the position mark is not circular, another reference point may be provided in place of the first center point 86b. Also, a point identified by another logic, such as the topmost or bottommost vertex of the information mark, may be used. As the relative positional relationship of these reference points, in the clamped state, as shown in FIG. 7a, the horizontal lateral distance XC and the vertical distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image, and the horizontal front-back distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 are used. In the unclamped state, as shown in FIG. 7b, the horizontal lateral distance XU and the vertical distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88, and the horizontal front-back distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 are used.
図8には、油空圧供給装置26の回路図を示す。油空圧供給装置26は、油空圧を設定するための油空圧ユニットHPと、油空圧が設定圧力に到達すると開閉が切り替わるように構成された圧力スイッチPSと、を備える。また、油空圧ユニットHPとの間にはソレノイドバルブSN及び減圧弁RVが取り付けられており、油空圧供給装置26内の油空圧に応じて開閉するように構成されている。
FIG. 8 shows a circuit diagram of the oil/air pressure supply device 26. The oil/air pressure supply device 26 is equipped with an oil/air pressure unit HP for setting the oil/air pressure, and a pressure switch PS configured to switch between open and closed when the oil/air pressure reaches a set pressure. In addition, a solenoid valve SN and a pressure reducing valve RV are attached between the oil/air pressure unit HP and the oil/air pressure supply device 26, and are configured to open and close according to the oil/air pressure inside the oil/air pressure supply device 26.
油空圧供給装置26は、工作機械12側に配置されたカプラCPを介してアングルプレート72のノズル連結部90と接続されている。これによって、油空圧供給装置26からの油空圧をアングルプレート72のクランパ74に供給することができる。また、ノズル連結部90は、また、工作機械12に配置された油空圧ユニットHPともソレノイドバルブSN及び圧力スイッチPSを介して接続されている。このため、工作機械12側の油空圧ユニットHPからも油空圧をクランパ74に供給することができる。さらに、クランパ74とノズル連結部90との間には、クランパ74への圧力を補助的に供給するためのアキュムレータACが配置されている。
The hydraulic/pneumatic supply device 26 is connected to the nozzle connection 90 of the angle plate 72 via a coupler CP arranged on the machine tool 12 side. This allows hydraulic/pneumatic pressure from the hydraulic/pneumatic supply device 26 to be supplied to the clamper 74 of the angle plate 72. The nozzle connection 90 is also connected to the hydraulic/pneumatic unit HP arranged on the machine tool 12 via a solenoid valve SN and a pressure switch PS. This allows hydraulic/pneumatic pressure to be supplied to the clamper 74 from the hydraulic/pneumatic unit HP on the machine tool 12 side as well. Furthermore, an accumulator AC is arranged between the clamper 74 and the nozzle connection 90 to supply auxiliary pressure to the clamper 74.
図6a及び図6bに示すように、クランパ74の圧力をモニタするための圧力計92は、アングルプレート72の上面側に配置されている。図9a及び図9bに示すように、ここでは目安針94を有するアナログ式の圧力計92が用いられている。図9aに示すように、クランパ74に所定の圧力が供給されている場合には、目安針94は基準目盛SSよりも正面視で右側、図では約12時の方向を指している。また、図9bに示すように、クランパ74に圧力が十分に供給されておらず、所定の圧力以下の場合には、目安針94は基準目盛SSよりも正面視で左側、図では約8時の方向を指している。ロボット制御装置31は、カメラ46を作動して圧力計92を撮影し、目安針94と基準目盛SSとの位置関係からクランパ74に所定の圧力が供給されているか否かを判断するように構成されている。なお、ここでは、圧力計92はアナログ式であるとして説明したが、これに限らず、例えば、圧力計はデジタル式であってもよく、カメラによって撮影したデジタル表示の圧力値の画像から所定の圧力が供給されているか否かを判断するように構成されてもよい。
As shown in Figures 6a and 6b, a pressure gauge 92 for monitoring the pressure of the clamper 74 is disposed on the upper surface side of the angle plate 72. As shown in Figures 9a and 9b, an analog pressure gauge 92 having a guide needle 94 is used here. As shown in Figure 9a, when a predetermined pressure is supplied to the clamper 74, the guide needle 94 points to the right of the reference scale SS when viewed from the front, at about 12 o'clock in the figure. Also, as shown in Figure 9b, when pressure is not sufficiently supplied to the clamper 74 and is below a predetermined pressure, the guide needle 94 points to the left of the reference scale SS when viewed from the front, at about 8 o'clock in the figure. The robot control device 31 is configured to operate the camera 46 to photograph the pressure gauge 92 and determine whether a predetermined pressure is being supplied to the clamper 74 from the positional relationship between the guide needle 94 and the reference scale SS. Note that, although the pressure gauge 92 has been described here as being analog, this is not limiting, and the pressure gauge may be digital, for example, and may be configured to determine whether a predetermined pressure is being supplied from an image of the digitally displayed pressure value captured by a camera.
図10に示すフローチャートを用いたワークWの着脱手順の説明を通じて、本実施形態に係るワーク着脱システム10の作用効果を説明する。
The effect of the workpiece mounting/removal system 10 according to this embodiment will be explained through an explanation of the procedure for mounting/removing the workpiece W using the flowchart shown in FIG. 10.
(ロボット30及び無人搬送車32の位置決め)
図10に示すように、ステップS001において、上位制御システム48は、無人搬送車32をステーション14の前の基準位置まで移動させる。ステップS002において、カメラ46でステーション14を撮影し、ロボット制御装置31に予め保存されている無人搬送車32が基準位置で停止した場合の基準画像データと比較して、基準位置からのずれが生じている場合には、ずれた距離を確認する(図10中A)。ここで、無人搬送車32の基準位置からずれた距離が閾値以上の場合(図10中A1)は、ステップS003へ移行し、ずれた距離が小さくするように無人搬送車32を移動させ、カメラ46でステーション14を撮影し、基準画像データと比較する。この結果、無人搬送車32の基準位置からずれた距離が閾値未満になった場合(図10中A2)には、ステップS004へ移行し、さらにずれが小さくなるようにロボットハンド42の位置を修正した上でステップS005へ移行する。 (Positioning of therobot 30 and the automated guided vehicle 32)
As shown in Fig. 10, in step S001, theupper control system 48 moves the automatic guided vehicle 32 to a reference position in front of the station 14. In step S002, the camera 46 photographs the station 14, and compares it with reference image data when the automatic guided vehicle 32 stops at the reference position, which is stored in advance in the robot control device 31, and if there is a deviation from the reference position, the distance of the deviation is confirmed (A in Fig. 10). Here, if the distance of the automatic guided vehicle 32 from the reference position is equal to or greater than a threshold (A1 in Fig. 10), the process proceeds to step S003, where the automatic guided vehicle 32 is moved so as to reduce the distance of the deviation, the camera 46 photographs the station 14, and the image is compared with the reference image data. As a result, if the distance of the automatic guided vehicle 32 from the reference position becomes less than the threshold (A2 in Fig. 10), the process proceeds to step S004, where the position of the robot hand 42 is corrected so as to further reduce the deviation, and then the process proceeds to step S005.
図10に示すように、ステップS001において、上位制御システム48は、無人搬送車32をステーション14の前の基準位置まで移動させる。ステップS002において、カメラ46でステーション14を撮影し、ロボット制御装置31に予め保存されている無人搬送車32が基準位置で停止した場合の基準画像データと比較して、基準位置からのずれが生じている場合には、ずれた距離を確認する(図10中A)。ここで、無人搬送車32の基準位置からずれた距離が閾値以上の場合(図10中A1)は、ステップS003へ移行し、ずれた距離が小さくするように無人搬送車32を移動させ、カメラ46でステーション14を撮影し、基準画像データと比較する。この結果、無人搬送車32の基準位置からずれた距離が閾値未満になった場合(図10中A2)には、ステップS004へ移行し、さらにずれが小さくなるようにロボットハンド42の位置を修正した上でステップS005へ移行する。 (Positioning of the
As shown in Fig. 10, in step S001, the
つぎに、ステップS005において、カメラ46でワーク置き台24の置き台位置マーク50及び置き台情報マーク52を撮影し、ロボット制御装置31に予め保存されている無人搬送車32がワーク置き台24に対して基準位置にある場合の基準画像データと比較して、基準位置からのずれがある場合には、ずれた距離を確認する(図10中B)。また、ワーク置き台24に積載する部品番号をロボット制御装置31に記録する。さらに、ロボット制御装置31は、カメラ46で撮影したワーク置き台24の画像に基づき、ワーク置き台24上にワークWが積載されているか否かを確認する。ワークWのワーク置き台24上にワークWが積載されている場合には、積載する部品のワーク空き番号をロボット制御装置31に記録する。ここで、ワーク置き台24に対してずれた距離が閾値以上、又は、例えば、ワーク置き台24が設置されていない等の理由により比較できない場合(図10中B1)には、ステップS006へ移行し、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる。また、ワーク置き台24に対してずれた距離が閾値未満の場合(図10中B2)には、ステップS007において、ロボット制御装置31は、さらにずれが小さくなるようにロボットハンド42の位置を修正した上で位置決めを完了し、ステップS008へ移行する。
Next, in step S005, the camera 46 photographs the workpiece placement stage 24's placement stage position mark 50 and placement stage information mark 52, and compares this with reference image data stored in advance in the robot control device 31 when the automated guided vehicle 32 is in a reference position relative to the workpiece placement stage 24, and if there is any deviation from the reference position, the distance of deviation is confirmed (B in Figure 10). Also, the robot control device 31 records the part number to be loaded on the workpiece placement stage 24. Furthermore, the robot control device 31 confirms whether or not a workpiece W is loaded on the workpiece placement stage 24 based on the image of the workpiece placement stage 24 photographed by the camera 46. If a workpiece W is loaded on the workpiece placement stage 24 of the workpiece W, the vacant workpiece number of the part to be loaded is recorded in the robot control device 31. If the deviation from the workpiece placement table 24 is equal to or greater than the threshold value, or if the comparison is not possible because the workpiece placement table 24 is not installed (B1 in FIG. 10), the process proceeds to step S006, and the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has output the alarm moves the automated guided vehicle 32 to another station 15. If the deviation from the workpiece placement table 24 is less than the threshold value (B2 in FIG. 10), in step S007, the robot control device 31 corrects the position of the robot hand 42 to further reduce the deviation, completes positioning, and proceeds to step S008.
(ステーション14のドア20の開放)
ステップS008において、カメラ46でステーション14のドア20を撮影し、ロボット制御装置31に予め保存されているドア20の開放時及び閉鎖時における基準画像データと比較し、ドア20の状態を確認する(図10中C)。ここで、ドア20の閉鎖時におけるドア20の基準画像とずれがある場合において、ずれた距離が閾値未満の場合には、ドア20が閉鎖されていると判断してステップS009へ移行する(図10中C1)。ステップS009において、ロボット制御装置31は、ロボットハンド42を作動してロック操作ボタン66aを押す。これによってドアロックを解除し、ステップS010へ移行する。また、ステップS008において、ドア20の状態が、ドア20の開放時及び閉鎖時におけるドア20の基準画像からずれた距離がいずれも閾値以上である場合、すなわち、開放時と閉鎖時の中間位置にある場合(図10中C2)にも、ステップS010へ移行する。 (Opening ofdoor 20 of station 14)
In step S008, thedoor 20 of the station 14 is photographed by the camera 46, and compared with the reference image data of the door 20 when it is open and when it is closed, which are stored in advance in the robot control device 31, to confirm the state of the door 20 (C in FIG. 10). If there is a deviation between the reference image of the door 20 when it is closed and the deviation distance is less than a threshold, it is determined that the door 20 is closed, and the process proceeds to step S009 (C1 in FIG. 10). In step S009, the robot control device 31 operates the robot hand 42 to press the lock operation button 66a. This releases the door lock, and the process proceeds to step S010. In step S008, if the deviation distance from the reference image of the door 20 when it is open and when it is closed is equal to or greater than a threshold, that is, if it is in an intermediate position between the open state and the closed state (C2 in FIG. 10), the process also proceeds to step S010.
ステップS008において、カメラ46でステーション14のドア20を撮影し、ロボット制御装置31に予め保存されているドア20の開放時及び閉鎖時における基準画像データと比較し、ドア20の状態を確認する(図10中C)。ここで、ドア20の閉鎖時におけるドア20の基準画像とずれがある場合において、ずれた距離が閾値未満の場合には、ドア20が閉鎖されていると判断してステップS009へ移行する(図10中C1)。ステップS009において、ロボット制御装置31は、ロボットハンド42を作動してロック操作ボタン66aを押す。これによってドアロックを解除し、ステップS010へ移行する。また、ステップS008において、ドア20の状態が、ドア20の開放時及び閉鎖時におけるドア20の基準画像からずれた距離がいずれも閾値以上である場合、すなわち、開放時と閉鎖時の中間位置にある場合(図10中C2)にも、ステップS010へ移行する。 (Opening of
In step S008, the
ステップS010において、ロボット制御装置31は、ロボットハンド42を作動してドア20を開放する。具体的には、ロボットハンド42は、ドア20に取り付けられたドアハンドル20aの少し左側(ドア20を閉鎖する側)の位置からドアハンドル20aに接触しながら右側(ドア20を開放する側)へ移動し、ドア20をスライドすることによってこれを開放する。ドア20を開放すると、ステップS011へ移行し、カメラ46によってドア20を撮影し、ドア20の開放時の基準画像データと比較して、ドア20が開放されているか否かを確認する(図10中D)。ここで、ドア20の開放時における基準位置に対してドア20のずれた距離が閾値以上である場合には、ステップS012へ移行し、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる(図10中D1)。
In step S010, the robot control device 31 operates the robot hand 42 to open the door 20. Specifically, the robot hand 42 moves from a position slightly to the left of the door handle 20a attached to the door 20 (the side that closes the door 20) to the right (the side that opens the door 20) while contacting the door handle 20a, and opens the door 20 by sliding it. When the door 20 is opened, the process proceeds to step S011, where the camera 46 takes an image of the door 20 and compares it with the reference image data when the door 20 is open to confirm whether the door 20 is open or not (D in FIG. 10). Here, if the distance by which the door 20 has shifted from the reference position when the door 20 is open is equal to or greater than the threshold value, the process proceeds to step S012, where the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has output the alarm moves the automatic guided vehicle 32 to another station 15 (D1 in FIG. 10).
ステップS008において、ドア20の開放時における基準位置に対してドア20のずれた距離が閾値未満の場合(図10中C3)、又は、ステップS011において、ドア20が開放されていることを確認した場合(図10中D2)には、ステップS013へ移行する。
If, in step S008, the distance by which the door 20 has shifted from the reference position when the door 20 is open is less than the threshold value (C3 in FIG. 10), or if, in step S011, it is confirmed that the door 20 is open (D2 in FIG. 10), the process proceeds to step S013.
(加工済みのワークWの取り外し)
ステップS013において、ロボット制御装置31は、ロボットハンド42を作動して供給装置ボタン66dを押す。これによってステーション15内のアングルプレート72のノズル連結部90と油空圧供給装置26とを接続させる。また、ロボット制御装置31は、カメラ46を作動してアングルプレート72における固定部材84の情報マーク88を撮影し、ロボット制御装置31に予め保存されている固定部材84の基準画像データと比較して、基準位置からずれた距離を確認する。ずれた距離が所定の閾値よりも大きい場合には、上位制御システム48は、ロボットハンド42を作動し、ロボットハンド42の位置を修正する。さらに、カメラ46によって、固定部材84に表示されている対応部品番号を撮影し、ロボット制御装置31に記録する。これを予めロボット制御装置31に記録したワーク置き台24の対応部品番号と一致するか否かを確認する(図10中E)。ここで、固定部材84に表示されている対応部品番号とワーク置き台24の対応部品番号とが一致しない場合(図10中E1)は、ステップS014へ移行し、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる。 (Removal of the machined workpiece W)
In step S013, therobot control device 31 operates the robot hand 42 to press the supply device button 66d. This connects the nozzle connection part 90 of the angle plate 72 in the station 15 to the hydraulic/pneumatic supply device 26. The robot control device 31 also operates the camera 46 to take an image of the information mark 88 of the fixed member 84 on the angle plate 72, and compares it with reference image data of the fixed member 84 previously stored in the robot control device 31 to confirm the distance displaced from the reference position. If the displaced distance is greater than a predetermined threshold, the upper control system 48 operates the robot hand 42 to correct the position of the robot hand 42. Furthermore, the camera 46 takes an image of the corresponding part number displayed on the fixed member 84 and records it in the robot control device 31. It is confirmed whether this matches the corresponding part number of the workpiece placement table 24 previously recorded in the robot control device 31 (E in FIG. 10). If the corresponding part number displayed on the fixed member 84 does not match the corresponding part number on the workpiece placement table 24 (E1 in FIG. 10), the process proceeds to step S014, and the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has received the alarm moves the automatic guided vehicle 32 to another station 15.
ステップS013において、ロボット制御装置31は、ロボットハンド42を作動して供給装置ボタン66dを押す。これによってステーション15内のアングルプレート72のノズル連結部90と油空圧供給装置26とを接続させる。また、ロボット制御装置31は、カメラ46を作動してアングルプレート72における固定部材84の情報マーク88を撮影し、ロボット制御装置31に予め保存されている固定部材84の基準画像データと比較して、基準位置からずれた距離を確認する。ずれた距離が所定の閾値よりも大きい場合には、上位制御システム48は、ロボットハンド42を作動し、ロボットハンド42の位置を修正する。さらに、カメラ46によって、固定部材84に表示されている対応部品番号を撮影し、ロボット制御装置31に記録する。これを予めロボット制御装置31に記録したワーク置き台24の対応部品番号と一致するか否かを確認する(図10中E)。ここで、固定部材84に表示されている対応部品番号とワーク置き台24の対応部品番号とが一致しない場合(図10中E1)は、ステップS014へ移行し、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる。 (Removal of the machined workpiece W)
In step S013, the
一方、固定部材84に表示されている対応部品番号とワーク置き台24の対応部品番号とが一致する場合(図10中E2)は、ステップS015へ移行する。ステップS015において、アングルプレート72に加工済みのワークWが固定されている場合には、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82のワークWへの係合が解除されるため、クランパ74がアンクランプ状態となる。
On the other hand, if the corresponding part number displayed on the fixing member 84 matches the corresponding part number on the workpiece placement table 24 (E2 in FIG. 10), the process proceeds to step S015. In step S015, if a machined workpiece W is fixed to the angle plate 72, the robot control device 31 operates the robot hand 42 to press the workpiece clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, disengaging the claw member 82 from the workpiece W, and the clamper 74 enters an unclamped state.
さらに、ステップS016へ移行し、正常にアンクランプ状態になったか否かを確認するために、ロボット制御装置31は、カメラ46を作動してアングルプレート72の固定部材84の情報マーク88と爪部材82の位置マーク86とを同時に撮影する。ここでは、鉛直方向上方側及び水平方向前方側の2方向からの撮影による、情報マーク88及び位置マーク86の平面図と正面図といった2方向の画像を取得する。なお、カメラ46として、3Dカメラやステレオカメラを使用する場合は、例えば、1回の撮影で取得された画像を正面方向からの画像と奥行き方向からの画像といった2方向の画像に分解して使用されてもよい。撮影するとステップS017へ移行し、ロボット制御装置31に予め保存されているアンクランプ状態の基準画像における位置マーク86と情報マーク88との相対位置関係と撮影した画像における位置マーク86と情報マーク88との相対位置関係とを比較する(図10中F)。具体的には、アンクランプ状態の基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XU及び上下方向の間隔YU並びに位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの水平前後方向の間隔ZU(いずれも図7b参照)と撮影した画像における間隔とを比較し、基準となる間隔との差異、すなわち間隔差を確認する。ここで、水平横方向の間隔XU、上下方向の間隔YU及び水平前後方向の間隔ZUとの間隔差の少なくとも1つが閾値以上の場合(図10中F1)は、ステップS018へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82がワークWに係合するため、クランパ74がクランプ状態となる。さらに、ステップS019へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82のワークWへの係合が解除されるため、クランパ74が再度アンクランプ状態となる。
Then, the process proceeds to step S016, where the robot control device 31 simultaneously photographs the information mark 88 of the fixing member 84 of the angle plate 72 and the position mark 86 of the claw member 82 to check whether the unclamped state has been reached normally. Here, two-way images, a plan view and a front view of the information mark 88 and the position mark 86, are obtained by photographing from two directions, the vertical upper side and the horizontal front side. Note that when a 3D camera or a stereo camera is used as the camera 46, the image obtained in one photographing may be decomposed into two-way images, for example, an image from the front and an image from the depth direction, and used. After photographing, the process proceeds to step S017, where the relative positional relationship between the position mark 86 and the information mark 88 in the reference image of the unclamped state stored in advance in the robot control device 31 is compared with the relative positional relationship between the position mark 86 and the information mark 88 in the photographed image (F in FIG. 10). Specifically, the horizontal lateral distance XU and the vertical distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image in the unclamped state, and the horizontal front-rear distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 (see FIG. 7b for all) are compared with the distances in the captured image, and the difference from the reference distance, i.e., the distance difference, is confirmed. Here, if at least one of the distance differences between the horizontal lateral distance XU, the vertical distance YU, and the horizontal front-rear distance ZU is equal to or greater than the threshold (F1 in FIG. 10), the process proceeds to step S018, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. As a result, the movable member 78 of the clamper 74 rotates, and the claw member 82 engages with the work W, so that the clamper 74 is in the clamped state. Furthermore, the process proceeds to step S019, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and disengage the claw member 82 from the workpiece W, causing the clamper 74 to return to the unclamped state.
再度アンクランプ状態になると、ステップS020へ移行し、ロボット制御装置31は、再度カメラ46を作動して鉛直方向上方側及び水平方向前方側からアングルプレート72の固定部材84の情報マーク88と爪部材82の位置マーク86とを同時に撮影する。つぎに、ステップS021へ移行し、基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XU及び上下方向の間隔YU並びに位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの水平前後方向の間隔ZUと撮影した画像とを比較し、間隔差を確認する(図10中G)。ここで、水平横方向の間隔XU、上下方向の間隔YU及び水平前後方向の間隔ZUとの間隔差の少なくとも1つが閾値以上の場合(図10中G1)は、ステップS022へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによってクランパ74の可動部材78が回動してワークWをクランプする。さらに、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる。
When the unclamped state is resumed, the process proceeds to step S020, and the robot control device 31 again operates the camera 46 to simultaneously photograph the information mark 88 of the fixed member 84 of the angle plate 72 and the position mark 86 of the claw member 82 from the vertically upward side and the horizontally forward side. Next, the process proceeds to step S021, and the horizontal lateral distance XU and the vertical distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image, as well as the horizontal front-back distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88, are compared with the photographed image to confirm the distance difference (G in FIG. 10). Here, if at least one of the distance differences between the horizontal lateral distance XU, the vertical distance YU, and the horizontal front-back distance ZU is equal to or greater than the threshold value (G1 in FIG. 10), the process proceeds to step S022, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and clamp the workpiece W. Furthermore, the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has received the alarm output moves the automated guided vehicle 32 to another station 15.
一方、水平横方向の間隔XU、上下方向の間隔YU及び水平前後方向の間隔ZUとの間隔差の全てが閾値未満の場合(図10中F2及びG2)は、ステップS023へ移行し、ロボット制御装置31は、ワークWは適切にアンクランプされたものと判断してステップS024へ移行する。ステップS024において、ロボット30はロボットハンド42を作動してアンクランプされたワークWを把持し、無人搬送車32によってワーク置き台24へと移動し、これにワークWを収納する。
On the other hand, if the horizontal lateral spacing XU, the vertical spacing YU, and the horizontal front-rear spacing ZU are all less than the threshold (F2 and G2 in FIG. 10), the process proceeds to step S023, and the robot control device 31 determines that the workpiece W has been properly unclamped, and proceeds to step S024. In step S024, the robot 30 operates the robot hand 42 to grasp the unclamped workpiece W, and moves to the workpiece placement table 24 by the automated guided vehicle 32, where the workpiece W is stored.
(未加工のワークWの取り付け)
ロボット30は、加工済みのワークWを取り外して片づけると、次の加工のために未加工のワークWの取り付けを開始する。ステップS025へ移行し、ロボット制御装置31はカメラ46を作動して材料置き台22の置き台位置マーク50及び置き台情報マーク52を撮影し、ロボット制御装置31に予め保存されている無人搬送車32が材料置き台22に対して基準位置にある場合の基準画像データと比較して、基準位置からのずれがある場合には、ずれた距離を確認する。ずれた距離が閾値以上ある場合には、ロボット制御装置31は、ロボットハンド42を作動し、その位置を修正する。さらに、ロボット制御装置31に対応部品番号を記録すると共に、これらの対応部品番号が固定部材84に表示されている対応部品番号と一致するか否かを確認する(図10中H)。ここで、固定部材84に表示されている対応部品番号と材料置き台22の対応部品番号とが一致しない場合(図10中H1)には、ステップS026へ移行し、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる。 (Installation of unprocessed workpiece W)
After removing and putting away the machined workpiece W, therobot 30 starts mounting an unmachined workpiece W for the next machining. In step S025, the robot control device 31 operates the camera 46 to take an image of the placement table position mark 50 and placement table information mark 52 on the material placement table 22, and compares the image with reference image data when the unmanned transport vehicle 32 is in a reference position relative to the material placement table 22, which is stored in advance in the robot control device 31, and checks the distance of deviation from the reference position if there is any deviation. If the distance of deviation is equal to or greater than a threshold, the robot control device 31 operates the robot hand 42 to correct its position. Furthermore, the robot control device 31 records the corresponding part numbers in the robot control device 31, and checks whether these corresponding part numbers match the corresponding part numbers displayed on the fixed member 84 (H in FIG. 10). If the corresponding part numbers displayed on the fixed member 84 do not match the corresponding part numbers on the material placement table 22 (H1 in FIG. 10), the robot control device 31 moves to step S026 and outputs an alarm to the upper control system 48. The host control system 48 which has received the alarm output moves the automated guided vehicle 32 to another station 15 .
ロボット30は、加工済みのワークWを取り外して片づけると、次の加工のために未加工のワークWの取り付けを開始する。ステップS025へ移行し、ロボット制御装置31はカメラ46を作動して材料置き台22の置き台位置マーク50及び置き台情報マーク52を撮影し、ロボット制御装置31に予め保存されている無人搬送車32が材料置き台22に対して基準位置にある場合の基準画像データと比較して、基準位置からのずれがある場合には、ずれた距離を確認する。ずれた距離が閾値以上ある場合には、ロボット制御装置31は、ロボットハンド42を作動し、その位置を修正する。さらに、ロボット制御装置31に対応部品番号を記録すると共に、これらの対応部品番号が固定部材84に表示されている対応部品番号と一致するか否かを確認する(図10中H)。ここで、固定部材84に表示されている対応部品番号と材料置き台22の対応部品番号とが一致しない場合(図10中H1)には、ステップS026へ移行し、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる。 (Installation of unprocessed workpiece W)
After removing and putting away the machined workpiece W, the
(未加工のワークWのクランプ)
固定部材84に表示されている対応部品番号と材料置き台22の対応部品番号とが一致する場合は、ステップS027へ移行し、ロボット制御装置31はロボットハンド42を作動させて、材料置き台22上の未加工のワークWを把持し、アングルプレート72のワーク載置部76にワークWを載置する。つぎに、ステップS028へ移行し、ロボット制御装置31はロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82がワークWに係合するため、クランパ74がクランプ状態となる。 (Clamping of unmachined workpiece W)
If the corresponding part number displayed on the fixedmember 84 matches the corresponding part number on the material placement table 22, the process proceeds to step S027, where the robot control device 31 actuates the robot hand 42 to grip the unmachined workpiece W on the material placement table 22 and place the workpiece W on the workpiece placement portion 76 of the angle plate 72. Next, the process proceeds to step S028, where the robot control device 31 actuates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and the claw members 82 to engage with the workpiece W, so that the clamper 74 enters a clamped state.
固定部材84に表示されている対応部品番号と材料置き台22の対応部品番号とが一致する場合は、ステップS027へ移行し、ロボット制御装置31はロボットハンド42を作動させて、材料置き台22上の未加工のワークWを把持し、アングルプレート72のワーク載置部76にワークWを載置する。つぎに、ステップS028へ移行し、ロボット制御装置31はロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82がワークWに係合するため、クランパ74がクランプ状態となる。 (Clamping of unmachined workpiece W)
If the corresponding part number displayed on the fixed
さらに、ステップS029へ移行し、正常にクランプ状態になったか否かを確認するために、ロボット制御装置31はカメラ46を作動してアングルプレート72の固定部材84の情報マーク88と爪部材82の位置マーク86とを同時に撮影する。ここでの撮影は、撮影した画像がこれらの平面図になる鉛直方向上方側からの撮影と撮影した画像がこれらの正面図になる水平方向前方側からの撮影の2方向からの撮影を行う。撮影すると、ロボット制御装置31は、上位制御システム48に予め保存されているクランプ状態の基準画像における位置マーク86と情報マーク88との相対位置関係と撮影した画像における位置マーク86と情報マーク88との相対位置関係とを比較する(図10中J1)。具体的には、クランプ状態の基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XC及び上下方向の間隔YC並びに位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの水平前後方向の間隔ZC(いずれも図7a参照)と撮影した画像とを比較し、基準となる間隔との差異、すなわち間隔差を確認する。
Then, proceeding to step S029, in order to check whether the clamped state has been reached normally, the robot control device 31 operates the camera 46 to simultaneously photograph the information mark 88 of the fixing member 84 of the angle plate 72 and the position mark 86 of the claw member 82. The photographs are taken from two directions: from above in the vertical direction so that the photographed image is a plan view of these, and from the front in the horizontal direction so that the photographed image is a front view of these. After photographing, the robot control device 31 compares the relative positional relationship between the position mark 86 and the information mark 88 in a reference image of the clamped state that has been stored in advance in the upper control system 48 with the relative positional relationship between the position mark 86 and the information mark 88 in the photographed image (J1 in Figure 10). Specifically, the horizontal lateral distance XC and vertical distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image in the clamped state, as well as the horizontal front-to-back distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 (all see FIG. 7a) are compared with the captured image to check the difference from the reference distance, i.e., the distance difference.
ここで、水平横方向の間隔XC、上下方向の間隔YC及び水平前後方向の間隔ZCとの間隔差の少なくとも1つが閾値以上の場合には、ステップS030へ移行し、ロボット制御装置31は、間隔差が閾値以上のクランパ74の位置を記録する。つぎに、ステップS031へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82のワークWへの係合が解除されるため、クランパ74がアンクランプ状態となる。さらに、ステップS032へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワークWを把持し、材料置き台22上の仮置台23へ一旦移動させる。つぎに、ステップS033へ移行して、ロボット制御装置31は、ロボットハンド42を作動してエアノズル68をステーション14の格納位置から引き出し、クランパ74及びワークWの取り付け位置及びこれらの周辺を清掃する。これによって、クランパ74がごみ等を挟み込むことによって適切にクランプ状態にならない場合は、これを解消することができる。さらに、ステップS034へ移行し、ロボット制御装置31は、ロボットハンド42を作動して仮置台23上のワークWを把持し、ワーク載置部76に載置する。続いて、ステップS035へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによってクランパ74の可動部材78が回動して爪部材82がワークWに係合するため、クランパ74がクランプ状態となる。
Here, if at least one of the differences in the horizontal lateral distance XC, the vertical distance YC, and the horizontal front-rear distance ZC is equal to or greater than the threshold value, the process proceeds to step S030, and the robot control device 31 records the position of the clamper 74 where the difference in the distance is equal to or greater than the threshold value. Next, the process proceeds to step S031, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, and the engagement of the claw member 82 with the work W is released, so that the clamper 74 is in an unclamped state. Furthermore, the process proceeds to step S032, and the robot control device 31 operates the robot hand 42 to grasp the work W and temporarily move it to the temporary placement table 23 on the material placement table 22. Next, the process proceeds to step S033, and the robot control device 31 operates the robot hand 42 to pull out the air nozzle 68 from the storage position of the station 14, and cleans the clamper 74 and the attachment position of the work W and the surrounding areas thereof. This can eliminate any problem in the clamper 74 that would prevent it from being properly clamped due to dirt or the like being caught in it. Then, the process moves to step S034, where the robot control device 31 operates the robot hand 42 to grasp the workpiece W on the temporary placement table 23 and place it on the workpiece placement section 76. Next, the process moves to step S035, where the robot control device 31 operates the robot hand 42 to press the workpiece clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate and the claw members 82 to engage with the workpiece W, so that the clamper 74 is in a clamped state.
ワークWがクランパ74によってクランプされると、ステップS036へ移行し、正常にクランプ状態になったか否かを確認するために、カメラ46によってアングルプレート72の固定部材84の情報マーク88と爪部材82の位置マーク86とを同時に撮影する。ここでの撮影は、撮影した画像がこれらの平面図になる鉛直方向上方側からの撮影と撮影した画像がこれらの正面図になる水平方向前方側からの撮影の2方向からの撮影を行う。撮影すると、ロボット制御装置31に予め保存されているクランプ状態の基準画像における位置マーク86と情報マーク88との相対位置関係と撮影した画像における位置マーク86と情報マーク88との相対位置関係とを比較する(図10中K)。具体的には、クランプ状態の基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XC及び上下方向の間隔YC並びに位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの水平前後方向の間隔ZC(いずれも図7a参照)と撮影した画像とを比較し、間隔差を確認する。
When the workpiece W is clamped by the clamper 74, the process proceeds to step S036, where the camera 46 simultaneously photographs the information mark 88 of the fixed member 84 of the angle plate 72 and the position mark 86 of the claw member 82 to check whether the workpiece has been clamped normally. The photographs are taken from two directions: from above in the vertical direction so that the photographed image is a plan view of these, and from the front in the horizontal direction so that the photographed image is a front view of these. Once the photographs have been taken, the relative positional relationship between the position mark 86 and the information mark 88 in a reference image of the clamped state that is pre-stored in the robot control device 31 is compared with the relative positional relationship between the position mark 86 and the information mark 88 in the photographed image (K in Figure 10). Specifically, the horizontal lateral distance XC and vertical distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image in the clamped state, as well as the horizontal front-to-back distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 (all see FIG. 7a) are compared with the captured image to confirm the distance difference.
ここで、水平横方向の間隔XC、上下方向の間隔YC及び水平前後方向の間隔ZCとの間隔差の少なくとも1つが閾値以上の場合には、ステップS037へ移行し、ロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82のワークWへの係合が解除されるため、クランパ74がアンクランプ状態となる。さらに、ロボット制御装置31は、ロボットハンド42を作動してアンクランプ状態のワークWを挟持し、ワークWを材料置き台22の仮置台23上へ戻す。ワークWを仮置台23上へ載置すると、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる(図10中K1)。
Here, if at least one of the differences in the horizontal lateral distance XC, the vertical distance YC, and the horizontal front-rear distance ZC is equal to or greater than the threshold value, the process proceeds to step S037, where the robot hand 42 is operated to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, and the claw member 82 to disengage from the work W, causing the clamper 74 to enter an unclamped state. Furthermore, the robot control device 31 operates the robot hand 42 to clamp the unclamped work W and return the work W to the temporary placement table 23 of the material placement table 22. When the work W is placed on the temporary placement table 23, the robot control device 31 outputs an alarm to the upper control system 48. The upper control system 48 that has output the alarm moves the automated guided vehicle 32 to another station 15 (K1 in FIG. 10).
水平横方向の間隔XC、上下方向の間隔YC及び水平前後方向の間隔ZCとの間隔差の全てが閾値未満の場合(図10中J2/K2)には、ステップS038へ移行し、ロボット制御装置31は、カメラ46を作動して圧力計92を撮影し、撮影した画像に基づき、クランパ74に閾値以上の圧力が供給されているか否かを判断する(図10中L)。圧力が閾値未満の場合は、ステップS039へ移行し、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによって、クランパ74の可動部材78が回動して爪部材82のワークWへの係合が解除されるため、クランパ74がアンクランプ状態となる。さらに、ロボット制御装置31は、ロボットハンド42を作動してワークWを挟持し、材料置き台22上の仮置台23へ移動させる。ワークWを仮置台23上に載置すると、ロボット制御装置31は、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる(図10中L1)。
If the horizontal lateral spacing XC, the vertical spacing YC, and the horizontal front-rear spacing ZC are all less than the threshold (J2/K2 in FIG. 10), the process proceeds to step S038, and the robot control device 31 operates the camera 46 to photograph the pressure gauge 92, and determines whether or not a pressure equal to or greater than the threshold is being supplied to the clamper 74 based on the photographed image (L in FIG. 10). If the pressure is less than the threshold, the process proceeds to step S039, and the robot control device 31 operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, and the engagement of the claw member 82 with the work W is released, so that the clamper 74 is in an unclamped state. Furthermore, the robot control device 31 operates the robot hand 42 to clamp the work W and move it to the temporary placement table 23 on the material placement table 22. When the work W is placed on the temporary placement table 23, the robot control device 31 outputs an alarm to the upper control system 48. The host control system 48 that received the alarm output moves the automated guided vehicle 32 to another station 15 (L1 in Figure 10).
ステップS038において、ロボット制御装置31が、クランパ74に閾値以上の圧力が供給されていると判断した場合は、ステップS040へ移行し、ロボット制御装置31は、ロボットハンド42を作動して供給装置ボタン66dを押すことによってアングルプレート72のノズル連結部90と油空圧供給装置26との接続を解除する。油空圧供給装置26が接続解除されると、ロボット制御装置31は、カメラ46を作動して圧力計92を撮影し、撮影した画像に基づき、油空圧供給装置26が接続解除された後もクランパ74に閾値以上の圧力が供給されているか否かを判断する(図10中M)。
If in step S038 the robot control device 31 determines that a pressure equal to or greater than the threshold is being supplied to the clamper 74, the process proceeds to step S040, where the robot control device 31 operates the robot hand 42 to press the supply device button 66d to disconnect the nozzle connection part 90 of the angle plate 72 from the hydraulic and pneumatic supply device 26. When the hydraulic and pneumatic supply device 26 is disconnected, the robot control device 31 operates the camera 46 to photograph the pressure gauge 92, and determines based on the photographed image whether or not a pressure equal to or greater than the threshold is being supplied to the clamper 74 even after the hydraulic and pneumatic supply device 26 has been disconnected (M in FIG. 10).
圧力が閾値未満の場合は、ステップS041へ移行し、ロボット制御装置31は、ロボットハンド42を作動して供給装置ボタン66dを押してアングルプレート72のノズル連結部90と油空圧供給装置26とを再度接続する。また、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押す。これによってクランパ74の可動部材78が回動して爪部材82のワークWへの係合が解除されるため、クランパ74がアンクランプ状態となる。さらに、ロボット制御装置31は、ロボットハンド42を作動してアンクランプ状態のワークWを挟持し、材料置き台22上の仮置台23へ移動する。ロボット制御装置31は、ワークWを仮置台23上へ載置すると、上位制御システム48へアラームを出力する。アラーム出力のあった上位制御システム48は、無人搬送車32を他のステーション15へ移動させる(図10中M1)。
If the pressure is less than the threshold, the process proceeds to step S041, where the robot control device 31 operates the robot hand 42 to press the supply device button 66d to reconnect the nozzle connection part 90 of the angle plate 72 to the hydraulic/pneumatic supply device 26. The robot control device 31 also operates the robot hand 42 to press the work clamp button 66b. This causes the movable member 78 of the clamper 74 to rotate, and the claw member 82 to disengage from the work W, so that the clamper 74 enters an unclamped state. The robot control device 31 also operates the robot hand 42 to clamp the unclamped work W and move it to the temporary placement table 23 on the material placement table 22. When the robot control device 31 places the work W on the temporary placement table 23, it outputs an alarm to the upper control system 48. The upper control system 48 that has output the alarm moves the automated guided vehicle 32 to another station 15 (M1 in FIG. 10).
圧力が閾値以上の場合は、ステップS042へ移行し、ロボット制御装置31は、ロボットハンド42を作動してドア20を閉鎖する。具体的には、ロボットハンド42は、ドアハンドル20aの少し右側(ドア20を開放する側)の位置からドアハンドル20aに接触しながら左側(ドア20を閉鎖する側)へ移動し、ドア20をスライドすることによってドア20を閉鎖する。ロボット制御装置31は、ドア20を閉鎖すると、ロボットハンド42を作動してロック操作ボタン66aを押してドア20をロックする。さらに、ロボットハンド42を作動してワークセット完了ボタン66cを押すことによって、ワークWのセットが完了したことを工作機械12に伝達することができる。
If the pressure is equal to or greater than the threshold, the process proceeds to step S042, where the robot control device 31 activates the robot hand 42 to close the door 20. Specifically, the robot hand 42 moves from a position slightly to the right of the door handle 20a (the side that opens the door 20) to the left (the side that closes the door 20) while contacting the door handle 20a, and closes the door 20 by sliding the door 20. When the robot control device 31 has closed the door 20, it activates the robot hand 42 to press the lock operation button 66a to lock the door 20. Furthermore, by activating the robot hand 42 to press the work set complete button 66c, it is possible to communicate to the machine tool 12 that the setting of the workpiece W has been completed.
本実施形態に係るワーク着脱システム10によると、ロボット30は、ワークWを把持可能に構成されたロボットハンド42を有し、任意の方向に移動可能な無人搬送車32によって移動することができる。このため、上位制御システム48は、ロボット30を載置した無人搬送車32を作動させることによってロボット30をステーション14、15まで移動させ、ロボット制御装置31は、ロボット30のロボットハンド42を作動させることによってワークWをワーク取付台16に配置することができる。これによって、ステーション14、15ごとにロボット30を配置するのではなく、ワークWの着脱を必要とするステーション14、15へ適宜ロボット30を移動すればよく、ロボット30を用いたワークWの着脱を効率的に行うことができる。
In the workpiece attachment/detachment system 10 according to this embodiment, the robot 30 has a robot hand 42 configured to be able to grasp the workpiece W, and can be moved by an automated guided vehicle 32 that can move in any direction. Therefore, the upper control system 48 operates the automated guided vehicle 32 on which the robot 30 is placed to move the robot 30 to the stations 14 and 15, and the robot control device 31 operates the robot hand 42 of the robot 30 to place the workpiece W on the workpiece mounting table 16. This allows the robot 30 to be moved appropriately to the stations 14 and 15 where the workpiece W needs to be attached or detached, rather than placing the robot 30 at each of the stations 14 and 15, and allows the robot 30 to be used to efficiently attach and detach the workpiece W.
さらに、本実施形態に係るワーク着脱システム10によると、ロボット30は、撮影するための基準位置において可動部材78及び固定部材84を撮影可能に構成されたカメラ46を有し、無人搬送車32によって撮影位置まで移動することができる。上位制御システム48は、ロボット30を載置した無人搬送車32を作動させることによってロボット30を撮影位置へ移動させ、ロボット制御装置31は、カメラ46を作動させることによって可動部材78及び固定部材84を同時に撮影することができる。このため、ロボット制御装置31は、撮影された可動部材78及び固定部材84の画像に基づいて、ワーク取付台16に対するワークWの着脱状態を判断することができ、ワーク取付台16にワークWが適切に取り付けられていると判断した場合には加工を継続することができる。また、ロボット制御装置31がワーク取付台16にワークWが適切に取り付けられていないと判断した場合には、上位制御システム48は、例えば、クランパ74及びロボット30を作動してワークWを一旦アンクランプした上で再度クランプする工程や、クランプを改善するために加工を中断するといった工程を含めることができる。これによって、ステーション14、15の不具合の確認やその解消のための工程を含めることができ、ロボット30を用いたワークWの着脱を効率的に行うことができる。
Furthermore, according to the workpiece mounting/removal system 10 of this embodiment, the robot 30 has a camera 46 configured to be able to photograph the movable member 78 and the fixed member 84 at a reference position for photographing, and can be moved to the photographing position by the automatic guided vehicle 32. The upper control system 48 moves the robot 30 to the photographing position by operating the automatic guided vehicle 32 on which the robot 30 is placed, and the robot control device 31 can simultaneously photograph the movable member 78 and the fixed member 84 by operating the camera 46. Therefore, the robot control device 31 can determine the mounting/removal state of the workpiece W with respect to the workpiece mounting table 16 based on the images of the movable member 78 and the fixed member 84 that have been photographed, and can continue processing if it is determined that the workpiece W is properly mounted on the workpiece mounting table 16. In addition, if the robot control device 31 determines that the workpiece W is not properly mounted on the workpiece mounting table 16, the upper control system 48 can include, for example, a process of operating the clamper 74 and the robot 30 to once unclamp the workpiece W and then clamp it again, or a process of interrupting processing to improve clamping. This allows the process of checking for and resolving malfunctions in stations 14 and 15 to be included, and allows the robot 30 to efficiently load and unload the workpiece W.
また、本実施形態に係るワーク着脱システム10によると、可動部材78にはこれが作動することによって向きが変化する位置マーク86が形成されている。また、固定部材84には、情報マーク88が形成されている。位置マーク86及び情報マーク88の表示面は、いずれもアングルプレート72からドア20の方向へ向けて表示されており、カメラ46によって同時に撮影することができる。このため、カメラ46によって撮影した画像の基準位置を明確にすることができる。さらに、基準画像との比較は、ここでは、鉛直方向上方側及び水平方向前方側から撮影された可動部材78及び固定部材84の画像に基づいて行われる。これによって、可動部材78と固定部材84との相対位置関係の判断、すなわちクランプ状態又はアンクランプ状態を確実に判断することができ、ロボット30を用いたワークWの着脱を効率的に行うことができる。
Furthermore, according to the workpiece mounting/removal system 10 of this embodiment, the movable member 78 is formed with a position mark 86 whose orientation changes when the movable member 78 is actuated. Furthermore, the fixed member 84 is formed with an information mark 88. The display surfaces of the position mark 86 and the information mark 88 are both displayed facing the direction from the angle plate 72 toward the door 20, and can be photographed simultaneously by the camera 46. This makes it possible to clarify the reference position of the image photographed by the camera 46. Furthermore, the comparison with the reference image is performed here based on images of the movable member 78 and the fixed member 84 photographed from the vertically upward side and the horizontally forward side. This makes it possible to reliably determine the relative positional relationship between the movable member 78 and the fixed member 84, i.e., the clamped or unclamped state, and efficiently mount and remove the workpiece W using the robot 30.
さらに、本実施形態に係るワーク着脱システム10によると、適切にクランプ状態になっていない、すなわち適切にワークWがクランプされていないと判断したロボット制御装置31は、ロボットハンド42を作動してワークWを把持し、材料置き台22上の仮置台23へ一旦移動させる。ワークWを移動させると、ロボット制御装置31は、ロボットハンド42を作動してエアノズル68をステーション14の格納位置から引き出し、クランパ74及びワークWの取り付け位置及びこれらの周辺を清掃するように構成されている。このため、クランパ74がごみ等を挟み込むことによって適切にクランプ状態にならない場合は、これを解消することができる。これによって、ワークWを安定して、かつ、確実にクランプすることができ、ロボット30を用いたワークWの着脱を効率的に行うことができる。
Furthermore, according to the workpiece attachment/detachment system 10 of this embodiment, when the robot control device 31 determines that the workpiece W is not properly clamped, i.e. that the workpiece W is not properly clamped, it operates the robot hand 42 to grasp the workpiece W and temporarily move it to the temporary placement table 23 on the material placement table 22. After moving the workpiece W, the robot control device 31 is configured to operate the robot hand 42 to pull out the air nozzle 68 from its storage position in the station 14 and clean the clamper 74 and the attachment position of the workpiece W and their surroundings. Therefore, if the clamper 74 is not properly clamped due to the presence of dirt or the like, this can be resolved. This allows the workpiece W to be stably and reliably clamped, and the workpiece W can be efficiently attached and detached using the robot 30.
また、本実施形態に係るワーク着脱システム10によると、ワーク取付台16は、油空圧供給装置26を用いてクランパ74に供給された圧力を表示するための圧力計92を備える。ロボット制御装置31は、ワークWがクランプされ、油空圧供給装置26が接続解除されると、カメラ46を作動して圧力計92を撮影し、撮影した画像に基づき、油空圧供給装置26が接続解除された後もクランパ74に閾値以上の圧力が供給されているか否かを判断することができる。ここで、圧力が閾値未満の場合は、ロボット制御装置31は、ロボットハンド42を作動して供給装置ボタン66dを押すことによって、アングルプレート72のノズル連結部90と油空圧供給装置26とを再度接続するように構成されている。また、ロボット制御装置31は、ロボットハンド42を作動してワーククランプボタン66bを押すことによって、クランパ74の可動部材78が回動して爪部材82のワークWへの係合を解除し、クランパ74をアンクランプ状態にできるように構成されている。さらに、ロボット制御装置31は、ロボットハンド42を作動してアンクランプ状態のワークWを挟持し、材料置き台22の仮置台23上へ移動するように構成されている。これによって、ステーション14、15の不具合を発見した場合にはその解消を優先すべくワークWの加工を中断することができ、ロボット30を用いたワークWの着脱を効率的に行うことができる。
In addition, according to the workpiece mounting and demounting system 10 of this embodiment, the workpiece mounting table 16 is provided with a pressure gauge 92 for displaying the pressure supplied to the clamper 74 by the hydraulic and pneumatic supply device 26. When the workpiece W is clamped and the hydraulic and pneumatic supply device 26 is disconnected, the robot control device 31 operates the camera 46 to photograph the pressure gauge 92, and can determine whether or not a pressure equal to or greater than the threshold value is being supplied to the clamper 74 even after the hydraulic and pneumatic supply device 26 is disconnected, based on the photographed image. Here, if the pressure is less than the threshold value, the robot control device 31 is configured to operate the robot hand 42 to press the supply device button 66d, thereby reconnecting the nozzle connection part 90 of the angle plate 72 to the hydraulic and pneumatic supply device 26. In addition, the robot control device 31 is configured to operate the robot hand 42 to press the workpiece clamp button 66b, thereby rotating the movable member 78 of the clamper 74 to release the engagement of the claw member 82 with the workpiece W, and to place the clamper 74 in an unclamped state. Furthermore, the robot control device 31 is configured to operate the robot hand 42 to clamp the unclamped workpiece W and move it onto the temporary placement table 23 of the material placement table 22. This allows the processing of the workpiece W to be interrupted in order to prioritize resolving any malfunctions found in stations 14 and 15, and allows the robot 30 to efficiently load and unload the workpiece W.
以上により、本実施形態に係るワーク着脱システム10によれば、ロボット30を用いたワークWの着脱を効率的に行うことができる。
As described above, the workpiece mounting/removal system 10 according to this embodiment can efficiently mount and remove the workpiece W using the robot 30.
(変形例)
以下、本実施形態に係るワーク着脱システム10の変形例について説明する。本実施形態と同様な又は対応する要素には同一の符号を付し、重複する説明は省略する。 (Modification)
Hereinafter, a modified example of the workpiece mounting andunmounting system 10 according to the present embodiment will be described. Elements similar to or corresponding to those in the present embodiment will be given the same reference numerals, and duplicated descriptions will be omitted.
以下、本実施形態に係るワーク着脱システム10の変形例について説明する。本実施形態と同様な又は対応する要素には同一の符号を付し、重複する説明は省略する。 (Modification)
Hereinafter, a modified example of the workpiece mounting and
変形例に係るワーク着脱システム10によれば、ワーク取付台16のプレート台座70上には、水平方向に沿って延在するパレット102が配置されている。4つのクランパ74は、パレット102の上方側に配置されており、パレット102の上面に配置されるワークWをクランプするように構成されている。また、圧力計92は、ノズル連結部90の上方側に配置されている。
In the modified workpiece mounting/removal system 10, a pallet 102 extending horizontally is placed on the plate base 70 of the workpiece mounting table 16. The four clampers 74 are arranged above the pallet 102 and are configured to clamp the workpiece W placed on the upper surface of the pallet 102. In addition, the pressure gauge 92 is arranged above the nozzle connection part 90.
ロボット30は、クランパ74のアンクランプ状態及びクランプ状態の確認、すなわち判断を、予めロボット制御装置31に記録した基準画像をカメラ46で撮影した画像と比較することによって行うように構成されている。具体的には、撮影した画像における位置マーク86と情報マーク88との相対位置関係を基準画像における相対位置関係と比較する。基準画像における相対位置関係としては、クランプ状態では、上方側から撮影した基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XC及び水平前後方向の間隔YC、並びに、正面側から撮影した基準画像における位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの上下方向の間隔ZCを用いる。また、アンクランプ状態では、上方側から撮影した基準画像における位置マーク86の第1の中心点86bと情報マーク88の一辺との水平横方向の間隔XU及び水平前後方向の間隔YU、並びに、正面側から撮影した基準画像における位置マーク86の第1の中心点86bと情報マーク88の第2の端点88aとの上下方向の間隔ZUを用いる。
The robot 30 is configured to confirm, i.e., judge, the unclamped and clamped states of the clamper 74 by comparing a reference image previously recorded in the robot control device 31 with an image captured by the camera 46. Specifically, the relative positional relationship between the position mark 86 and the information mark 88 in the captured image is compared with the relative positional relationship in the reference image. As the relative positional relationship in the reference image, in the clamped state, the horizontal lateral distance XC and horizontal front-to-back distance YC between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image captured from above, and the vertical distance ZC between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 in the reference image captured from the front are used. In addition, in the unclamped state, the horizontal lateral distance XU and horizontal front-to-back distance YU between the first center point 86b of the position mark 86 and one side of the information mark 88 in the reference image captured from above, as well as the vertical distance ZU between the first center point 86b of the position mark 86 and the second end point 88a of the information mark 88 in the reference image captured from the front, are used.
変形例に係るワーク着脱システム10によると、ロボット制御装置31は、カメラ46で撮影した画像に基づいて、ワーク取付台16に対するワークWの着脱状態を判断することができ、ワーク取付台16にワークWが適切に取り付けられていると判断した場合には加工を継続することができる。また、ロボット制御装置31がワーク取付台16にワークWが適切に取り付けられていないと判断した場合には、上位制御システム48は、例えば、クランパ74及びロボット30を作動してワークWを一旦アンクランプした上で再度クランプした場合であってもワークWが適切に取り付けられていないと判断した場合は加工を中断することができる。これによって、ステーション14、15の不具合を発見した場合にはこれを解消するための工程を含めることができ、ロボット30を用いたワークWの着脱を効率的に行うことができる。
In the workpiece mounting/removal system 10 according to the modified example, the robot control device 31 can determine the mounting/removal state of the workpiece W on the workpiece mounting table 16 based on the image captured by the camera 46, and can continue processing if it determines that the workpiece W is properly mounted on the workpiece mounting table 16. Furthermore, if the robot control device 31 determines that the workpiece W is not properly mounted on the workpiece mounting table 16, the upper control system 48 can suspend processing if it determines that the workpiece W is not properly mounted, even if, for example, the clamper 74 and the robot 30 are operated to unclamp the workpiece W and then clamp it again. This makes it possible to include a process for resolving any defects found in the stations 14 and 15, and to efficiently mount and remove the workpiece W using the robot 30.
なお、ここでは、ドア20の横に配置された4つの操作ボタン66a、66b、66c、66dをロボットハンド42が押すものとして説明したが、これに限らず、例えば、上位制御システムからの通信によって自動化されてもよい。
In the above description, the robot hand 42 presses the four operation buttons 66a, 66b, 66c, and 66d located on the side of the door 20, but this is not limiting and may be automated, for example, by communication from a higher-level control system.
また、ここでは、油空圧供給装置26は、ワーク取付台16の側方から接続されるものとして説明したが、これに限らず、例えば、ワーク取付台の上方側と接続するような上部オンライン形油圧供給装置等とされてもよい。
In addition, the hydraulic and pneumatic supply device 26 has been described here as being connected from the side of the work mounting table 16, but this is not limited thereto, and it may be, for example, an upper online hydraulic supply device that is connected to the upper side of the work mounting table.
さらに、ここでは、クランパ74は、軸部材80を回動させて爪部材82をワークWに係合させるものとして説明したが、これに限らず、例えば、リンククランプや直動クランプのような他の種類のクランパが用いられてもよい。
Furthermore, the clamper 74 has been described here as rotating the shaft member 80 to engage the claw member 82 with the workpiece W, but this is not limited to the above, and other types of clampers, such as a link clamp or a linear clamp, may also be used.
また、ここでは、ワーク取付台16は、ステーション14、15の内部に配置されているとして説明したが、これに限らず、例えば、ワーク取付台単体で使用されてもよい。
Furthermore, although the work mounting table 16 has been described here as being disposed inside the stations 14 and 15, this is not limiting, and for example, the work mounting table may be used alone.
以上、ワーク着脱システム10の実施形態について説明したが、本発明は上記の実施形態に限定されない。当業者であれば、上記の実施形態の様々な変形が可能であることを理解できると考えられる。
The above describes an embodiment of the workpiece attachment/detachment system 10, but the present invention is not limited to the above embodiment. It is believed that a person skilled in the art would understand that various modifications of the above embodiment are possible.
10 ワーク着脱システム
14 ステーション(ワーク取付装置)
15 ステーション(ワーク取付装置)
16 ワーク取付台
30 ロボット
31 ロボット制御装置(制御装置)
32 無人搬送車(移動体)
42 ロボットハンド(ハンド)
46 カメラ
48 上位制御システム(制御装置)
68 エアノズル(清掃手段)
74 クランパ
78 可動部材
84 固定部材
86 位置マーク(第1の撮影部)
88 情報マーク(第2の撮影部)
92 圧力計
100 ワーク取付台
W ワーク 10 Workpiece mounting/removal system 14 Station (workpiece mounting device)
15 Station (Work mounting device)
16 Workpiece mounting table 30Robot 31 Robot control device (control device)
32 Automated guided vehicle (mobile body)
42 Robot Hand (Hand)
46Camera 48 Upper control system (control device)
68 Air nozzle (cleaning means)
74: clamper; 78: movable member; 84: fixed member; 86: position mark (first photographing unit)
88 Information mark (second photographing part)
92Pressure gauge 100 Work mounting stand W Work
14 ステーション(ワーク取付装置)
15 ステーション(ワーク取付装置)
16 ワーク取付台
30 ロボット
31 ロボット制御装置(制御装置)
32 無人搬送車(移動体)
42 ロボットハンド(ハンド)
46 カメラ
48 上位制御システム(制御装置)
68 エアノズル(清掃手段)
74 クランパ
78 可動部材
84 固定部材
86 位置マーク(第1の撮影部)
88 情報マーク(第2の撮影部)
92 圧力計
100 ワーク取付台
W ワーク 10 Workpiece mounting/
15 Station (Work mounting device)
16 Workpiece mounting table 30
32 Automated guided vehicle (mobile body)
42 Robot Hand (Hand)
46
68 Air nozzle (cleaning means)
74: clamper; 78: movable member; 84: fixed member; 86: position mark (first photographing unit)
88 Information mark (second photographing part)
92
Claims (4)
- 加工のためにワークを着脱するワーク着脱システムであって、
前記ワークを取付けるためのワーク取付台と、可動部材を作動することによって前記ワークを前記ワーク取付台に対して取り付ける、又は、取り外すためのクランパと、前記クランパの近傍に固定された固定部材とを有するワーク取付装置と、
前記ワークを把持可能に構成されたハンドと、撮影位置において前記可動部材及び前記固定部材を撮影可能に構成されたカメラとを有するロボットと、
前記ロボットを載置し、前記ロボットを前記撮影位置へ移動するために、任意の方向に移動可能な移動体と、
前記クランパ、前記ロボット及び前記カメラを作動するための制御装置であって、前記カメラで撮影した画像に基づいて、前記ワーク取付台に対する前記ワークの着脱状態を判断する制御装置と、を備え、
前記カメラは、前記可動部材及び前記固定部材を同時に撮影することを特徴としたワーク着脱システム。 A workpiece loading/unloading system for loading/unloading a workpiece for machining, comprising:
a work mounting device including a work mounting table for mounting the work, a clamper for mounting or removing the work on the work mounting table by operating a movable member, and a fixing member fixed near the clamper;
a robot having a hand configured to be able to grip the workpiece and a camera configured to be able to photograph the movable member and the fixed member at a photographing position;
a moving body on which the robot is placed and which is movable in any direction in order to move the robot to the photographing position;
A control device for operating the clamper, the robot, and the camera, the control device determining a mounting/removal state of the workpiece with respect to the workpiece mounting table based on an image captured by the camera,
A workpiece attachment/detachment system characterized in that the camera simultaneously photographs the movable member and the fixed member. - 前記可動部材に形成され、前記可動部材が作動することによって位置が変化する第1の撮影部と、
前記固定部材に形成された第2の撮影部と、を備え、
前記第1の撮影部と前記第2の撮影部とは同じ方向で前記カメラと対向し、前記カメラは、前記第1の撮影部及び前記第2の撮影部を同時に撮影することを特徴とする請求項1に記載のワーク着脱システム。 a first imaging unit formed on the movable member and whose position changes as the movable member is actuated;
A second imaging unit formed on the fixed member,
The workpiece mounting/removal system according to claim 1, characterized in that the first photographing unit and the second photographing unit face the camera in the same direction, and the camera photographs the first photographing unit and the second photographing unit simultaneously. - 前記制御装置は、前記カメラで撮影した画像における前記第1の撮影部と前記第2の撮影部との位置関係から、前記クランパが前記ワークを前記ワーク取付台に取り付けるクランプ状態、又は、前記ワークを前記ワーク取付台から取り外すアンクランプ状態にあることを判断し、
前記可動部材が前記クランプ状態又は前記アンクランプ状態の基準位置から閾値以上ずれていると判断した場合は、清掃手段を作動して、前記クランパ及び前記ワークの周辺を清掃するように構成されている請求項2に記載のワーク着脱システム。 The control device determines, based on a positional relationship between the first photographing unit and the second photographing unit in an image photographed by the camera, that the clamper is in a clamping state in which the workpiece is attached to the workpiece mounting table, or in an unclamping state in which the workpiece is removed from the workpiece mounting table;
The workpiece mounting/removal system of claim 2, configured to operate a cleaning means to clean the clamper and the surrounding area of the workpiece when it is determined that the movable member has deviated from the reference position in the clamped state or the unclamped state by more than a threshold value. - 前記ワーク取付台は、油空圧供給装置を用いて前記クランパに供給された圧力を表示するための圧力計を備え、
前記制御装置は、前記カメラによって撮影された前記圧力計の画像から前記クランパの圧力値を検出し、該圧力値が閾値以下の場合は、前記ワークを前記ワーク取付台から取り外すように構成されている請求項3に記載のワーク着脱システム。 the workpiece mounting table is provided with a pressure gauge for indicating pressure supplied to the clamper by a hydraulic and pneumatic pressure supply device,
The workpiece mounting/removal system of claim 3, wherein the control device is configured to detect the pressure value of the clamper from an image of the pressure gauge captured by the camera, and remove the workpiece from the workpiece mounting table if the pressure value is below a threshold value.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2023041115A JP7493643B1 (en) | 2023-03-15 | 2023-03-15 | Workpiece attachment/detachment system |
JP2023-041115 | 2023-03-15 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2024190300A1 true WO2024190300A1 (en) | 2024-09-19 |
Family
ID=91227035
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2024/005778 WO2024190300A1 (en) | 2023-03-15 | 2024-02-19 | Workpiece attachment/detachment system |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7493643B1 (en) |
WO (1) | WO2024190300A1 (en) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013073683A1 (en) * | 2011-11-16 | 2013-05-23 | 日産自動車株式会社 | Joint manufacturing method and manufacturing device for same |
JP6626165B2 (en) * | 2018-08-02 | 2019-12-25 | ファナック株式会社 | Machining system with a machine tool and a robot for attaching and detaching workpieces |
-
2023
- 2023-03-15 JP JP2023041115A patent/JP7493643B1/en active Active
-
2024
- 2024-02-19 WO PCT/JP2024/005778 patent/WO2024190300A1/en unknown
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013073683A1 (en) * | 2011-11-16 | 2013-05-23 | 日産自動車株式会社 | Joint manufacturing method and manufacturing device for same |
JP6626165B2 (en) * | 2018-08-02 | 2019-12-25 | ファナック株式会社 | Machining system with a machine tool and a robot for attaching and detaching workpieces |
Also Published As
Publication number | Publication date |
---|---|
JP2024131075A (en) | 2024-09-30 |
JP7493643B1 (en) | 2024-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6065200A (en) | Method for assembling bodywork parts | |
CN112770992B (en) | Vacuum gripper, feed unit and method for transporting flat components | |
US11938583B2 (en) | Transport device for receiving one or more module units having machine tool accessory devices and for transporting the one or more received module units | |
CN111655436B (en) | Clamping positioning device for transferring clamping device between different positions | |
US20080251351A1 (en) | Robotic frame handling system | |
TWI480214B (en) | Sheet metal processing apparatus and sheet-like member manufacturing method | |
KR102345573B1 (en) | gas auto supply system of gas cylinder and method of controlling the same | |
CN109548395A (en) | The automatic disassemblerassembler of pcb board | |
WO2024190300A1 (en) | Workpiece attachment/detachment system | |
US11791188B2 (en) | Transport apparatus and control method | |
CN117980233A (en) | Mobile robot and method for changing label rolls at a labelling device | |
JP4621334B2 (en) | Automatic jig changing method in welding line | |
US20210221457A1 (en) | Vehicle servicing apparatus and methods of use thereof | |
TWM510027U (en) | Positioning material receiving device without plate arrangement mechanism | |
CN115485104A (en) | Manipulator for manufacturing environment | |
JP4514843B2 (en) | Tool magazine | |
KR20210151483A (en) | endcap removal auto supply apparatus of gas cylinder | |
JP4483818B2 (en) | Workpiece transfer method, workpiece transfer device, and workpiece transfer system | |
CN215883376U (en) | Battery replacing system | |
US12110172B2 (en) | Apparatus and method of operating twistlocks and associated robot | |
JP4697049B2 (en) | Workpiece transfer method, workpiece transfer device, and workpiece transfer system | |
US20210122062A1 (en) | Glass Decking System, Adaptable End Effector and Methods | |
JP4595885B2 (en) | Workpiece transfer device and workpiece transfer system | |
JP5008842B2 (en) | Conveying method of workpiece and conveying device used for the conveying method | |
WO2021240626A1 (en) | Substrate manufacturing system, autonomous traveling bogie, and substrate manufacturing method |
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: 24770415 Country of ref document: EP Kind code of ref document: A1 |