WO2019111413A1 - 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 - Google Patents

制御装置、ワーク作業装置、ワーク作業システム及び制御方法 Download PDF

Info

Publication number
WO2019111413A1
WO2019111413A1 PCT/JP2017/044237 JP2017044237W WO2019111413A1 WO 2019111413 A1 WO2019111413 A1 WO 2019111413A1 JP 2017044237 W JP2017044237 W JP 2017044237W WO 2019111413 A1 WO2019111413 A1 WO 2019111413A1
Authority
WO
WIPO (PCT)
Prior art keywords
work
list
execution unit
processing
type
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/JP2017/044237
Other languages
English (en)
French (fr)
Inventor
陵平 福本
政利 藤田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fuji Corp
Original Assignee
Fuji Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fuji Corp filed Critical Fuji Corp
Priority to EP17934230.8A priority Critical patent/EP3722053B1/en
Priority to CN201780097280.4A priority patent/CN111417496B/zh
Priority to PCT/JP2017/044237 priority patent/WO2019111413A1/ja
Priority to JP2019557975A priority patent/JP6825134B2/ja
Publication of WO2019111413A1 publication Critical patent/WO2019111413A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Program-control systems
    • G05B19/02—Program-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form
    • G05B19/4155—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by program execution, i.e. part program or machine function execution, e.g. selection of a program
    • 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
    • B25J9/00—Program-controlled manipulators
    • B25J9/16—Program controls
    • B25J9/1656—Program controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Program controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Program-control systems
    • G05B19/02—Program-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form
    • G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by monitoring or safety
    • G05B19/4067—Restoring data or position after power failure or other interruption
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/34—Director, elements to supervisory
    • G05B2219/34332—Program execution as function of direction, forward or backward
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/50—Machine tool, machine tool null till machine tool work handling
    • G05B2219/50103—Restart, reverse, return along machined path, stop

Definitions

  • control device In the present specification, a control device, a work operation device, a work operation system, and a control method are disclosed.
  • the present disclosure has been made in view of such problems, and has as its main object to provide a control device, a work operation device, a work operation system, and a control method capable of realizing reverse feeding more easily. .
  • the control device of the present disclosure is A control device used in a work operation apparatus including a work execution unit that moves a work member that performs a predetermined work on a work and performs the predetermined work on the work, A work type list including a work type and a work position of the work execution unit and defined as a pair of a work type at the time of forward processing and a work type at the time of reverse processing.
  • a storage unit for storing The work execution unit is controlled based on the order of the operation order list and the work type at the time of forward movement process of the work type list at the time of forward movement processing, and at the time of reverse movement process, the reverse order of the operation order list and the work type list
  • an operation order list including the work type and the work position of the work execution unit and the operation order list regarding the operation order of the work type, and the work type during the forward processing and the work type during the reverse processing are defined as a pair.
  • the work execution unit is controlled based on the order of the operation order list and the work type at the time of the process type list forward processing in the forward processing, and the reverse order of the operation order list and the work in the backward processing
  • the work execution unit is controlled based on the work type at the time of reverse feed processing of the species list. For example, in the case where the work work apparatus is for moving and placing a work, if the reverse feed process at the time of operation return etc.
  • the operator specifies the operation order of the work type in the operation order list, and defines the work type in the forward processing and the work type in the reverse processing in the work type list. If you do, in the reverse feed process at the time of operation return etc., the device can replace work automatically and can execute. Therefore, in this control device, it is not necessary to separately prepare complicated handling (for example, a program etc.) related to the reverse feeding process, and the reverse feeding process can be realized more easily.
  • the storage unit stores a position list related to the recording of the operation position of the work execution unit executed at the time of the forward processing, and the control unit performs the position when the operation execution unit starts operation.
  • the reverse process may be performed based on a list.
  • this control device by using the position list, it is possible to grasp the current position of the work execution unit, so it is possible to more reliably execute the reverse feeding process.
  • control unit causes the operation position of the work execution unit executed during the forward processing to be stored in the storage unit as operation position information from the recording start position included in the position list.
  • the operation position information is stored when it reaches the recording end position included in the position list, and when the operation position information is stored at the start of the operation of the work execution unit, the operation included in the operation position information
  • the work execution unit may be controlled to execute the reverse feed process from the position. In this control device, it is possible to more easily determine whether or not the reverse feed process can be performed from the recording start position registered in the position list to the recording end position based on the presence or absence of the operation position information.
  • control unit may control the work execution unit to execute the reverse processing when the work execution unit performs an error stop and then performs a return operation. With this control device, recovery of operation can be realized more easily.
  • the working member is a sampling member that samples and processes the work
  • the work execution unit is a sampling and moving unit that includes the sampling member and moves the workpiece
  • the storage unit is One of the pair of the work collecting operation and the work collecting and releasing operation, and the pair of the movement operation of the work to the movement target position and the movement operation of the previous work type to the movement target position
  • the work type list defined including the above may be stored.
  • the reverse operation can be executed by automatically replacing the sampling operation and the moving operation.
  • the work work apparatus moves a work member that performs a predetermined work on a work and performs a predetermined work on the work and controls the work execution unit as described above. And the control device described in the above.
  • the operator specifies the operation order of the work type in the operation order list, and sets the work type in the forward processing and the work type in the reverse processing as a pair. If defined in the work type list, the apparatus can replace and execute the work automatically in the reverse feed process at the time of operation return and the like. Therefore, in this work work apparatus, it is not necessary to separately prepare complicated handling (for example, a program etc.) related to the reverse feeding process, and the reverse feeding process can be realized more easily.
  • complicated handling for example, a program etc.
  • the work member may be a collection member that collects and processes the work
  • the work execution unit may be a collection movement unit that includes the collection member and moves the work.
  • work such as teaching may be required for operation return etc., but the work work apparatus of the present disclosure does not require such work and can be easily reversed. Feeding processing can be realized.
  • the work work system of the present disclosure includes a plurality of any one of the work work devices described above.
  • the forward feed process and the reverse feed process can be easily realized, and for example, interference of a plurality of work work devices can be prevented.
  • the control method of the present disclosure is A control method used in a work operation apparatus including a work execution unit that moves a work member that performs a predetermined work on a work and performs the predetermined work on the work, A work type list including a work type and a work position of the work execution unit and defined as a pair of a work type at the time of forward processing and a work type at the time of reverse processing.
  • the work execution unit is controlled based on the order of the operation order list and the work type at the time of forward movement process of the work type list at the time of forward movement processing, and at the time of reverse movement process, the reverse order of the operation order list and the work type list Controlling the work execution unit based on the work type at the time of reverse feed processing; Is included.
  • the operator specifies the operation order of the work type in the operation order list, and sets the work type in the forward feed process and the work type in the reverse feed process as a pair. If defined in the seed list, the apparatus can automatically replace and execute work in reverse feed processing at the time of operation return and the like. Therefore, with this control method, reverse feed processing can be realized more easily.
  • the aspect of the control apparatus mentioned above may be employ
  • FIG. 1 is a schematic explanatory view showing an example of a work operation system 10;
  • FIG. 2 is a perspective view showing an example of a work operation device 20.
  • FIG. FIG. 10 is an explanatory diagram of a list content input screen 50.
  • 5 is a flowchart illustrating an example of an operation position storage process routine.
  • FIG. Explanatory drawing which shows an example of a forward feeding process and the reverse sending process after halfway stop.
  • FIG. 10 is a schematic explanatory view showing an example of a work operation system 10;
  • FIG. 2 is a perspective view showing an example of a work operation device 20.
  • FIG. 1 is a schematic explanatory view showing an example of a work operation system 10.
  • FIG. 2 is a perspective view showing an example of the work device 20.
  • FIG. 3 is an explanatory diagram of the operation order list 44, the work type list 45, the position list 46, and the operation position information 47 stored in the storage unit 43.
  • the work operation system 10 includes a plurality of work operation devices 20 that perform a predetermined operation on an article (work W) to be operated.
  • the work operation system 10 transports and fixes one or more work operation devices 20, a base 11 on which the work operation device 20 is disposed, and an arrangement member 15 on which the work W (see FIG.
  • a transport unit 12 and a system interface (I / F) 14 for inputting a command from the control device 40 are provided.
  • the work system 10 moves the work W from the supply position to the arrangement position (arrangement member 15).
  • the left-right direction (X-axis), the front-back direction (Y-axis), and the up-down direction (Z-axis) of the work system 10 are as shown in FIG.
  • the work work apparatus 20 is movable in all directions, and there is no specific direction fixed, but for convenience of explanation, for the work work apparatus 20, the direction shown in FIG. ), And will be described as the longitudinal direction (Y axis) and the vertical direction (Z axis).
  • the work work device 20 is configured as a device that performs a predetermined work on an article to be worked.
  • the article to be worked is not particularly limited, and examples include various parts such as mechanical parts, electrical parts, electronic parts, and chemical parts, as well as food, bio and biological related articles.
  • predetermined work for example, moving work of collecting, moving and arranging from a supply position to a target position, assembling work of assembling parts, processing work of applying processing, coating work of applying viscous material, heating of heating Examples include processing operations that perform predetermined operations such as operations, chemical and / or physical, and inspection operations that perform inspections.
  • the processing operation includes grinding operation, cutting operation, deformation operation, connection operation, bonding operation and the like.
  • the viscous material may, for example, be an adhesive, a solder paste, or grease.
  • the inspection operation may be, for example, an operation of inspecting one or more operation results described above, and may be accompanied by a movement operation of the workpiece W.
  • the work work apparatus 20 is configured as an articulated arm robot, and as shown in FIG. 2, the first arm 21, the second arm 22, the third support 23, the pedestal 24, and the end effector It has 30 and.
  • An end effector 30 is rotatably disposed at the tip of the first arm 21 via a first drive unit 21a.
  • the first arm 21 is rotatably disposed at the tip of the second arm 22 via the second drive unit 22a.
  • the second arm 22 is rotatably disposed at the tip of the third support portion 23 via the third drive portion 23a.
  • the third support 23 is rotatably supported by the pedestal 24 via the pedestal drive 25.
  • the arm and the drive unit constitute a work execution unit 28 for picking up the work W and performing a moving work.
  • the end effector 30 picks up the work W and has a pick member 32.
  • the collecting member 32 is a working member for holding and collecting the workpiece W, and is moved by the work execution unit 28.
  • the collecting member 32 may be a suction nozzle for collecting the workpiece W by negative pressure.
  • the control device 40 is a computer that controls the entire work work device 20 included in the work work system 10.
  • the control device 40 includes a control unit 41, a storage unit 43, and a display unit 48.
  • the control unit 41 is configured as a microprocessor centering on the CPU 42.
  • the control unit 41 outputs drive signals to the first drive unit 21a, the second drive unit 22a, the third drive unit 23a, the pedestal drive unit 25, the end effector 30, and the like.
  • the storage unit 43 is configured as, for example, a large-capacity storage device such as an HDD. As shown in FIG. 3, the storage unit 43 stores an operation order list 44, a work type list 45, a position list 46, operation position information 47, and the like used to control the work apparatus 20.
  • the display unit 48 displays a screen including information on the work apparatus 20, and is, for example, a liquid crystal display.
  • the operation order list 44 includes information such as the processing order, the work type, and the work position regarding the operation order of the work type of the work apparatus 20.
  • the work position may be the position of the work W or the position of the work member (collection member 32), and although the coordinates are different, these can be treated as synonymous.
  • the position of the collecting member 32 will be mainly described as a work position.
  • the work type list 45 includes information defined as a pair of a work type in the forward processing and a work type in the reverse processing.
  • the position list 46 includes information on the recording of the operation position of the work execution unit 28 performed at the time of the sequential feeding process.
  • the position list 46 includes the recording start and the recording end of the operation position information 47 as processing executed when the collecting member 32 reaches the specific target position and the target position.
  • the operation position information 47 is information recorded based on the position list 46, and is information in which the processing order at the time of operation is associated with position coordinates.
  • the operation position information 47 is temporary data to be deleted from the storage unit 43 when the collecting member 32 reaches the recording end position of the position list 46.
  • the control unit 41 is programmed to execute the work types defined in the operation order list 44 in order of processing using the work content specified when the work type list 45 is advanced. On the other hand, when the operation position information 47 is stored, the control unit 41 uses the work content defined at the time of reverse sending of the work type list 45, and reverses the processing type defined in the operation order list 44 to the processing order. It is programmed to run.
  • FIG. 4 is an explanatory diagram of a list content input screen 50 displayed on the display unit 48 of the control device 40.
  • a cursor 51 As shown in FIG.
  • the cursor 51 is for selecting an input position and various keys, and operates in conjunction with a mouse or a keyboard connected to the control device 40.
  • the operation order list input field 52 is an area for inputting information contained in the operation order list 44, and is a field for inputting information such as processing order, work type (command), and work position (X, Y, Z coordinates). is there.
  • the work type list registration field 53 is a field included in the work type list 45 for registering the work type at the time of the sending process and the work type at the time of the reverse process in pairs.
  • the work type (command) the work content at the time of the forward processing is previously determined, and in this column, after the work type at the time of the progressive processing is selected, the work type at the time of the reverse processing corresponding to this is selected. be registered.
  • the work type (command) the work content at the time of the forward processing is previously determined, and in this column, after the work type at the time of the progressive processing is selected, the work type at the time of the reverse processing corresponding to this is selected. be registered.
  • the position list input field 54 is a field that is included in the position list 46 and is used to enter the position at which the recording of the operation position information 47 starts and the position at which the recording ends. In the position list input field 54, a target position aligned with the processing order is automatically registered in conjunction with the content input to the operation order list input field 52.
  • the determination key 55 is a key that is pressed when the input content is determined. The operator can easily perform the operation setting of the work work apparatus 20 by inputting various information to the list content input screen 50 without using, for example, a teaching pendant or the like.
  • FIG. 5 is a flowchart showing an example of the work execution routine executed by the CPU 42 of the control device 40.
  • FIG. 6 is a flowchart showing an example of an operation position storage processing routine executed by the CPU 42 of the control device 40. The motion position storage processing routine of FIG. 6 is executed by the CPU 42 in parallel with the work execution routine.
  • FIG. 7 is an explanatory view showing an example of the work on the work W which the work work apparatus 20 executes based on the contents of FIG.
  • FIG. 8 is an explanatory view showing an example of the forward feeding process (FIG. 8A) and the reverse feeding process (FIG. 8B) after halfway stop.
  • the work execution routine and the operation position storage processing routine are stored in the storage unit 43 and executed in response to a start instruction by the worker.
  • the operation position storage processing routine of FIG. 6 will be described.
  • the CPU 42 reads and acquires the position list 46 from the storage unit 43 (S200), and operates whether or not the collecting member 32 has reached the recording start position of the operation position information 47. The determination is made based on the progress status of the order list 44 (S210).
  • the CPU 42 stands by as it is.
  • the current processing order and operation position are stored in the storage unit 43 as operation position information 47 (S220).
  • the CPU 42 determines whether or not the collecting member 32 has reached the recording end position based on the progress status of the operation order list 44 (S230).
  • the CPU 42 continues the process of S220, but deletes the operation position information 47 from the storage unit 43 when the collecting member 32 reaches the recording end position (S240) It is determined whether the series operation has been completed (S250). When the series operation is not completed, the CPU 42 executes the processing of S210 and after, and when the series operation is completed, this routine is ended as it is. As described above, in the control device 40, the operation position information 47 is stored in the storage unit 43 during the work determined by the worker.
  • the CPU 42 reads and acquires the operation order list 44 and the work type list 45 from the storage unit 43 (S100), and determines whether the operation position information 47 is stored in the storage unit 43 or not. It determines (S110).
  • the CPU 42 executes the sequential feeding process (S120 to S140). Specifically, the CPU 42 acquires the work type according to the processing order from the operation order list 44 (S120), acquires the work content corresponding to the acquired work type from the work type list 45, and the work work apparatus 20 Is executed (S130). For example, the CPU 42 acquires the work type “move” in process order 1 shown in FIG.
  • the CPU 42 determines whether or not all the set operations have been completed based on whether or not the last work of the operation order list 44 has been executed (S140), and when the operation is not completed, The process after S120 is performed. That is, the work type “move” of the processing order 2 is acquired, and the processing of moving the collecting member 32 to the target position B is performed by the work operation apparatus 20 (see FIG. 7). Such processing is repeated, the CPU 42 picks up the work W at the position B, moves the positions C to E, releases the work W at the position E, and moves the collecting member 32 to the position F. On the other hand, when the operation is completed in S140, this routine is ended as it is.
  • the CPU 42 determines that it is the operation return after being interrupted in the middle of the last series of operations, and executes the reverse processing. (S150 to S170). Specifically, the CPU 42 sets coordinates in the processing order included in the operation position information 47 as start coordinates, acquires the work type according to the processing order reverse to the operation order list 44 (S150), and corresponds to the acquired work type The work content at the time of reverse feed processing is acquired from the work type list 45, and the work work apparatus 20 is made to execute the work (S160).
  • the CPU 42 determines whether or not all the set operations have been completed based on whether or not the first work of the operation order list 44 has been executed (S170), and when the operation is not completed, The processing of S150 and thereafter is executed.
  • S170 the first work of the operation order list 44 has been executed
  • the processing of S150 and thereafter is executed.
  • FIG. 8A the case where the operation is interrupted during movement to the position D in the processing order 5 (see FIG. 3) will be described as an example.
  • the reason for interrupting the operation may be, for example, when the operator operates the emergency stop key, or when a sensor or the like detects that an object such as the worker has entered the work area.
  • the operation position information 47 is temporarily stored between the recording start position and the recording end position.
  • the operation position information 47 is not stored in the storage unit 43 other than at the time of interruption. Therefore, at the time of work start, the CPU 42 can determine whether or not it is the reverse feed process after cancellation of the interruption depending on the presence or absence of the operation position information 47.
  • the CPU 42 acquires the work type “move to previous target position” in the processing order 5 from the work type list 45 based on the operation position information 47 and proceeds from the start coordinates (Xa, Ya, Xa) to the front.
  • a process of moving the collecting member 32 to the target position C is performed by the work operation device 20 (see FIG. 8B).
  • control device 40 can easily switch and execute the forward process and the reverse process after the operation is interrupted using the operation order list 44, the work type list 45, the position list 46 and the operation position information 47. .
  • the collection member 32 of the present embodiment corresponds to a work member of the present disclosure
  • the work execution unit 28 corresponds to a work execution unit
  • the storage unit 43 corresponds to a storage unit
  • the control unit 41 corresponds to a control unit.
  • the operation order list 44 corresponds to the operation order list
  • the work type list 45 corresponds to the work type list
  • the position list 46 corresponds to the position list
  • the operation position information 47 corresponds to the operation position information.
  • the control device 40 corresponds to a control device
  • the work work device 20 corresponds to a work work device
  • the work work system 10 corresponds to a work work system.
  • an example of the control method of the present disclosure is also clarified.
  • the operation order list 44 including the work type and the work position of the work execution unit 28 regarding the operation order of the work type, the work type at the time of forward feed processing and the work at reverse feed processing
  • the storage unit 43 stores a work type list 45 defined as a pair with a type, a position list 46 regarding the recording of the operation position of the work execution unit 28 performed at the time of the forward processing, and the operation position information 47. Further, in the control device 40, the work execution unit is controlled based on the order of the operation order list and the work type at the time of the process type list advance processing in the forward processing, and the operation position information 47 and the operation order list in the reverse processing.
  • the work execution unit 48 is controlled based on the reverse order of 44 and the work type at the time of reverse processing of the work type list 45. For example, when the work apparatus 20 moves and places the work W, when performing gripping of the work W and movement of the work W in the sequential feeding process, the reverse feeding process at the time of operation return etc. is simply executed. If this happens, work such as movement of the workpiece and gripping of the workpiece will be performed, so some measures will be required during reverse feed processing.
  • the operator defines the operation order of the work type in the operation order list 44, and defines in the work type list 45 the work type at the time of forward feed processing and the work type at the reverse feed processing as a pair.
  • the device can replace work automatically and can execute. Therefore, in the control device 40, it is not necessary to separately prepare complicated handling (for example, a program and the like) regarding the reverse feeding process, and the reverse feeding process can be realized more easily. Further, since the control device 40 can grasp the current position of the work execution unit 28 by using the position list 46, the reverse feeding process can be executed more reliably. Furthermore, in the control device 40, whether or not the reverse feed process can be performed between the recording start position registered in the position list 46 and the recording end position depending on the presence or absence of the operation position information 47 deleted when the series operation is completed. Can be determined more easily.
  • control device 40 executes the reverse feed process when the work execution unit 28 performs the return operation after the error stop, the operation return can be realized more easily.
  • the work execution unit 28 has the collection member 32 and moves the work W
  • the storage unit 43 is a pair of the work W collection operation and the work W collection cancellation operation
  • the movement target position of the work A work type list 45 defined including one or more of a pair of the movement operation to the movement target position of the previous work type and the movement operation to the movement target position of the previous work type is stored.
  • the reverse operation can be executed by automatically replacing the sampling operation and the moving operation.
  • the work work apparatus 20 moves the work member that performs the predetermined work on the work W, and controls the work execution unit 28 that executes the predetermined work on the work W, and the above-described control that controls the work execution unit 28 And an apparatus 40.
  • the work execution unit 28 is an articulated robot that has the collecting member 32 and moves the work W. For example, in a multi-joint robot, work such as teaching may be required for operation recovery and the like, but this work work apparatus 20 can easily realize reverse feed processing without such work. it can.
  • the work system 10 includes a plurality of the work devices 20 described above.
  • the work work device 20 can easily realize the forward processing and the reverse processing, and the reverse processing can be reliably executed by each work device 20. Interference of the work work device 20 can be prevented.
  • whether the forward processing or the reverse processing is determined based on the presence or absence of the operation position information 47 is not particularly limited thereto, and information (for example, a flag) to that effect when an error is stopped May be stored. Also by this control device, it is possible to obtain the same effect as the embodiment described above.
  • the work work apparatus 20 has mainly been described as performing the work of moving the work W, but the invention is not particularly limited thereto.
  • the work work apparatus 20 is a work member that performs a predetermined work on the work W Can be used to perform various tasks.
  • the work work apparatus 20 may be moved from the supply position to the inspection position and then moved to the sorting position.
  • the work work device 20 may perform one or more work on one or more works W.
  • the work work apparatus 20 takes out a bolt as the work W, moves it, assembles it to the main body as another work W, and then inserts a washer as the work W into the bolt.
  • the fastening operation of tightening the nut as the work W may be performed.
  • the CPU 42 may store one or more pieces of operation position information 47 for each work.
  • the control device 40 since the operation order list 44, the work type list 45, the position list 46, and the like are used, settings for executing a plurality of works and a plurality of types of work can be performed more easily.
  • the work type list 45 includes information in which “collection” and “collection cancellation” are paired, but it is not particularly limited thereto.
  • the work W collected by the collecting member 32 may be dropped when the error stops or may be removed by the worker.
  • the processing for releasing the work W at the supply position is performed and returned, but various measures can be considered such as returning the work W to the initial position.
  • reverse feed processing may be appropriately registered according to the production.
  • the work execution unit 28 has been described as an articulated robot in the above-described embodiment, the invention is not particularly limited to this, as long as it is a structure that performs forward feeding processing and reverse feeding processing on a working member. It does not have to be the case, and may not have an arm.
  • control device 40 has been described as controlling the work execution unit 28 of the work work device 20 in the embodiment described above, the present invention is not particularly limited thereto.
  • the control device 40 performs reverse feed set on offline A process may be performed to control a simulator that operates a work execution unit of electronic data. That is, the present disclosure may be implemented as a control method that the control device 40 executes.
  • FIG. 9 is an explanatory view showing an example of a simulator image displayed on the display unit 48. As shown in FIG. This simulator image is an image generated by the 3D-CAD motion simulator program. In this control device 40, the recovery operation from the error stop at any timing can be confirmed on the screen before actually working with the work work device 20.
  • control device 40 has been described as a computer connected to the outside of the work work device 20 in the embodiment described above, the present invention is not particularly limited thereto.
  • a controller provided in the work work device 20 may be used as the control device 40.
  • control device the work operation device, the work operation system, and the control method disclosed herein can be used in the technical field of an apparatus that performs a predetermined operation on a work.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

制御装置は、ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部を備えたワーク作業装置に用いられる装置である。この制御装置は、作業実行部の作業種と作業位置とを含み作業種の動作順に関する動作順リストと、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リストとを記憶する記憶部と、順送り処理時には動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて作業実行部を制御すると共に、逆送り処理時には動作順リストの逆の順番及び作業種リストの逆送り処理時の作業種に基づいて作業実行部を制御する制御部とを備えたものである。

Description

制御装置、ワーク作業装置、ワーク作業システム及び制御方法
　本明細書では、制御装置、ワーク作業装置、ワーク作業システム及び制御方法を開示する。
　従来、ロボットアームを有するワーク作業装置としては、例えば、動作区間が後退移動区間であるときには、動作経路命令を記憶部に記憶させ、中断停止入力があり、動作区間が後退移動区間であるときに記憶部に記憶された動作経路命令を逆順に実行したあと、退避点に復帰させるものが提案されている（例えば、特許文献１参照）。この装置では、ロボットアームがワークに干渉することなく退避点まで迅速に移動することができるとしている。
特開２００８－２５４１４１号公報
　ところで、ロボットアームでは、ワークを把持する動作や、ワークの把持を解除する動作を行い、ワークを移動させる場合がある。上述した特許文献１では、退避点に移動するまで逆順で移動することは考慮されているが、逆順で実行できない処理などについては、考慮されていなかった。このため、逆送り処理において、個別にロボットプログラムを作成するなど対処しなければならず、稼働復帰などの際に煩雑な処理が必要であった。
　本開示は、このような課題に鑑みなされたものであり、より容易に逆送り処理を実現することができる制御装置、ワーク作業装置、ワーク作業システム及び制御方法を提供することを主目的とする。
　本開示では、上述の主目的を達成するために以下の手段を採った。
　本開示の制御装置は、
　ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部を備えたワーク作業装置に用いられる制御装置であって、
　前記作業実行部の作業種と作業位置とを含み該作業種の動作順に関する動作順リストと、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リストとを記憶する記憶部と、
　順送り処理時には前記動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて前記作業実行部を制御すると共に、逆送り処理時には前記動作順リストの逆の順番及び前記作業種リストの逆送り処理時の作業種に基づいて前記作業実行部を制御する制御部と、
　を備えたものである。
　この制御装置では、作業実行部の作業種と作業位置とを含み作業種の動作順に関する動作順リストと、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リストとを記憶する。また、この制御装置では、順送り処理時には動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて作業実行部を制御すると共に、逆送り処理時には動作順リストの逆の順番及び作業種リストの逆送り処理時の作業種に基づいて作業実行部を制御する。例えば、ワーク作業装置がワークを移動載置するものである場合、ワークの把持、ワークの移動を順送り処理で実行する際において、稼働復帰時などの逆送り処理を単純に実行してしまうと、ワークの移動、ワークの把持との作業を実行してしまうため、逆送り処理時には何らかの対策を要することとなる。本開示の制御装置では、作業者は、作業種の動作順を動作順リストに規定し、順送り処理時の作業種と逆送り処理時の作業種とを対にして作業種リストに規定しておけば、稼働復帰時などの逆送り処理においては、装置が自動で作業を置き換えて実行可能である。したがって、この制御装置では、逆送り処理に関する煩雑な対処（例えばプログラムなど）を別途用意する必要がなく、より容易に逆送り処理を実現することができる。
　本開示の制御装置において、前記記憶部は、前記順送り処理時に実行された前記作業実行部の動作位置の記録に関する位置リストを記憶し、前記制御部は、前記作業実行部の動作開始時に前記位置リストに基づいて前記逆送り処理を実行するものとしてもよい。この制御装置では、位置リストを利用することにより、現在の作業実行部の位置を把握可能であるから、より確実に逆送り処理を実行することができる。
　位置リストを記憶する本開示の制御装置において、前記制御部は、前記順送り処理時に実行された前記作業実行部の動作位置を前記位置リストに含まれる記録開始位置から動作位置情報として前記記憶部に記憶させ、前記位置リストに含まれる記録終了位置に至ると該動作位置情報を削除し、前記作業実行部の動作開始時に前記動作位置情報が記憶されているときには、該動作位置情報に含まれる動作位置から前記逆送り処理を実行するよう前記作業実行部を制御するものとしてもよい。この制御装置では、動作位置情報の存在の有無によって、位置リストに登録された記録開始位置から記録終了位置までの間における逆送り処理の実行の可否をより容易に判定することができる。
　本開示の制御装置において、前記制御部は、前記作業実行部がエラー停止したのち復帰動作する際に前記逆送り処理を実行するよう前記作業実行部を制御するものとしてもよい。この制御装置では、より容易に稼働復帰を実現することができる。
　本開示の制御装置において、前記作業部材は、前記ワークを採取処理する採取部材であり、前記作業実行部は、前記採取部材を有し前記ワークを移動させる採取移動部であり、前記記憶部は、前記ワークの採取動作と前記ワークの採取解除動作との対と、前記ワークの移動目標位置への移動動作と１つ前の作業種の移動目標位置への移動動作との対とのうち１以上を含んで規定される前記作業種リストを記憶するものとしてもよい。この制御装置では、採取動作や、移動動作を自動で置き換えて逆送り処理を実行することができる。
　本開示のワーク作業装置は、ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部と、前記作業実行部を制御する上述したいずれかに記載の制御装置と、を備えたものである。このワーク作業装置では、上述した制御装置と同様に、作業者は、作業種の動作順を動作順リストに規定し、順送り処理時の作業種と逆送り処理時の作業種とを対にして作業種リストに規定しておけば、稼働復帰時などの逆送り処理においては、装置が自動で作業を置き換えて実行可能である。したがって、このワーク作業装置では、逆送り処理に関する煩雑な対処（例えばプログラムなど）を別途用意する必要がなく、より容易に逆送り処理を実現することができる。
　本開示のワーク作業装置において、前記作業部材は、前記ワークを採取処理する採取部材であり、前記作業実行部は、前記採取部材を有し前記ワークを移動させる採取移動部であるものとしてもよい。例えば、採取移動部としての多関節ロボットなどにおいては、稼働復帰などについてもティーチングなどの作業を要する場合があるが、本開示のワーク作業装置では、このような作業を要さず、容易に逆送り処理を実現することができる。
　本開示のワーク作業システムは、上述したいずれかのワーク作業装置を複数備えたものである。このワーク作業システムでは、順送り処理と逆送り処理とを容易に実現することができ、例えば複数のワーク作業装置の干渉なども防止することができる。
　本開示の制御方法は、
　ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部を備えたワーク作業装置に用いられる制御方法であって、
　前記作業実行部の作業種と作業位置とを含み該作業種の動作順に関する動作順リストと、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リストとが記憶部に記憶されており、
　順送り処理時には前記動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて前記作業実行部を制御すると共に、逆送り処理時には前記動作順リストの逆の順番及び前記作業種リストの逆送り処理時の作業種に基づいて前記作業実行部を制御するステップ、
　を含むものである。
　この制御方法では、上述した制御装置と同様に、作業者は、作業種の動作順を動作順リストに規定し、順送り処理時の作業種と逆送り処理時の作業種とを対にして作業種リストに規定しておけば、稼働復帰時などの逆送り処理においては、装置が自動で作業を置き換えて実行可能である。したがって、この制御方法では、より容易に逆送り処理を実現することができる。なお、この制御方法において、上述した制御装置の態様を採用してもよいし、上述した制御装置の機能を発現するステップを含むものとしてもよい。
ワーク作業システム１０の一例を示す概略説明図。 ワーク作業装置２０の一例を示す斜視図。 記憶部４３に記憶された情報の説明図。 リスト内容入力画面５０の説明図。 作業実行ルーチンの一例を示すフローチャート。 動作位置記憶処理ルーチンの一例を示すフローチャート。 ワークＷに対する作業の一例を示す説明図。 順送り処理と途中停止後の逆送り処理の一例を示す説明図。 表示部４８に表示されるシミュレータ画像の一例を示す説明図。
　本明細書で開示するワーク作業システム１０の実施形態を図面を参照しながら以下に説明する。図１は、ワーク作業システム１０の一例を示す概略説明図である。図２は、ワーク作業装置２０の一例を示す斜視図である。図３は、記憶部４３に記憶された動作順リスト４４、作業種リスト４５、位置リスト４６及び動作位置情報４７の説明図である。ワーク作業システム１０は、作業対象の物品（ワークＷ）に対して所定作業を行うワーク作業装置２０を複数備えて構成されている。ワーク作業システム１０は、１以上のワーク作業装置２０と、ワーク作業装置２０が配設される基台１１と、ワークＷ（図２参照）を配置する配置部材１５を作業領域へ搬送及び固定する搬送部１２と、制御装置４０からの指令を入力するシステムインターフェイス（Ｉ／Ｆ）１４とを備えている。ここでは、ワーク作業システム１０がワークＷを供給位置から配置位置（配置部材１５）へ移動させる作業を行うことを一例として説明する。なお、ワーク作業システム１０の左右方向（Ｘ軸）、前後方向（Ｙ軸）及び上下方向（Ｚ軸）は、図１に示した通りとする。また、ワーク作業装置２０は全方位に可動するため固定される特定の方向はないが、説明の便宜のため、ワーク作業装置２０に対しては、図２に示した方向を左右方向（Ｘ軸）、前後方向（Ｙ軸）及び上下方向（Ｚ軸）として説明する。
　ワーク作業装置２０は、作業対象の物品に対して所定の作業を行う装置として構成されている。作業対象の物品は、特に限定されないが、例えば、機械部品、電気部品、電子部品、化学部品など各種の部品のほか、食品、バイオ、生物関連の物品などが挙げられる。また、所定の作業としては、例えば、供給位置から目的位置まで採取、移動、配置する移動作業や、部品を組み付ける組付け作業、加工を施す加工作業、粘性材料を塗布する塗布作業、加熱する加熱作業、化学的及び／又は物理的な所定処理を行う処理作業及び検査を行う検査作業などが挙げられる。組付け作業としては、例えば、ネジ、ボルトなどの締結部材の締結作業や、コネクタの挿入作業、配線に関する取回し作業、部品のはめ込み作業、部材の取付作業、ワークを押さえる押さえ付け作業などが挙げられる。加工作業としては、研削作業、切削作業、変形作業、接続作業、接合作業などが挙げられる。粘性材料としては、接着剤やはんだペースト、グリスなどが挙げられる。検査作業としては、例えば、上述した１以上の作業結果を検査する作業などが挙げられ、ワークＷの移動作業を伴うものとしてもよい。
　このワーク作業装置２０は、多関節アームロボットとして構成されており、図２に示すように、第１アーム２１と、第２アーム２２と、第３支持部２３と、台座部２４と、エンドエフェクタ３０とを備えている。第１アーム２１の先端には、エンドエフェクタ３０が第１駆動部２１ａを介して回動可能に配設されている。第２アーム２２の先端には、第２駆動部２２ａを介して第１アーム２１が回動可能に配設されている。第３支持部２３の先端には、第３駆動部２３ａを介して第２アーム２２が回動可能に配設されている。第３支持部２３は、台座駆動部２５を介して台座部２４により軸回転可能に支持されている。これらのアーム及び駆動部によって、ワークＷを採取し移動作業を行う作業実行部２８が構成されている。エンドエフェクタ３０は、ワークＷを採取するものであり、採取部材３２を有する。採取部材３２は、ワークＷを把持して採取する作業部材であり、作業実行部２８により移動される。なお、採取部材３２は、負圧によりワークＷを採取する吸着ノズルとしてもよい。
　制御装置４０は、ワーク作業システム１０に含まれるワーク作業装置２０の全体を制御するコンピュータである。この制御装置４０は、制御部４１と、記憶部４３と、表示部４８とを備えている。制御部４１は、ＣＰＵ４２を中心とするマイクロプロセッサとして構成されている。制御部４１は、第１駆動部２１ａ、第２駆動部２２ａ、第３駆動部２３ａ、台座駆動部２５及びエンドエフェクタ３０などへ駆動信号を出力する。記憶部４３は、例えば、ＨＤＤなど、大容量の記憶装置として構成されている。記憶部４３には、図３に示すように、ワーク作業装置２０を制御するのに用いる動作順リスト４４、作業種リスト４５、位置リスト４６及び動作位置情報４７などが記憶されている。表示部４８は、ワーク作業装置２０に関する情報を含む画面を表示するものであり、例えば液晶ディスプレイである。
　動作順リスト４４には、ワーク作業装置２０の作業種の動作順に関する処理順や作業種、作業位置などの情報が含まれる。作業位置は、ワークＷの位置としてもよいし、作業部材（採取部材３２）の位置としてもよく、座標は異なるもののこれらは同義として取り扱うことができる。ここでは、説明の便宜のため、採取部材３２の位置を主に作業位置として説明する。作業種リスト４５には、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される情報が含まれる。位置リスト４６には、順送り処理時に実行された作業実行部２８の動作位置の記録に関する情報が含まれる。この位置リスト４６には、特定の目標位置とこの目標位置に採取部材３２が到達したときに実行される処理として、動作位置情報４７の記録開始と、記録終了とが含まれている。動作位置情報４７は、位置リスト４６に基づいて記録される情報であり、動作時の処理順と位置座標とを対応付けた情報である。この動作位置情報４７は、位置リスト４６の記録終了の位置に採取部材３２が至ると記憶部４３から削除される一時データである。制御部４１は、作業種リスト４５の順送り時に規定された作業内容を用い、動作順リスト４４に規定された作業種を処理順に実行するようプログラムされている。一方、制御部４１は、動作位置情報４７が記憶されているときに作業種リスト４５の逆送り時に規定された作業内容を用い、動作順リスト４４に規定された作業種を処理順の逆に実行するようプログラムされている。
　次に、このように構成されたワーク作業システム１０を利用するの作業について説明する。まず、動作順リスト４４、作業種リスト４５及び位置リスト４６の内容を入力する処理について説明する。図４は、制御装置４０の表示部４８に表示されるリスト内容入力画面５０の説明図である。リスト内容入力画面５０には、カーソル５１や動作順リスト入力欄５２、作業種リスト登録欄５３、位置リスト入力欄５４、決定キー５５などが配置されている。カーソル５１は、入力位置や各種キーを選択するものであり、制御装置４０に接続されたマウスやキーボードに連動して動作する。動作順リスト入力欄５２は、動作順リスト４４に含まれる情報を入力する領域であり、処理順や作業種（コマンド）、作業位置（Ｘ，Ｙ，Ｚ座標）などの情報を入力する欄である。作業種リスト登録欄５３は、作業種リスト４５に含まれる、送り処理時の作業種と逆送り処理時の作業種とを対にして登録する欄である。作業種（コマンド）には、予め、順送り処理時の作業内容が定められており、この欄では、順送り処理時の作業種が選択されたのち、これに対応する逆送り処理時の作業種が登録される。図４において、「採取」の逆送り処理時には「採取解除」が登録されているため、ワーク作業装置２０では逆送り処理時には採取解除の作業を行うが、例えば、何も実行しない「－」を登録すれば、採取解除せずに逆送り処理を実行する設定となる。位置リスト入力欄５４は、位置リスト４６に含まれる、動作位置情報４７を記録開始する位置と記録終了する位置を入力する欄である。この位置リスト入力欄５４は、動作順リスト入力欄５２への入力内容に連動し処理順に合わせた目標位置が自動で登録される。図４では、動作位置情報４７の記録を１回行う設定であるが、記録開始、記録終了位置を複数設け、動作位置情報４７を複数回記録させる設定にすることもできる。決定キー５５は、入力内容で確定する際に押下されるキーである。作業者は、例えば、ティーチングペンダントなどを使用せずに、このリスト内容入力画面５０へ各種情報を入力することにより、ワーク作業装置２０の動作設定を容易に行うことができる。
　次に、こうして構成された本実施形態のワーク作業システム１０の動作、特に、順送り処理及び逆送り処理に関する動作について説明する。ここでは、ワーク作業装置２０がワークＷを配置部材１５へ配列固定させる処理を一例として説明する。図５は、制御装置４０のＣＰＵ４２により実行される作業実行ルーチンの一例を示すフローチャートである。図６は、制御装置４０のＣＰＵ４２により実行される動作位置記憶処理ルーチンの一例を示すフローチャートである。図６の動作位置記憶処理ルーチンは、作業実行ルーチンと並列でＣＰＵ４２により実行される。また、図７は、図３の内容に基づいてワーク作業装置２０が実行するワークＷに対する作業の一例を示す説明図である。図８は、順送り処理（図８Ａ）と途中停止後の逆送り処理（図８Ｂ）の一例を示す説明図である。作業実行ルーチンや動作位置記憶処理ルーチンは、記憶部４３に記憶され、作業者による開始指示により実行される。
　まず、図６の動作位置記憶処理ルーチンから説明する。この動作位置記憶処理ルーチンが開始されると、ＣＰＵ４２は、位置リスト４６を記憶部４３から読み出して取得し（Ｓ２００）、動作位置情報４７の記録開始位置に採取部材３２が至っているか否かを動作順リスト４４の進行状況に基づいて判定する（Ｓ２１０）。記録開始位置に採取部材３２が至っていないときには、ＣＰＵ４２は、そのまま待機する。一方、記録開始位置に採取部材３２が至ったときには、現在の処理順及び動作位置を動作位置情報４７として記憶部４３に記憶させる（Ｓ２２０）。次に、ＣＰＵ４２は、記録終了位置に採取部材３２が至っているか否かを動作順リスト４４の進行状況に基づいて判定する（Ｓ２３０）。記録終了位置に採取部材３２が至っていないときには、ＣＰＵ４２は、Ｓ２２０の処理を継続する一方、記録終了位置に採取部材３２が至ったときには、動作位置情報４７を記憶部４３から削除し（Ｓ２４０）、一連動作が完了したか否かを判定する（Ｓ２５０）。一連動作が完了していないときには、ＣＰＵ４２は、Ｓ２１０以降の処理を実行し、一連動作が完了したときにはこのルーチンをそのまま終了する。このように、制御装置４０では、作業者により定められた作業の間、動作位置情報４７を記憶部４３に記憶させる。
　次に、図５の作業実行ルーチンについて説明する。作業実行ルーチンが開始されると、ＣＰＵ４２は、動作順リスト４４及び作業種リスト４５を記憶部４３から読み出して取得し（Ｓ１００）、動作位置情報４７が記憶部４３に記憶されているか否かを判定する（Ｓ１１０）。動作位置情報４７が記憶部４３に記憶されていないときには、ＣＰＵ４２は、順送り処理を実行する（Ｓ１２０～Ｓ１４０）。具体的には、ＣＰＵ４２は、動作順リスト４４から処理順にしたがって作業種を取得し（Ｓ１２０）、取得した作業種に対応する作業内容を作業種リスト４５から取得し、ワーク作業装置２０にその作業を実行させる（Ｓ１３０）。例えば、ＣＰＵ４２は、図３に示す、処理順１の作業種「移動」を取得し、目標位置Ａへ採取部材３２を移動する処理をワーク作業装置２０に実行させる（図７参照）。次に、ＣＰＵ４２は、設定されている動作が全て完了したか否かを動作順リスト４４の最後の作業まで実行されたか否かに基づいて判定し（Ｓ１４０）、動作が完了していないときには、Ｓ１２０以降の処理を実行する。即ち、処理順２の作業種「移動」を取得し、目標位置Ｂへ採取部材３２を移動する処理をワーク作業装置２０に実行させる（図７参照）。このような処理を繰り返し、ＣＰＵ４２は、位置ＢでワークＷを採取させ、位置Ｃ～Ｅを移動させ、位置ＥでワークＷを採取解除し、位置Ｆへ採取部材３２を移動させる。一方、Ｓ１４０で動作が完了したときには、そのままこのルーチンを終了する。
　一方、Ｓ１１０で、記憶部４３に動作位置情報４７が記憶されているときには、ＣＰＵ４２は、前回の一連動作の途中で中断されたのちの稼働復帰であるものと判定し、逆送り処理を実行する（Ｓ１５０～Ｓ１７０）。具体的には、ＣＰＵ４２は、動作位置情報４７に含まれる処理順における座標を開始座標とし、動作順リスト４４の逆の処理順にしたがって作業種を取得し（Ｓ１５０）、取得した作業種に対応する逆送り処理時の作業内容を作業種リスト４５から取得し、ワーク作業装置２０にその作業を実行させる（Ｓ１６０）。次に、ＣＰＵ４２は、設定されている動作が全て完了したか否かを動作順リスト４４の最初の作業まで実行されたか否かに基づいて判定し（Ｓ１７０）、動作が完了していないときには、Ｓ１５０以降の処理を実行する。例えば、図８Ａのように、処理順５の位置Ｄへの移動中（図３参照）に動作が中断された場合を一例として説明する。動作の中断理由としては、例えば、作業者が緊急停止キーを操作した場合や、作業者など何らかの物体の作業領域への浸入がセンサーなどで検出された場合などが挙げられる。制御装置４０では、位置リスト４６に基づき、記録開始位置から記録終了位置の間において動作位置情報４７が一時記憶される。このため、動作位置情報４７は、中断時以外には記憶部４３に保存されない。したがって、ＣＰＵ４２は、作業開始時において、動作位置情報４７の有無によって、中断解除後の逆送り処理であるか否かを判定することができる。この逆送り処理では、例えば、ＣＰＵ４２は動作位置情報４７に基づき、処理順５の作業種「前目標位置へ移動」を作業種リスト４５から取得し、開始座標（Ｘａ，Ｙａ，Ｘａ）から前目標位置Ｃへ採取部材３２を移動する処理をワーク作業装置２０に実行させる（図８Ｂ参照）。このような処理を繰り返し、ＣＰＵ４２は、位置Ｃから位置Ｂへ採取部材３２を移動させ、位置ＢでワークＷを採取解除させ、位置Ａへ採取部材３２を移動させる。一方、Ｓ１７０で動作が完了したときには、そのままこのルーチンを終了する。このように、制御装置４０は、動作順リスト４４、作業種リスト４５、位置リスト４６及び動作位置情報４７を用い、順送り処理及び動作中断後の逆送り処理を簡便に切り替えて実行することができる。
　ここで、本実施形態の構成要素と本発明の構成要素との対応関係を明らかにする。本実施形態の採取部材３２が本開示の作業部材に相当し、作業実行部２８が作業実行部に相当し、記憶部４３が記憶部に相当し、制御部４１が制御部に相当する。また、動作順リスト４４が動作順リストに相当し、作業種リスト４５が作業種リストに相当し、位置リスト４６が位置リストに相当し、動作位置情報４７が動作位置情報に相当する。また、制御装置４０が制御装置に相当し、ワーク作業装置２０がワーク作業装置に相当し、ワーク作業システム１０がワーク作業システムに相当する。なお、本実施形態では、制御装置４０の動作を説明することにより本開示の制御方法の一例も明らかにしている。
　以上説明した本実施形態の制御装置４０では、作業実行部２８の作業種と作業位置とを含み作業種の動作順に関する動作順リスト４４と、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リスト４５と、順送り処理時に実行された作業実行部２８の動作位置の記録に関する位置リスト４６と、動作位置情報４７とを記憶部４３に記憶する。また、この制御装置４０では、順送り処理時には動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて作業実行部を制御すると共に、逆送り処理時には動作位置情報４７や動作順リスト４４の逆の順番及び作業種リスト４５の逆送り処理時の作業種に基づいて作業実行部４８を制御する。例えば、ワーク作業装置２０がワークＷを移動載置するものである場合、ワークＷの把持、ワークＷの移動を順送り処理で実行する際において、稼働復帰時などの逆送り処理を単純に実行してしまうと、ワークの移動、ワークの把持という作業を実行してしまうため、逆送り処理時には何らかの対策を要することとなる。制御装置４０では、作業者は、作業種の動作順を動作順リスト４４に規定し、順送り処理時の作業種と逆送り処理時の作業種とを対にして作業種リスト４５に規定しておけば、稼働復帰時などの逆送り処理においては、装置が自動で作業を置き換えて実行可能である。したがって、制御装置４０では、逆送り処理に関する煩雑な対処（例えばプログラムなど）を別途用意する必要がなく、より容易に逆送り処理を実現することができる。また、制御装置４０では、位置リスト４６を利用することにより、現在の作業実行部２８の位置を把握可能であるから、より確実に逆送り処理を実行することができる。更に、制御装置４０では、一連動作が完了すると削除される動作位置情報４７の存在の有無によって、位置リスト４６に登録された記録開始位置から記録終了位置までの間における逆送り処理の実行の可否をより容易に判定することができる。
　また、制御装置４０は、作業実行部２８がエラー停止したのち復帰動作する際に逆送り処理を実行するため、より容易に稼働復帰を実現することができる。更に、作業実行部２８は、採取部材３２を有しワークＷを移動させるものであり、記憶部４３は、ワークＷの採取動作とワークＷの採取解除動作との対と、ワークの移動目標位置への移動動作と１つ前の作業種の移動目標位置への移動動作との対とのうち１以上を含んで規定される作業種リスト４５を記憶する。この制御装置４０では、採取動作や、移動動作を自動で置き換えて逆送り処理を実行することができる。
　また、ワーク作業装置２０は、ワークＷに対して所定作業を実行する作業部材を移動してワークＷに対して所定作業を実行する作業実行部２８と、作業実行部２８を制御する上述した制御装置４０とを備えたものである。このワーク作業装置２０では、上述した制御装置４０と同様に、逆送り処理に関する煩雑な対処を別途用意する必要がなく、より容易に逆送り処理を実現することができる。また、作業実行部２８は、採取部材３２を有しワークＷを移動させる多関節ロボットである。例えば、多関節ロボットにおいては、稼働復帰などについてもティーチングなどの作業を要する場合があるが、このワーク作業装置２０では、このような作業を要さず、容易に逆送り処理を実現することができる。
　また、ワーク作業システム１０は、上述したワーク作業装置２０を複数備えたものである。このワーク作業システム１０では、ワーク作業装置２０が順送り処理と逆送り処理とを容易に実現することができ、且つ逆送り処理を各々のワーク作業装置２０で確実に実行することができるから、複数のワーク作業装置２０の干渉なども防止することができる。
　なお、本開示は上述した実施形態に何ら限定されることはなく、本開示の技術的範囲に属する限り種々の態様で実施し得ることはいうまでもない。
　例えば、上述した実施形態では、動作位置情報４７の有無によって、順送り処理か逆送り処理かを判定するものとしたが、特にこれに限定されず、エラー停止時にその旨の情報（例えばフラグ）などを記憶するものとしてもよい。この制御装置によっても、上述した実施形態と同様の効果を得ることができる。
　上述した実施形態では、ワーク作業装置２０は、ワークＷの移動作業を行うものとして主として説明したが、特にこれに限定されず、ワーク作業装置２０は、ワークＷに対して所定作業を行う作業部材を移動するものとすれば、様々な作業を実行するものとしてもよい。例えば、ワーク作業装置２０は、供給位置から配置位置へ移動するものとして説明したが、ワークＷを供給位置から検査位置へ移動し、その後仕分け位置へ移動するものとしてもよい。また、ワーク作業装置２０は、１以上のワークＷに対して１以上の作業を行うものとしてもよい。例えば、ワーク作業装置２０は、ワークＷとしてのボルトを採取、移動作業し、別のワークＷとしての本体にこれを組み付ける組付け作業を行ったのち、ワークＷとしてのワッシャをボルトに挿入作業し、ワークＷとしてのナットを締める締結作業を実行するものとしてもよい。このとき、ＣＰＵ４２は、各作業に対し、１以上の動作位置情報４７を記憶するものとしてもよい。この制御装置４０では、動作順リスト４４や作業種リスト４５、位置リスト４６などを用いるため、複数のワークや複数種の作業を実行する設定をより容易に行うことができる。
　上述した実施形態では、作業種リスト４５において、「採取」と「採取解除」とを対にした情報を含むものとしたが、特にこれに限定されない。例えば、エラー停止後の逆送り処理においては、採取部材３２に採取されたワークＷは、エラー停止時に落とされたり、作業者により取り除かれている場合もある。上記実施形態では、ワークＷを供給位置で採取解除して戻す処理としたが、初期位置まで採取したまま戻すなど、様々な対処が考えられる。作業種リスト４５には、適宜、その生産に合わせた逆送り処理を登録するものとすればよい。
　上述した実施形態では、作業実行部２８を多関節ロボットとして説明したが、特にこれに限定されず、作業部材に対して順送り処理及び逆送り処理を行う構造物であればよく、例えば、多関節でなくてもよいし、アームを備えていないものとしてもよい。
　上述した実施形態では、制御装置４０は、ワーク作業装置２０の作業実行部２８を制御するものとして説明したが、特にこれに限定されず、例えば、制御装置４０は、オフライン上で設定した逆送り処理を電子データの作業実行部を動作させるシミュレータを制御するものとしてもよい。即ち、制御装置４０が実行する制御方法として本開示を実現するものとしてもよい。図９は、表示部４８に表示されるシミュレータ画像の一例を示す説明図である。このシミュレータ画像は、３Ｄ－ＣＡＤ動作シミュレータプログラムにより生成された画像である。この制御装置４０では、実際にワーク作業装置２０で作業させる前に任意のタイミングでのエラー停止からの復帰動作を画面上で確認することができる。
　上述した実施形態では、制御装置４０をワーク作業装置２０の外部に接続されたコンピュータとして説明したが、特にこれに限定されず、例えば、ワーク作業装置２０が備えるコントローラを制御装置４０としてもよい。
　本明細書で開示する制御装置、ワーク作業装置、ワーク作業システム及び制御方法は、ワークに対して所定作業を実行する装置の技術分野に利用可能である。
１０　ワーク作業システム、１１　基台、１２　搬送部、１４　システムインターフェイス（Ｉ／Ｆ）、１５　配置部材、２０　ワーク作業装置、２１　第１アーム、２１ａ　第１駆動部、２２　第２アーム、２２ａ　第２駆動部、２３　第３支持部、２３ａ　第３駆動部、２４　台座部、２５　台座駆動部、２８　作業実行部、３０　エンドエフェクタ、３２　採取部材、４０　制御装置、４１　制御部、４２　ＣＰＵ、４３　記憶部、４４　動作順リスト、４５　作業種リスト、４６　位置リスト、４７　動作位置情報、４８　表示部、５０　リスト内容入力画面、５１　カーソル、５２　動作順リスト入力欄、５３　作業種リスト登録欄、５４　位置リスト入力欄、５５　決定キー、Ｗ　ワーク。

Claims (9)

  1. 　ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部を備えたワーク作業装置に用いられる制御装置であって、
    　前記作業実行部の作業種と作業位置とを含み該作業種の動作順に関する動作順リストと、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リストとを記憶する記憶部と、
    　順送り処理時には前記動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて前記作業実行部を制御すると共に、逆送り処理時には前記動作順リストの逆の順番及び前記作業種リストの逆送り処理時の作業種に基づいて前記作業実行部を制御する制御部と、
    　を備えた制御装置。
  2. 　前記記憶部は、前記順送り処理時に実行された前記作業実行部の動作位置の記録に関する位置リストを記憶し、
    　前記制御部は、前記作業実行部の動作開始時に前記位置リストに基づいて前記逆送り処理を実行する、請求項１に記載の制御装置。
  3. 　前記制御部は、前記順送り処理時に実行された前記作業実行部の動作位置を前記位置リストに含まれる記録開始位置から動作位置情報として前記記憶部に記憶させ、前記位置リストに含まれる記録終了位置に至ると該動作位置情報を削除し、前記作業実行部の動作開始時に前記動作位置情報が記憶されているときには、該動作位置情報に含まれる動作位置から前記逆送り処理を実行するよう前記作業実行部を制御する、請求項２に記載の制御装置。
  4. 　前記制御部は、前記作業実行部がエラー停止したのち復帰動作する際に前記逆送り処理を実行するよう前記作業実行部を制御する、請求項１～３のいずれか１項に記載の制御装置。
  5. 　前記作業部材は、前記ワークを採取処理する採取部材であり、
    　前記作業実行部は、前記採取部材を有し前記ワークを移動させる採取移動部であり、
    　前記記憶部は、前記ワークの採取動作と前記ワークの採取解除動作との対と、前記ワークの移動目標位置への移動動作と１つ前の作業種の移動目標位置への移動動作との対とのうち１以上を含んで規定される前記作業種リストを記憶する、請求項１～４のいずれか１項に記載の制御装置。
  6. 　ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部と、
    　前記作業実行部を制御する請求項１～５のいずれか１項に記載の制御装置と、
    　を備えたワーク作業装置。
  7. 　前記作業部材は、前記ワークを採取処理する採取部材であり、
    　前記作業実行部は、前記採取部材を有し前記ワークを移動させる採取移動部である、請求項６に記載のワーク作業装置。
  8. 　請求項６又は７に記載のワーク作業装置を複数備えたワーク作業システム。
  9. 　ワークに対して所定の作業を実行する作業部材を移動して該ワークに対して所定の作業を実行する作業実行部を備えたワーク作業装置に用いられる制御方法であって、
    　前記作業実行部の作業種と作業位置とを含み該作業種の動作順に関する動作順リストと、順送り処理時の作業種と逆送り処理時の作業種とを対にして規定される作業種リストとが記憶部に記憶されており、
    　順送り処理時には前記動作順リストの順番及び作業種リストの順送り処理時の作業種に基づいて前記作業実行部を制御すると共に、逆送り処理時には前記動作順リストの逆の順番及び前記作業種リストの逆送り処理時の作業種に基づいて前記作業実行部を制御するステップ、
    　を含む制御方法。
PCT/JP2017/044237 2017-12-08 2017-12-08 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 Ceased WO2019111413A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
EP17934230.8A EP3722053B1 (en) 2017-12-08 2017-12-08 CONTROL DEVICE, WORKPIECE OPERATION DEVICE, WORKPIECE OPERATION SYSTEM, AND CONTROL METHOD
CN201780097280.4A CN111417496B (zh) 2017-12-08 2017-12-08 控制装置、工件作业装置、工件作业系统以及控制方法
PCT/JP2017/044237 WO2019111413A1 (ja) 2017-12-08 2017-12-08 制御装置、ワーク作業装置、ワーク作業システム及び制御方法
JP2019557975A JP6825134B2 (ja) 2017-12-08 2017-12-08 制御装置、ワーク作業装置、ワーク作業システム及び制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/044237 WO2019111413A1 (ja) 2017-12-08 2017-12-08 制御装置、ワーク作業装置、ワーク作業システム及び制御方法

Publications (1)

Publication Number Publication Date
WO2019111413A1 true WO2019111413A1 (ja) 2019-06-13

Family

ID=66750125

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/044237 Ceased WO2019111413A1 (ja) 2017-12-08 2017-12-08 制御装置、ワーク作業装置、ワーク作業システム及び制御方法

Country Status (4)

Country Link
EP (1) EP3722053B1 (ja)
JP (1) JP6825134B2 (ja)
CN (1) CN111417496B (ja)
WO (1) WO2019111413A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022054768A1 (ja) * 2020-09-11 2022-03-17 ファナック株式会社 ロボットシステム及びロボット動作の方法
WO2023037418A1 (ja) * 2021-09-07 2023-03-16 ファナック株式会社 インタロック機能を有する制御装置及び制御方法
WO2024195000A1 (ja) * 2023-03-20 2024-09-26 株式会社Fuji 異物除去装置及び異物除去装置の制御方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0728520A (ja) * 1993-07-14 1995-01-31 Toyota Motor Corp ロボットの原点復帰制御方法
JPH07302109A (ja) * 1994-03-25 1995-11-14 Asea Brown Boveri Ab ロボット制御装置
JPH1011124A (ja) * 1996-06-20 1998-01-16 Fanuc Ltd ロボットの後退実行機能を備えたロボット制御装置
JP2008254141A (ja) 2007-04-06 2008-10-23 Mitsubishi Electric Corp ロボット制御装置、ロボット制御方法及びロボット搬送装置

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE58908998D1 (de) * 1988-11-11 1995-03-23 Siemens Ag Verfahren zum Betrieb eines Industrieroboters.
JP2935706B2 (ja) * 1988-12-07 1999-08-16 ファナック株式会社 加工プログラム修正方法
JP2004102932A (ja) * 2002-09-12 2004-04-02 Dainippon Printing Co Ltd 自動処理汎用制御システム、管理装置、制御装置、自動処理汎用制御方法、自動処理汎用制御装置、プログラム、及び、記録媒体
JP4027350B2 (ja) * 2004-06-29 2007-12-26 ファナック株式会社 ロボットの待機位置復帰プログラム作成装置
JP4911782B2 (ja) * 2006-01-17 2012-04-04 武蔵エンジニアリング株式会社 作業の再開性に優れた作業ロボット
DE112010000775B4 (de) * 2009-02-12 2016-03-17 Kyoto University Industrierobotersystem
DE102012008073A1 (de) * 2012-04-24 2013-10-24 Kuka Roboter Gmbh Verfahren und Mittel zum Vorgeben und/oder Steuern eines Manipulatorprozesses
WO2014056533A1 (en) * 2012-10-11 2014-04-17 Abb Technology Ltd A method and an apparatus for automatically generating a collision free return program for returning a robot from a stop position to a predefined restart position

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0728520A (ja) * 1993-07-14 1995-01-31 Toyota Motor Corp ロボットの原点復帰制御方法
JPH07302109A (ja) * 1994-03-25 1995-11-14 Asea Brown Boveri Ab ロボット制御装置
JPH1011124A (ja) * 1996-06-20 1998-01-16 Fanuc Ltd ロボットの後退実行機能を備えたロボット制御装置
JP2008254141A (ja) 2007-04-06 2008-10-23 Mitsubishi Electric Corp ロボット制御装置、ロボット制御方法及びロボット搬送装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3722053A4

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022054768A1 (ja) * 2020-09-11 2022-03-17 ファナック株式会社 ロボットシステム及びロボット動作の方法
JPWO2022054768A1 (ja) * 2020-09-11 2022-03-17
JP7453393B2 (ja) 2020-09-11 2024-03-19 ファナック株式会社 ロボットシステム及びロボット動作の方法
US12502775B2 (en) 2020-09-11 2025-12-23 Fanuc Corporation Robot system and robot operation method
WO2023037418A1 (ja) * 2021-09-07 2023-03-16 ファナック株式会社 インタロック機能を有する制御装置及び制御方法
JPWO2023037418A1 (ja) * 2021-09-07 2023-03-16
JP7691507B2 (ja) 2021-09-07 2025-06-11 ファナック株式会社 インタロック機能を有する制御装置及び制御方法
WO2024195000A1 (ja) * 2023-03-20 2024-09-26 株式会社Fuji 異物除去装置及び異物除去装置の制御方法

Also Published As

Publication number Publication date
CN111417496B (zh) 2023-03-28
JPWO2019111413A1 (ja) 2020-11-19
EP3722053A4 (en) 2020-12-02
EP3722053A1 (en) 2020-10-14
EP3722053B1 (en) 2025-04-30
CN111417496A (zh) 2020-07-14
JP6825134B2 (ja) 2021-02-03

Similar Documents

Publication Publication Date Title
JP5423441B2 (ja) 作業システム、ロボット装置、機械製品の製造方法
CN108235696B (zh) 机器人控制方法和设备
JP6450960B2 (ja) ロボット、ロボットシステム及び教示方法
JP7167681B2 (ja) ロボットシステムおよび接続方法
CN107921638A (zh) 机械臂系统
EP3409428B1 (en) Work system comprising a job creation device and a work robot control device
JP2006035397A (ja) 搬送ロボットシステム
CN108349092A (zh) 制造系统、制造系统的构建方法、末端效应器、机器人、及机器人的作业方法
JP2008015683A (ja) ロボットプログラムを作成するための装置、プログラム、記録媒体及び方法
CN104044152A (zh) 机器人系统、机器人控制方法及被加工物制造方法
JP2014176944A (ja) ロボットシステム、校正方法及び被加工物の製造方法
JP2014176943A (ja) ロボットシステム、校正方法及び被加工物の製造方法
JP2019188545A (ja) ロボット制御装置
WO2020021643A1 (ja) エンドエフェクタの選択方法および選択システム
WO2019111413A1 (ja) 制御装置、ワーク作業装置、ワーク作業システム及び制御方法
JP2020004916A (ja) 基板搬送装置及びその運転方法
JP6718502B2 (ja) 電子部品装着機の動作確認装置
WO2018043493A1 (ja) ロボット及びその運転方法
JP2015085499A (ja) ロボット、ロボットシステム、制御装置及び制御方法
CN114761186B (zh) 机器人系统及其运转方法
JPH03128126A (ja) プレスブレーキロボット
KR102365739B1 (ko) 3d 비전기술을 활용한 다형상 주방용품 최적 그라인딩 로봇 자동화 시스템
JP2010207997A (ja) 産業用ロボットの位置教示装置、産業用ロボットの動作教示装置およびプログラム
US11577381B2 (en) Teaching apparatus, robot system, and teaching program
US20210331874A1 (en) Workpiece processing 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: 17934230

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2019557975

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2017934230

Country of ref document: EP

Effective date: 20200708

WWG Wipo information: grant in national office

Ref document number: 2017934230

Country of ref document: EP