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

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

Info

Publication number
WO2020144852A1
WO2020144852A1 PCT/JP2019/000703 JP2019000703W WO2020144852A1 WO 2020144852 A1 WO2020144852 A1 WO 2020144852A1 JP 2019000703 W JP2019000703 W JP 2019000703W WO 2020144852 A1 WO2020144852 A1 WO 2020144852A1
Authority
WO
WIPO (PCT)
Prior art keywords
mode
work
distance
acquired
speed
Prior art date
Application number
PCT/JP2019/000703
Other languages
English (en)
French (fr)
Inventor
篤規 平野
Original Assignee
株式会社Ｆｕｊｉ
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社Ｆｕｊｉ filed Critical 株式会社Ｆｕｊｉ
Priority to JP2020565139A priority Critical patent/JP7145237B2/ja
Priority to EP19909309.7A priority patent/EP3909726A4/en
Priority to PCT/JP2019/000703 priority patent/WO2020144852A1/ja
Publication of WO2020144852A1 publication Critical patent/WO2020144852A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B25J9/1666—Avoiding collision or forbidden zones
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39082—Collision, real time collision avoidance
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39091—Avoid collision with moving obstacles
    • 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/49—Nc machine tool, till multiple
    • G05B2219/49141—Detect near collision and slow, stop, inhibit movement tool

Definitions

  • control device a work work device, a work work system, and a control method are disclosed.
  • Patent Document 1 since the device of Patent Document 1 can only perform rough motion restriction, it is still not sufficient to achieve both safety and workability, and further improvement has been desired.
  • the present disclosure has been made in view of such problems, and provides a control device, a work work device, a work work system, and a control method capable of performing more appropriate control that achieves both safety and workability.
  • the main purpose is that.
  • the control device of the present disclosure is A first mode for operating the work section in a first operation, and a second operation for operating the work section in a second operation slower than the first mode;
  • a control device used for a work working device having an operation mode including two modes and a stop mode for stopping the operation of the working unit, Distance information between the moving object outside the work working device and the working unit and speed information at which the moving object heads toward the working unit are acquired from a radio wave sensor, and the acquired distance information and speed information are acquired.
  • the execution mode of the work unit based on the distance information between the moving object (for example, a worker) outside the work working device and the working unit, which is acquired from the radio wave sensor, and the speed information at which the moving object moves toward the working unit, Set the execution mode of the work unit. That is, in this device, the operation mode of the working unit is set in consideration of the speed of the moving object. For example, when the moving object has a low speed, it may have time to come into contact with the working unit, while when the moving object has a fast speed, it may not have time to come into contact with the working unit.
  • the “working unit” may be, for example, an articulated arm included in an arm robot serving as a work working device, or a carrying unit that loads and unloads a carried object included in an automated guided vehicle serving as a work working device.
  • FIG. 1 is a schematic explanatory view showing an example of a work work system 10.
  • FIG. Explanatory drawing which shows an example of the signal classification output from the radio wave sensor 25.
  • 6 is a schematic explanatory diagram of an output pattern 1 of the radio wave sensor 25.
  • FIG. 6 is a schematic explanatory diagram of an output pattern 2 of the radio wave sensor 25.
  • FIG. 6 is a schematic explanatory diagram of an output pattern 3 of the radio wave sensor 25.
  • FIG. 5 is a schematic explanatory diagram of an output pattern 4 of the radio wave sensor 25.
  • FIG. The flowchart which shows an example of a work execution routine.
  • FIG. 1 is a schematic explanatory view showing an example of a work work system 10.
  • FIG. 2 is an explanatory diagram showing an example of signal types output from the radio wave sensor 25.
  • FIG. 3 is an explanatory diagram of the mode setting information 34 and the selection information 35 stored in the storage unit 33.
  • 4 to 7 are schematic explanatory diagrams of the output patterns 1 to 4 of the radio wave sensor 25, respectively.
  • the work work system 10 includes one or more work work devices 20 that perform a predetermined work on an article (work W) as a work target.
  • the work work system 10 includes a work work device 20 and a control PC 30.
  • the work working device 20 is movable in all directions and therefore has no fixed direction, but for convenience of description, the direction shown in FIG. 1 is the left-right direction (X-axis), the front-back direction (Y-axis), and the direction shown in FIG. It will be described as the vertical direction (Z axis).
  • the work work device 20 is configured as a device that performs a predetermined work on the work W to be worked.
  • the work W include various parts such as mechanical parts, electric parts, electronic parts, and chemical parts, as well as food, biotechnology, and biological-related articles.
  • the predetermined work for example, a moving work for collecting, moving, and arranging from the collecting position to the arrangement position, an assembling work for assembling parts, a working work for applying a work, a applying work for applying a viscous material, and a heating for heating. Examples include work, processing work of performing a predetermined chemical and/or physical process, and inspection work of performing an inspection.
  • Assembling work includes, for example, fastening work of fastening members such as screws and bolts, connector insertion work, wiring work, component fitting work, member mounting work, and work holding work.
  • Examples of processing work include grinding work, cutting work, deformation work, connection work, and joining work.
  • Examples of the viscous material include adhesives, solder paste, grease and the like.
  • the inspection work includes, for example, a work for inspecting one or more work results described above, and may involve moving the work W.
  • the work working device 20 has a working unit 21 and a radio wave sensor 25, and is configured as an articulated arm robot.
  • the working unit 21 includes an articulated arm 22, an end effector 23, and a drive unit 24.
  • the multi-joint arm 22 has a first arm and a second arm.
  • the end effector 23 is a member that performs a predetermined work on the work W, and is rotatably connected to the tip of the multi-joint arm 22.
  • the end effector 23 is a working member that grips and collects the work W.
  • the drive unit 24 rotationally drives each arm to open/close the end effector 23.
  • the radio wave sensor 25 is configured as a non-contact sensor capable of outputting distance information regarding the distance to a moving object that moves within the detectable area and speed information regarding the speed.
  • the radio wave sensor 25 detects the existence position of the target by transmitting the radio wave and receiving the radio wave reflected from the target, and based on the change in the frequency generated between the transmitted wave and the reflected wave, the moving speed. To detect.
  • patterns 1 to 4 are set as the pattern of the signal that outputs the detected result to the control device 31. Pattern 1 is a setting for outputting two distance channels and two velocity channels.
  • the OSSD1 signal is output when the moving object is within the first distance range A1
  • the OSSD2 signal is output when the moving object is within the second distance range A2 shorter than the first distance range A1.
  • the OSSD3 signal is output when the moving object is moving within the first speed range S1 toward the radio wave sensor 25, and the moving object moves within the second speed range S2 faster than the first speed range S1. It outputs the OSSD4 signal when the object is moving.
  • the first distance range A1 is 2 m or more and 5 m or less
  • the second distance range A2 is less than 2 m
  • the first speed range S1 is 0.1 m/s or more and less than 0.5 m/s
  • Pattern 2 is a setting for outputting four channels in distance.
  • the OSSD1 signal is output when the moving object is within the first distance range A1
  • the OSSD2 signal is output when the moving object is within the second distance range A2 shorter than the first distance range A1.
  • OSSD3 signal is output when the moving object is within the third distance range A3 shorter than the second distance range A2
  • OSSD4 is output when the moving object is within the fourth distance range A4 shorter than the third distance range A3.
  • the signal is output (see FIG. 5).
  • the first distance range A1 may be 4 m or more and 5 m or less
  • the second distance range A2 may be 3 m or more and less than 4 m
  • the third distance range A3 may be 2 m or more and less than 3 m
  • the fourth distance range A4 may be less than 2 m.
  • Pattern 3 is a setting for outputting 3 channels for distance and 1 channel for velocity.
  • the OSSD1 signal is output when the moving object is within the first distance range A1
  • the OSSD2 signal is output when the moving object is within the second distance range A2 shorter than the first distance range A1.
  • the OSSD3 signal is output when the moving object is within the third distance range A3 shorter than the second distance range A2 (see FIG. 6).
  • the OSSD4 signal is output when the moving object is moving toward the radio wave sensor 25 within the first speed range S1.
  • the first distance range A1 is 4 m or more and 6 m or less
  • the second distance range A2 is 2 m or more and less than 4 m
  • the third distance range A3 is less than 2 m
  • the first speed range S1 is 0.3 m/s or more.
  • Pattern 4 is a setting for outputting a distance of 1 channel and a speed of 3 channels. In this pattern 4, when there is a moving object within the first distance range A1, the OSSD1 signal is output (see FIG. 7).
  • the OSSD2 signal is output when the moving object is moving within the first speed range S1 toward the radio wave sensor 25, and the moving object moves within the second speed range S2 faster than the first speed range S1.
  • the OSSD3 signal is output when the object is moving
  • the OSSD4 signal is output when the moving object is moving within the third speed range S3 that is faster than the second speed range S2.
  • the first distance range A1 is less than 3 m
  • the first speed range S1 is 0.1 m/s or more and less than 0.3 m/s
  • the second speed range S2 is 0.3 m/s or more and 0.5 m/s.
  • the third distance range A3 may be 0.5 m/s or more.
  • Each of the first to fourth distance ranges A1 to A4 of the patterns 1 to 4 may be set to the same range or different ranges.
  • the first to third speed ranges S1 to S3 of the patterns 1 to 4 may be set to the same range or different ranges.
  • the control PC 30 is a computer that controls the entire work work device 20.
  • the control PC 30 includes a control device 31, a display unit 38, and an input device 39.
  • the control device 31 includes a CPU 32, a storage unit 33, and a communication unit (not shown).
  • the control device 31 is configured as a microprocessor centered on the CPU 32.
  • the control device 31 outputs a drive signal to the drive unit 24 and inputs a detection signal from the radio wave sensor 25.
  • the storage unit 33 is configured as a large-capacity storage device such as an HDD. As shown in FIG. 3, the storage unit 33 stores the mode setting information 34 and the selection information 35.
  • the mode setting information 34 is information used to set an operation mode for controlling the work work apparatus 20.
  • the operation mode of the work work apparatus 20 includes a plurality of modes for limiting the operation speed in order to suppress contact with a moving object such as an operator and improve safety.
  • This operation mode is a mode set according to the distance to the moving object and the speed of the moving object, and includes a normal mode, a small slow mode, a medium slow mode, a large slow mode, and a stop mode.
  • the normal mode is a mode in which the working unit 21 is operated at the fastest operation speed.
  • the small slow mode is a mode in which the working unit 21 is operated at a first operation speed slower than the normal mode.
  • the middle slow mode is a mode in which the working unit 21 is operated at a second operation speed slower than the small slow mode.
  • the large slow mode is a mode in which the working unit 21 is operated at a third operating speed slower than the medium slow mode.
  • the stop mode is a mode in which the operation of the working unit 21 is stopped.
  • the type of the signal and any mode set as the execution mode are associated with each other.
  • the operation mode that tends to be slower is set as the execution mode
  • the speed value acquired from the radio wave sensor 25 is faster
  • the operation mode that tends to be slower is set to run mode. It should be noted that "set to a slower tendency" means that there is a region where the speed does not change in some areas, and it is set to be slower as a whole.
  • the mode setting information 34 for example, in the correspondence information of pattern 1, there is no signal, signals of two channels for distance and two channels for speed, and one of the normal mode, small slow mode, medium slow mode, large slow mode, and stop mode. It is associated with the operation mode.
  • no signal or a signal of four channels is associated with one of the normal mode, the small slow mode, the medium slow mode, the large slow mode, and the stop mode.
  • signals of no signal, 3 channels of distance, and 1 channel of speed are associated with one of the normal mode, small slow mode, medium slow mode, large slow mode, and stop mode. There is.
  • the selection information 35 includes the pattern type of the signal output from the radio wave sensor 25.
  • the selection information 35 includes a pattern selected by the operator in advance from the patterns 1 to 4.
  • FIG. 8 is a flowchart showing an example of a work execution routine executed by the CPU 32 of the control device 31. This routine is stored in the storage unit 33 and is executed according to the start instruction from the worker. When this routine is started, the CPU 32 reads out and acquires the selected pattern from the selection information 35, and outputs it to the radio wave sensor 25 (S100).
  • the radio wave sensor 25 switches the detection condition so as to output the signal in the selected pattern.
  • the CPU 32 reads and acquires the mode setting information 34 according to the selection pattern (S110).
  • the correspondence information according to the selected pattern 1 is acquired.
  • the CPU 32 determines which pattern is selected (S120), and acquires signals (distance information and speed information) from the radio wave sensor 25 according to the selected pattern (S130 to S160).
  • the execution mode is set based on the mode setting information 34 and the acquired signal (S170 to S200).
  • the CPU 32 When the pattern 1 is selected in S120, the CPU 32 includes the operation mode based on the correspondence information of the pattern 1 included in the mode setting information 34 and the signals of the distance 2 channel and the velocity 2 channel from the radio wave sensor 25.
  • One of the modes is set as the execution mode (S130, 170).
  • the CPU 32 in the correspondence information of pattern 1, the CPU 32, as shown in FIG. 3, when the distance signal and the speed signal are not acquired from the radio wave sensor 25, or when the distance signal is not acquired and the first speed range S1 is set.
  • the normal mode is set to the execution mode, assuming that there is no contact between the moving object and the working unit 21.
  • the CPU 32 when the distance signal is not acquired from the radio wave sensor 25 and the signal of the second speed range S2 is acquired, or when the acquired signal is the first distance range A1 and the speed signal is not acquired. Sets the small slow mode in which the operating speed of the working unit 21 is slightly slowed to the execution mode. Similarly, when the signal acquired from the radio wave sensor 25 is in the first distance range A1 and the first speed range S1, the CPU 32 sets the medium/slow mode, and is in the first distance range A1 and the second speed range S2. In this case, the large delay mode is set to the execution mode. Further, when the signal acquired from the radio wave sensor 25 is in the second distance range A2, the CPU 32 sets the stop mode to the execution mode in order to prevent contact between the moving object and the working unit 21 regardless of the speed signal. To do.
  • the CPU 32 determines one mode included in the operation mode based on the correspondence information of the pattern 2 included in the mode setting information 34 and the signal of the distance 4 channels from the radio wave sensor 25. Is set to the execution mode (S140, 180). For example, in the correspondence information of pattern 2, the CPU 32 sets the normal mode to the execution mode when the distance signal is not acquired from the radio wave sensor 25. Further, the CPU 32, in the case where the acquired signal is in the first distance range A1, is in the small slow mode in which the operation speed of the working unit 21 is slightly slowed, and in the case of the second distance range A2, the operation speed of the working unit 21.
  • the CPU 32 When the pattern 3 is selected in S120, the CPU 32 includes it in the operation mode based on the correspondence information of the pattern 3 included in the mode setting information 34 and the signals of the distance 3 channels and the speed 1 channel from the radio wave sensor 25.
  • One of the modes is set as the execution mode (S150, 190).
  • the normal mode is set to the execution mode assuming that there is no contact between the moving object and the working unit 21 (see FIG. 6).
  • the small slow mode in which the operation speed of the working unit 21 is slightly slowed down is set to the execution mode.
  • the medium slow mode is set, and the second distance range A2 and the second speed are set.
  • the large delay mode is set to the execution mode.
  • the stop mode is used to prevent the contact between the moving object and the working unit 21 regardless of the speed signal. Is set to run mode.
  • the CPU 32 When the pattern 4 is selected in S120, the CPU 32 includes the operation mode based on the correspondence information of the pattern 4 included in the mode setting information 34 and the signals of the distance 1 channel and the speed 3 channel from the radio wave sensor 25.
  • One of the modes is set as the execution mode (S160, 200).
  • the CPU 32 determines that there is no contact between the moving object and the working unit 21, and sets the normal mode to the execution mode. .. Further, when the distance signal is not acquired from the radio wave sensor 25 and the signal in the first speed range S1 is acquired, the CPU 32 sets the small slow mode in which the operating speed of the working unit 21 is slightly slowed to the execution mode. Set.
  • the CPU 32 sets the medium/slow mode, and the distance signal is not acquired and the third speed is acquired.
  • the large delay mode is set to the execution mode.
  • the CPU 32 sets the stop mode to the execution mode in order to prevent contact between the moving object and the working unit 21 regardless of the speed signal. Set.
  • the CPU 32 causes the work unit 21 to execute a predetermined work using the set execution mode (S210).
  • the work work apparatus 20 performs work such as collecting the work W at the collection position, moving it to the arrangement position, and placing it.
  • the CPU 32 determines that the moving speed is higher when there is a moving object in the same area. If the moving speed is slower and the moving speed of the moving object is the same but the moving object is in a closer area, the working speed of the working unit 21 is slowed down.
  • the CPU 32 stops the operation of the working unit 21 to prevent the contact with the working unit 21 to ensure safety. Then, after S210, the CPU 32 determines whether or not the work of the working unit 21 is completed (S220), and when the work is not completed, executes the processes of S120 and thereafter. That is, a signal according to the selected pattern is acquired, the execution mode is set according to the distance and speed of the moving object according to the signal, and the working unit 21 is operated in the set execution mode. On the other hand, when the work of the working unit 21 is completed in S220, this routine is ended.
  • the working unit 21 of the present embodiment corresponds to the working unit of the present disclosure
  • the work working device 20 corresponds to the work working device
  • the control device 31 corresponds to the control device
  • the CPU 32 corresponds to the control unit.
  • the normal mode and the stop mode of the present embodiment correspond to the normal mode and the stop mode of the present disclosure
  • the small slow mode, the medium slow mode, and the large slow mode are the first mode, This corresponds to either the second mode or the third mode.
  • an example of the control method of the present disclosure is clarified by describing the operation of the control device 31.
  • the distance information between the moving object (for example, a worker or the like) outside the work working device 20 and the work unit 21 acquired from the radio wave sensor 25 and the moving object work.
  • the execution mode of the working unit 21 is set based on the speed information toward the unit 21. That is, in the work working device 20, the operation mode of the working unit 21 is set in consideration of the speed of the moving object. For example, when the moving object has a low speed, it may take time to come into contact with the working unit 21, while when the moving object has a high speed, it may take a short time to come into contact with the working unit 21. Since the control device 31 sets the operation mode in consideration of such speed, it is possible to perform more appropriate control that achieves both safety and workability.
  • control unit 31 sets the operation mode that tends to be slower to the execution mode when the distance information obtained from the radio wave sensor 25 is shorter, and the operation that tends to be slower when the speed information obtained from the radio wave sensor 25 is faster.
  • the control device 31 tends to delay the operation of the work unit 21 in a situation where a moving object is likely to come into contact with the work unit 21, and thus can perform more appropriate control that achieves both safety and workability. ..
  • control device 31 acquires the signals of the first distance range A1 and the first speed range S1 from the radio wave sensor 25 in the pattern 1, the control device 31 sets the medium slow mode, which is slower than the normal mode, to the execution mode, and the first distance range.
  • the medium slow mode which is slower than the medium slow mode
  • the stop mode is set to the execution mode.
  • a more appropriate operation mode can be set according to the signal value from the radio wave sensor 25.
  • the control device 31 is in the normal mode when the signal is not acquired from the radio wave sensor 25, the small delay mode when the signal of the first distance range A1 is acquired, and the medium delay mode when the signal of the second distance range A2 is acquired.
  • the large delay mode is set when the signal of the third distance range A3 is acquired, and the stop mode is set to the execution mode when the signal of the fourth distance range A4 is acquired.
  • a more appropriate operation mode can be set according to the signal value from the radio wave sensor 25.
  • the control device 31 acquires the detection values of the first distance range A1 and the first speed range S1 from the radio wave sensor 25 in the pattern 3, the control device 31 does not acquire the signal of the small slow mode, the first speed range S1 and the second speed range S1.
  • the medium slow mode is set
  • the large delay mode is set
  • the stop mode is set to the execution mode.
  • a more appropriate operation mode can be set according to the signal value from the radio wave sensor 25.
  • the control device 31 when the control device 31 does not acquire the signal of the first distance range A1 from the radio wave sensor 25 and acquires the signal of the first speed range S1, the control device 31 outputs the signal of the small delay mode and the first distance range A1. If the signal of the second speed range S2 is not acquired and the signal of the first distance range A1 is acquired, if the signal of the first speed range S1 is not acquired and the signal of the third speed range S3 is acquired, the large delay mode of the first distance range A1 is acquired. When the signal is acquired, the stop mode is set to the execution mode. In this control device 31, a more appropriate operation mode can be set according to the signal value from the radio wave sensor 25.
  • the control device 31 sets the normal mode to the execution mode when there is no moving object within the first distance range A1. Since the control device 31 operates at high speed when there is no moving object, it is possible to further suppress deterioration in workability. Further, in the pattern 2, the speed channel of the pattern 1 is replaced with the distance channel to have more stages, and the user can select. Therefore, the control device 31 uses the distance and the velocity, or has more stages of distance. It is selectable, and by setting a finer operation mode, it is possible to perform more appropriate control that achieves both safety and workability.
  • the patterns 1 to 4 are selectable, but any one or more patterns of the patterns 2 to 4 may be omitted.
  • the patterns 1 to 4 such as the pattern of four speed channels may be omitted.
  • a pattern other than 4 may be adopted. If at least the pattern 1 can be used, the control device 31 sets the execution mode based on the distance and speed of the moving object, so that more appropriate control that achieves both safety and workability can be performed. it can.
  • the operation mode corresponding to the distance range and the speed range is set as appropriate, but the setting of this operation mode is performed in the patterns 1 to 4.
  • the small slow mode is set to the execution mode, but this may be set to the normal mode.
  • the medium or slow mode may be used.
  • the medium slow mode is set to the execution mode, but this may be set to the small slow mode. It is also possible to use the large slow mode.
  • the operation mode that tends to be slower is set as the execution mode, and when the speed value acquired from the radio wave sensor 25 is faster, the operation mode that tends to be slower. Should be set to the execution mode.
  • the small slow mode, the medium slow mode, and the large slow mode are assumed, but the present invention is not limited to this.
  • One or two of these operation modes may be omitted, or one or more operation modes may be added.
  • the execution mode is set based on the distance and speed of the moving object, it is possible to perform more appropriate control that achieves both safety and workability.
  • the work working apparatus 20 has been mainly described as performing the moving work of the work W, but the work working apparatus 20 is not particularly limited to this, and the work working apparatus 20 performs a predetermined work on the work W. If it is equipped with, it may be configured to execute various tasks.
  • the work working device 20 has been mainly described to move from the sampling position to the arrangement position, the assembling work for assembling the parts, the working work for performing the working, the applying work for applying the viscous material, the heating work for heating, the chemical work. It may be a processing operation for performing a predetermined physical and/or physical processing and an inspection operation for performing an inspection.
  • the work work apparatus 20 is an arm robot including the multi-joint arm 22, but the work work apparatus 20 is not particularly limited thereto, and the work work apparatus may be an automated guided vehicle (AGV) for transferring the work.
  • AGV automated guided vehicle
  • the articulated arm 22 is used as the working unit in the above-described embodiment, the unmanned guided vehicle itself may be used as the working unit, or the carrying unit for carrying in and out the carried items of the unmanned guided vehicle may be used as the working unit.
  • the work W may be, for example, various parts such as mechanical parts, electric parts, electronic parts, and chemical parts, as well as any of articles such as food, biotechnology, and biological-related articles.
  • control device 31 is described as the control PC 30 connected to the outside of the work work device 20, but the invention is not particularly limited thereto, and for example, a controller provided inside the work work device 20 is used as the control device 31. Good.
  • control device of the present disclosure may be configured as follows.
  • the control unit sets the operation mode, which tends to be slower when the distance information acquired from the radio wave sensor is shorter, to the execution mode, and the speed acquired from the radio wave sensor.
  • the operation mode that tends to be slower when the information is faster may be set to the execution mode.
  • the operation of the working unit tends to be slower in a situation where the moving object is likely to come into contact with the working unit, it is possible to perform more appropriate control that achieves both safety and workability.
  • the control unit obtains a detection value of a first distance range and a second distance range shorter than the first distance as the distance information, and as the speed information, a first speed range and the first speed range.
  • a detection value in a second speed range that is faster than the first speed is acquired, and the execution mode of the working unit is set based on the acquired detection value by any one or more of the following (1) to (3). It may be one.
  • a more appropriate operation mode can be set according to the detection value from the radio wave sensor. (1) When the detection values of the first distance range and the first speed range are acquired from the radio wave sensor, the first mode is set to the execution mode. (2) When the detection values of the first distance range and the second speed range are acquired from the radio wave sensor, the second mode is set to the execution mode. (3) When the detection value of the second distance range is acquired from the radio wave sensor, the stop mode is set to the execution mode.
  • the operation mode further includes a third mode in which the working unit is operated in a slower operation than the second mode, and the control unit sets the first distance range as the distance information.
  • a detection value of a second distance range shorter than the first distance and a third distance range shorter than the second distance is acquired, a detection value of the first speed range is acquired as the speed information, and the acquired detection value is acquired.
  • the execution mode of the working unit may be set by any one or more of the following (4) to (7).
  • a more appropriate operation mode can be set according to the detection value from the radio wave sensor. (4) When the detection values of the first distance range and the first speed range are acquired from the radio wave sensor, the first mode is set to the execution mode.
  • the second mode is set to the execution mode.
  • the third mode is set to the execution mode.
  • the stop mode is set to the execution mode.
  • the operation mode further includes a third mode in which the working unit is operated in a slower operation than the second mode, and the control unit sets the first distance range as the distance information.
  • a detection value is acquired, and as the speed information, a detection value in a first speed range, a detection value in a second speed range faster than the first speed, and a detection value in a third speed range faster than the second speed are acquired.
  • the execution mode of the working unit may be set by any one or more of the following (8) to (11) based on the acquired detection value. In this control device, a more appropriate operation mode can be set according to the detection value from the radio wave sensor.
  • the first mode is set to the execution mode.
  • the second mode is set to the execution mode.
  • the third mode is set to the execution mode.
  • control unit operates the working unit in a normal operation faster than the first mode when there is no moving object within a predetermined first distance range based on a detection value from the radio wave sensor.
  • the normal mode may be set to the execution mode of the working unit. Since this control device operates at high speed when there is no moving object, it is possible to further suppress deterioration in workability.
  • the control device acquires distance speed information including the distance information and the speed information from the radio wave sensor, or replaces the speed information in the distance speed information with the distance information.
  • the control unit has selection information selected by the user as to whether to acquire the multi-step distance information from the radio wave sensor, and when the multi-step distance information is selected, when the distance speed information is acquired.
  • the operation mode including different speeds in multiple stages may be used as the execution mode. Since this control device can use distance and speed, or can use multiple distances, it is necessary to perform more appropriate control that achieves both safety and workability by setting a finer operation mode. You can use distance and speed, or can use multiple distances, it is necessary to perform more appropriate control that achieves both safety and workability by setting a finer operation mode. You can use distance and speed, or can use multiple distances, it is necessary to perform more appropriate control that achieves both safety and workability by setting a finer operation mode. You can use distance and speed, or can use multiple distances, it is necessary to perform more appropriate control that achieves both safety and work
  • the operation mode further includes a third mode in which the working unit is operated in a slower operation than the second mode, and the control unit uses the first distance as the distance information.
  • a detection value of a range, a second distance range shorter than the first distance, a third distance range shorter than the second distance, and a fourth distance range shorter than the third distance is acquired, and the acquired detection value is obtained.
  • any one or more of the following (12) to (15) may set the execution mode of the working unit.
  • a more appropriate operation mode can be set according to the detection value from the radio wave sensor. (12) When the detection value in the first distance range is acquired from the radio wave sensor, the first mode is set to the execution mode.
  • the second mode is set to the execution mode.
  • the third mode is set to the execution mode.
  • the stop mode is set to the execution mode.
  • the work working apparatus of the present disclosure includes a working unit that performs a predetermined work on a work, distance information between a moving object outside the work working apparatus and the working unit, and the moving object is the working unit. It is provided with an electric wave sensor capable of detecting speed information heading for and a control device described above. Since this work work device includes any of the control devices described above, the same effect as that of the control device can be obtained.
  • the work work system of the present disclosure includes a work unit that performs a predetermined work on a work, distance information between a moving object outside the work work device and the work unit, and the moving object is the work unit. It is provided with a work working device including speed information heading for and a detectable radio wave sensor, and any one of the control devices described above. Since this work work system includes any of the control devices described above, the same effect as this control device can be obtained.
  • the control method of the present disclosure is A first mode for operating the work section in a first operation, and a second operation for operating the work section in a second operation slower than the first mode;
  • Is included Based on the step of setting the execution mode of the working unit from the operation mode.
  • this control method as with the control device described above, the operation mode is set in consideration of the speed, so it is possible to perform more appropriate control that achieves both safety and workability. It should be noted that this control method may employ any one of the modes of the control device described above, or may include a step of exhibiting the function of any of the control devices described above.
  • control device the work work device, the work work system, and the control method disclosed in this specification can be used in the technical field of a device that executes a predetermined work on a work.
  • 10 work work system 20 work work device, 21 work unit, 22 multi-joint arm, 23 end effector, 24 drive unit, 25 radio wave sensor, 30 control PC (personal computer), 31 control device, 32 CPU, 33 storage unit, 34 Mode setting information, 35 selection information, A1 first distance range, A2 second distance range, A3 third distance range, A4 fourth distance range, S1 first speed range, S2 second speed range, S3 third speed range, W work.
  • control PC personal computer
  • 31 control device 32 CPU
  • 33 storage unit 34 Mode setting information, 35 selection information, A1 first distance range, A2 second distance range, A3 third distance range, A4 fourth distance range, S1 first speed range, S2 second speed range, S3 third speed range, W work.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

制御装置は、第１の動作でワークに対して所定の作業を実行する作業部を動作させる第１モードと、第１モードよりも遅い第２の動作で作業部を動作させる第２モードと、作業部の動作を停止させる停止モードとを含む動作モードを有するワーク作業装置に用いられる。この制御装置は、ワーク作業装置の外側にある移動物体と作業部との間の距離情報及び移動物体が作業部へ向かう速度情報とを電波センサから取得し、取得した距離情報及び速度情報に基づいて、作業部の実行用モードを動作モードから設定する制御部を備える。

Description

制御装置、ワーク作業装置、ワーク作業システム及び制御方法
　本明細書では、制御装置、ワーク作業装置、ワーク作業システム及び制御方法を開示する。
　従来、ロボットアームを有するワーク作業装置としては、例えば、装置近傍の第１領域と第１領域の外側の第２領域とがあり、第２領域に人が検知されると、ロボットの動作を制限し、第１領域に人が検知されるとロボットの動作を停止するものが提案されている（例えば、特許文献１参照）。この装置では、安全性と作業性とを両立した適切な制御を行うことができるとしている。
特開２０１８－１２６８１８号公報
　しかしながら、この特許文献１の装置では、大まかな動作制限しか行うことができないため、安全性と作業性とを両立するとしてもまだ十分でなく、更なる改良が望まれていた。
　本開示は、このような課題に鑑みなされたものであり、安全性と作業性とを両立したより適切な制御を行うことができる制御装置、ワーク作業装置、ワーク作業システム及び制御方法を提供することを主目的とする。
　本開示では、上述の主目的を達成するために以下の手段を採った。
　本開示の制御装置は、
　ワークに対して所定の作業を実行する作業部を備え、第１の動作で前記作業部を動作させる第１モードと、前記第１モードよりも遅い第２の動作で前記作業部を動作させる第２モードと、前記作業部の動作を停止させる停止モードとを含む動作モードを有するワーク作業装置に用いられる制御装置であって、
　前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報とを電波センサから取得し、取得した前記距離情報及び前記速度情報に基づいて、前記作業部の実行用モードを前記動作モードから設定する制御部、
　を備えたものである。
　この制御装置では、電波センサから取得した、ワーク作業装置の外側にある移動物体（例えば作業者など）と作業部との間の距離情報及び移動物体が作業部へ向かう速度情報とに基づいて、作業部の実行用モードを設定する。即ち、この装置では、移動物体の速度も考慮して作業部の動作モードを設定する。例えば、移動物体は、その速度が遅い場合、作業部と接触するまで時間がある一方、その速度が速い場合、作業部と接触するまで時間がない場合がある。ここでは、このような速度を考慮して動作モードを設定するから、安全性と作業性とを両立したより適切な制御を行うことができる。ここで、「作業部」とは、例えば、ワーク作業装置としてのアームロボットが備える多関節アームとしてもよいし、ワーク作業装置としての無人搬送車が備える搬送物を出し入れする搬送部としてもよい。
ワーク作業システム１０の一例を示す概略説明図。 電波センサ２５から出力される信号種別の一例を示す説明図。 記憶部３３に記憶された情報の説明図。 電波センサ２５の出力パターン１の概略説明図。 電波センサ２５の出力パターン２の概略説明図。 電波センサ２５の出力パターン３の概略説明図。 電波センサ２５の出力パターン４の概略説明図。 作業実行ルーチンの一例を示すフローチャート。
　本明細書で開示するワーク作業システム１０の実施形態を図面を参照しながら以下に説明する。図１は、ワーク作業システム１０の一例を示す概略説明図である。図２は、電波センサ２５から出力される信号種別の一例を示す説明図である。図３は、記憶部３３に記憶されたモード設定情報３４及び選択情報３５の説明図である。図４～７は、それぞれ電波センサ２５の出力パターン１～４の概略説明図である。ワーク作業システム１０は、作業対象の物品（ワークＷ）に対して所定作業を行うワーク作業装置２０を１以上備えて構成されている。ワーク作業システム１０は、ワーク作業装置２０と、制御ＰＣ３０とを備えている。なお、ワーク作業装置２０は全方位に可動するため固定される特定の方向はないが、説明の便宜のため、図１に示した方向を左右方向（Ｘ軸）、前後方向（Ｙ軸）及び上下方向（Ｚ軸）として説明する。
　ワーク作業装置２０は、作業対象のワークＷに対して所定の作業を実行する装置として構成されている。ワークＷは、例えば、機械部品、電気部品、電子部品、化学部品など各種の部品のほか、食品、バイオ、生物関連の物品などが挙げられる。また、所定の作業としては、例えば、採取位置から配置位置まで採取、移動、配置する移動作業や、部品を組み付ける組付け作業、加工を施す加工作業、粘性材料を塗布する塗布作業、加熱する加熱作業、化学的及び／又は物理的な所定処理を行う処理作業及び検査を行う検査作業などが挙げられる。組付け作業としては、例えば、ネジ、ボルトなどの締結部材の締結作業や、コネクタの挿入作業、配線に関する取回し作業、部品のはめ込み作業、部材の取付作業、ワークを押さえる押さえ付け作業などが挙げられる。加工作業としては、研削作業、切削作業、変形作業、接続作業、接合作業などが挙げられる。粘性材料としては、接着剤やはんだペースト、グリスなどが挙げられる。検査作業としては、例えば、上述した１以上の作業結果を検査する作業などが挙げられ、ワークＷの移動作業を伴うものとしてもよい。
　このワーク作業装置２０は、作業部２１と、電波センサ２５とを有しており、多関節アームロボットとして構成されている。作業部２１は、多関節アーム２２と、エンドエフェクタ２３と、駆動部２４とを備えている。多関節アーム２２は、第１アームと、第２アームとを有している。エンドエフェクタ２３は、ワークＷに対して所定の作業を行う部材であり、多関節アーム２２の先端に回動可能に接続されている。このエンドエフェクタ２３は、ワークＷを把持して採取する作業部材である。駆動部２４は、各アームを回動駆動し、エンドエフェクタ２３を開閉駆動する。
　電波センサ２５は、検知可能領域内において移動する移動物体までの距離に関する距離情報と速度に関する速度情報とを出力可能な非接触式のセンサとして構成されている。電波センサ２５は、電波を送信し、対象物から反射した電波を受信することで対象物の存在位置を検出し、この送信波と反射波との間で生じた周波数の変化に基づいて移動速度を検出する。この電波センサ２５では、図２に示すように、例えば、検出した結果を制御装置３１へ出力する信号のパターンとして、パターン１～４が設定されている。パターン１は、距離２チャネル、速度２チャネルの出力を行う設定である。このパターン１では、第１距離範囲Ａ１内に移動物体があるときにＯＳＳＤ１信号を出力し、第１距離範囲Ａ１よりも短い第２距離範囲Ａ２内に移動物体があるときにＯＳＳＤ２信号を出力する（図４参照）。また、パターン１では、移動物体が電波センサ２５に向かって第１速度範囲Ｓ１内で移動しているときにＯＳＳＤ３信号を出力し、第１速度範囲Ｓ１よりも速い第２速度範囲Ｓ２内で移動物体が移動しているときにＯＳＳＤ４信号を出力する。例えば、パターン１において、第１距離範囲Ａ１を２ｍ以上５ｍ以下、第２距離範囲Ａ２を２ｍ未満、第１速度範囲Ｓ１を０．１ｍ／ｓ以上０．５ｍ／ｓ未満、第２速度範囲Ｓ２を０．５ｍ／ｓ以上などとしてもよい。パターン２は、距離４チャネルの出力を行う設定である。このパターン２では、第１距離範囲Ａ１内に移動物体があるときにＯＳＳＤ１信号を出力し、第１距離範囲Ａ１よりも短い第２距離範囲Ａ２内に移動物体があるときにＯＳＳＤ２信号を出力し、第２距離範囲Ａ２よりも短い第３距離範囲Ａ３内に移動物体があるときにＯＳＳＤ３信号を出力し、第３距離範囲Ａ３よりも短い第４距離範囲Ａ４内に移動物体があるときにＯＳＳＤ４信号を出力する（図５参照）。例えば、パターン２において、第１距離範囲Ａ１を４ｍ以上５ｍ以下、第２距離範囲Ａ２を３ｍ以上４ｍ未満、第３距離範囲Ａ３を２ｍ以上３ｍ未満、第４距離範囲Ａ４を２ｍ未満などとしてもよい。パターン３は、距離３チャネル、速度１チャネルの出力を行う設定である。このパターン３では、第１距離範囲Ａ１内に移動物体があるときにＯＳＳＤ１信号を出力し、第１距離範囲Ａ１よりも短い第２距離範囲Ａ２内に移動物体があるときにＯＳＳＤ２信号を出力し、第２距離範囲Ａ２よりも短い第３距離範囲Ａ３内に移動物体があるときにＯＳＳＤ３信号を出力する（図６参照）。また、パターン３では、移動物体が電波センサ２５に向かって第１速度範囲Ｓ１内で移動しているときにＯＳＳＤ４信号を出力する。例えば、パターン３において、第１距離範囲Ａ１を４ｍ以上６ｍ以下、第２距離範囲Ａ２を２ｍ以上４ｍ未満、第３距離範囲Ａ３を２ｍ未満、第１速度範囲Ｓ１を０．３ｍ／ｓ以上などとしてもよい。パターン４は、距離１チャネル、速度３チャネルの出力を行う設定である。このパターン４では、第１距離範囲Ａ１内に移動物体があるときにＯＳＳＤ１信号を出力する（図７参照）。また、パターン４では、移動物体が電波センサ２５に向かって第１速度範囲Ｓ１内で移動しているときにＯＳＳＤ２信号を出力し、第１速度範囲Ｓ１よりも速い第２速度範囲Ｓ２内で移動物体が移動しているときにＯＳＳＤ３信号を出力し、第２速度範囲Ｓ２よりも速い第３速度範囲Ｓ３内で移動物体が移動しているときにＯＳＳＤ４信号を出力する。例えば、パターン４において、第１距離範囲Ａ１を３ｍ未満、第１速度範囲Ｓ１を０．１ｍ／ｓ以上０．３ｍ／ｓ未満、第２速度範囲Ｓ２を０．３ｍ／ｓ以上０．５ｍ／ｓ未満、第３距離範囲Ａ３を０．５ｍ／ｓ以上などとしてもよい。パターン１～４の第１～第４距離範囲Ａ１～Ａ４の各々は、同じ範囲に設定してもよいし、異なる範囲に設定するものとしてもよい。同様に、パターン１～４の第１～第３速度範囲Ｓ１～Ｓ３の各々は、同じ範囲に設定してもよいし、異なる範囲に設定してもよい。
　制御ＰＣ３０は、ワーク作業装置２０の全体を制御するコンピュータである。この制御ＰＣ３０は、制御装置３１と、表示部３８と、入力装置３９とを備えている。制御装置３１は、ＣＰＵ３２と、記憶部３３と、図示しない通信部とを備えている。制御装置３１は、ＣＰＵ３２を中心とするマイクロプロセッサとして構成されている。制御装置３１は、駆動部２４へ駆動信号を出力し、電波センサ２５から検出信号を入力する。記憶部３３は、例えば、ＨＤＤなど、大容量の記憶装置として構成されている。記憶部３３には、図３に示すように、モード設定情報３４や選択情報３５が記憶されている。モード設定情報３４は、ワーク作業装置２０を制御する動作モードを設定するために用いられる情報である。ワーク作業装置２０の動作モードには、例えば作業者などの移動物体との接触を抑制して安全性を高めるため、動作速度を制限する複数のモードを含んでいる。この動作モードには、移動物体との距離と移動物体の速度とに応じて設定されるモードであって、通常モード、小遅モード、中遅モード、大遅モード及び停止モードを含む。通常モードは、最速の動作速度で作業部２１を動作させるモードである。小遅モードは、通常モードよりも遅い第１の動作速度で作業部２１を動作させるモードである。中遅モードは、小遅モードよりも遅い第２の動作速度で作業部２１を動作させるモードである。大遅モードは、中遅モードよりも遅い第３の動作速度で作業部２１を動作させるモードである。停止モードは、作業部２１の動作を停止させるモードである。
　モード設定情報３４は、電波センサ２５からの出力信号のパターン１～４に応じて、それぞれ信号の種別と実行用モードに設定されるいずれかのモードとが対応づけられている。モード設定情報３４では、電波センサ２５から取得した距離値がより短いときにはより遅い傾向の動作モードを実行用モードに設定し、電波センサ２５から取得した速度値がより速いときにはより遅い傾向の動作モードを実行用モードに設定するようになっている。なお、「より遅い傾向に設定」とは、一部で速度が変わらない領域などがあることを許容し、全体としてみるとより遅くなるように設定される趣旨である。モード設定情報３４において、例えば、パターン１の対応情報では、信号なしや距離２チャネル及び速度２チャネルの信号と、通常モード、小遅モード、中遅モード、大遅モード及び停止モードのいずれかの動作モードとが対応づけられている。パターン２の対応情報では、信号なしや距離４チャネルの信号と、通常モード、小遅モード、中遅モード、大遅モード及び停止モードのいずれかの動作モードとが対応づけられている。パターン３の対応情報では、信号なしや距離３チャネル及び速度１チャネルの信号と、通常モード、小遅モード、中遅モード、大遅モード及び停止モードのいずれかの動作モードとが対応づけられている。パターン４の対応情報では、信号なしや距離１チャネル及び速度３チャネルの信号と、通常モード、小遅モード、中遅モード、大遅モード及び停止モードのいずれかの動作モードとが対応づけられている。モード設定情報３４を用いた具体的な実行用モードの設定については、詳しくは後述する。選択情報３５は、電波センサ２５から出力させる信号のパターンの種別を含む。この選択情報３５には、上記パターン１～４のうち、事前に作業者によって選択されたパターンが含まれている。
　次に、このように構成されたワーク作業システム１０の処理、特に動作モードを自動で設定しながら作業部２１が作業する処理について説明する。まず、この処理を実行する前に、作業者は、電波センサ２５からの出力信号のパターンを事前に選択する。制御装置３１は、選択されたパターンを選択情報３５に記憶させる。ここでは、選択情報３５にパターン１が記憶されている場合を主として説明する（図３参照）。図８は、制御装置３１のＣＰＵ３２が実行する作業実行ルーチンの一例を示すフローチャートである。このルーチンは、記憶部３３に記憶され、作業者による開始指示により実行される。このルーチンが開始されると、ＣＰＵ３２は、選択されているパターンを選択情報３５から読み出して取得し、電波センサ２５へ出力する（Ｓ１００）。これを受けた電波センサ２５では、選択されたパターンで信号を出力するよう、検出条件を切り替える。次に、ＣＰＵ３２は、選択パターンに応じたモード設定情報３４を読み出して取得する（Ｓ１１０）。ここでは、例えば、選択されているパターン１に応じた対応情報を取得する。次に、ＣＰＵ３２は、選択されているパターンがいずれであるかを判定し（Ｓ１２０）、選択されたパターンに応じて電波センサ２５から信号（距離情報及び速度情報）を取得し（Ｓ１３０～Ｓ１６０）、モード設定情報３４及び取得した信号に基づいて実行用モードを設定する（Ｓ１７０～Ｓ２００）。
　Ｓ１２０でパターン１が選択されている場合、ＣＰＵ３２は、モード設定情報３４に含まれるパターン１の対応情報と、電波センサ２５からの距離２チャネル及び速度２チャネルの信号とに基づいて動作モードに含まれる１つのモードを実行用モードに設定する（Ｓ１３０，１７０）。例えば、パターン１の対応情報において、ＣＰＵ３２は、図３に示すように、電波センサ２５から距離の信号及び速度の信号が取得されない場合、又は距離の信号が取得されず且つ第１速度範囲Ｓ１の信号が取得された場合には、移動物体と作業部２１との接触はないものとして通常モードを実行用モードに設定する。また、ＣＰＵ３２は、電波センサ２５から距離の信号が取得されず且つ第２速度範囲Ｓ２の信号が取得された場合、又は取得した信号が第１距離範囲Ａ１で且つ速度の信号が取得されない場合には、作業部２１の動作速度を若干遅くする小遅モードを実行用モードに設定する。同様に、ＣＰＵ３２は、電波センサ２５から取得した信号が第１距離範囲Ａ１及び第１速度範囲Ｓ１である場合には中遅モードを設定し、第１距離範囲Ａ１及び第２速度範囲Ｓ２である場合には大遅モードを実行用モードに設定する。また、ＣＰＵ３２は、電波センサ２５から取得した信号が第２距離範囲Ａ２である場合、速度の信号に関わらず、移動物体と作業部２１との接触を防止するため停止モードを実行用モードに設定する。
　Ｓ１２０でパターン２が選択されている場合、ＣＰＵ３２は、モード設定情報３４に含まれるパターン２の対応情報と、電波センサ２５からの距離４チャネルの信号とに基づいて動作モードに含まれる１つのモードを実行用モードに設定する（Ｓ１４０，１８０）。例えば、パターン２の対応情報において、ＣＰＵ３２は、電波センサ２５から距離の信号が取得されない場合には、通常モードを実行用モードに設定する。また、ＣＰＵ３２は、取得した信号が、第１距離範囲Ａ１である場合には作業部２１の動作速度を若干遅くする小遅モード、第２距離範囲Ａ２である場合には作業部２１の動作速度を中程度遅くする中遅モード、第３距離範囲Ａ３である場合には作業部２１の動作速度を大きく遅くする大遅モード、第４距離範囲Ａ４である場合には作業部２１の動作速度を停止する停止モードをそれぞれ実行用モードに設定する。
　Ｓ１２０でパターン３が選択されている場合、ＣＰＵ３２は、モード設定情報３４に含まれるパターン３の対応情報と、電波センサ２５からの距離３チャネル及び速度１チャネルの信号とに基づいて動作モードに含まれる１つのモードを実行用モードに設定する（Ｓ１５０，１９０）。パターン３の対応情報において、ＣＰＵ３２は、電波センサ２５から距離の信号及び速度の信号が取得されない場合、又は距離の信号が取得されず且つ第１速度範囲Ｓ１の信号が取得された場合には、移動物体と作業部２１との接触はないものとして通常モードが実行用モードに設定される（図６参照）。また、パターン３の対応情報では、取得した信号が第１距離範囲Ａ１で且つ速度の信号が取得されない場合、又は第１距離範囲Ａ１及び第１速度範囲Ｓ１の信号が取得された場合には、作業部２１の動作速度を若干遅くする小遅モードが実行用モードに設定される。また、パターン３の対応情報では、電波センサ２５から取得した信号が、第２距離範囲Ａ２で且つ速度の信号が取得されない場合には中遅モードが設定され、第２距離範囲Ａ２及び第２速度範囲Ｓ２であるときに大遅モードが実行用モードに設定される。また、パターン３の対応情報では、電波センサ２５から取得した信号が第３距離範囲Ａ３である場合には、速度の信号に関わらず、移動物体と作業部２１との接触を防止するため停止モードが実行用モードに設定される。
　Ｓ１２０でパターン４が選択されている場合、ＣＰＵ３２は、モード設定情報３４に含まれるパターン４の対応情報と、電波センサ２５からの距離１チャネル及び速度３チャネルの信号とに基づいて動作モードに含まれる１つのモードを実行用モードに設定する（Ｓ１６０，２００）。パターン４の対応情報において、ＣＰＵ３２は、電波センサ２５から距離の信号及び速度の信号が取得されない場合には、移動物体と作業部２１との接触はないものとして通常モードを実行用モードに設定する。また、ＣＰＵ３２は、電波センサ２５から距離の信号が取得されず且つ第１速度範囲Ｓ１の信号が取得された場合には、作業部２１の動作速度を若干遅くする小遅モードを実行用モードに設定する。同様に、ＣＰＵ３２は、電波センサ２５から距離の信号が取得されず且つ第２速度範囲Ｓ２の信号が取得された場合には中遅モードを設定し、距離の信号が取得されず且つ第３速度範囲Ｓ３の信号が取得された場合には大遅モードを実行用モードに設定する。また、ＣＰＵ３２は電波センサ２５から取得した信号が第１距離範囲Ａ１である場合には、速度の信号に関わらず、移動物体と作業部２１との接触を防止するため停止モードを実行用モードに設定する。
　Ｓ１７０～Ｓ２００で実行用モードを設定すると、ＣＰＵ３２は、設定した実行用モードを用いて作業部２１に所定の作業を実行させる（Ｓ２１０）。例えば、ワーク作業装置２０は、ワークＷを採取位置で採取し、配置位置へ移動して載置させるなどの作業を実行する。このとき、例えば、電波センサ２５の出力信号がパターン１～４の場合において、図４～７に示すように、ＣＰＵ３２は、同じエリアに移動物体があるときには移動速度がより大きいと作業部２１の動作速度をより遅くし、移動物体の移動速度が同じでも移動物体がより近いエリアにあると、作業部２１の動作速度をより遅くする。また、移動物体が電波センサ２５に最も近いエリアに入ったときには、ＣＰＵ３２は、作業部２１との接触を防止するため、作業部２１の動作を停止し、安全を確保するのである。そして、Ｓ２１０のあと、ＣＰＵ３２は、作業部２１の作業が完了したか否かを判定し（Ｓ２２０）、作業が完了していないときには、Ｓ１２０以降の処理を実行する。即ち、選択されたパターンに応じた信号を取得すると共に、その信号に応じて移動物体の距離及び速度に応じて実行用モードを設定し、設定した実行用モードで作業部２１を動作させる。一方、Ｓ２２０で作業部２１の作業が完了したときには、このルーチンを終了する。
　ここで、本実施形態の構成要素と本発明の構成要素との対応関係を明らかにする。本実施形態の作業部２１が本開示の作業部に相当し、ワーク作業装置２０がワーク作業装置に相当し、制御装置３１が制御装置に相当し、ＣＰＵ３２が制御部に相当する。また、本実施形態の通常モード及び停止モードが本開示の通常モード及び停止モードに相当し、小遅モード、中遅モード及び大遅モードが、速度序列の関係を守る前提において第１モード、第２モード及び第３モードのうちいずれかに相当する。なお、本実施形態では、制御装置３１の動作を説明することにより本開示の制御方法の一例も明らかにしている。
　以上説明した本実施形態の制御装置３１では、電波センサ２５から取得した、ワーク作業装置２０の外側にある移動物体（例えば作業者など）と作業部２１との間の距離情報及び移動物体が作業部２１へ向かう速度情報とに基づいて、作業部２１の実行用モードを設定する。即ち、このワーク作業装置２０では、移動物体の速度も考慮して作業部２１の動作モードを設定する。例えば、移動物体は、その速度が遅い場合、作業部２１と接触するまで時間がある一方、その速度が速い場合、作業部２１と接触するまで時間が短い場合がある。この制御装置３１では、このような速度を考慮して動作モードを設定するから、安全性と作業性とを両立したより適切な制御を行うことができる。また、制御部３１は、電波センサ２５から取得した距離情報がより短いときにはより遅い傾向の動作モードを実行用モードに設定し、電波センサ２５から取得した速度情報がより速いときにはより遅い傾向の動作モードを実行用モードに設定する。この制御装置３１では、移動物体が作業部２１に接触しやすい状況では作業部２１の動作をより遅くする傾向にするため、安全性と作業性とを両立したより適切な制御を行うことができる。
　また、制御装置３１は、パターン１において、電波センサ２５から第１距離範囲Ａ１及び第１速度範囲Ｓ１の信号を取得すると通常モードより遅い中遅モードを実行用モードに設定し、第１距離範囲Ａ１及び第２速度範囲Ｓ２の信号を取得すると中遅モードより遅い大遅モードを実行用モードに設定し、第２距離範囲Ａ２の信号を取得すると停止モードを前記実行用モードに設定する。この制御装置３１では、電波センサ２５からの信号値に応じて、更に適切な動作モードを設定することができる。また、制御装置３１は、パターン２において、電波センサ２５から信号を取得しないときには通常モード、第１距離範囲Ａ１の信号を取得すると小遅モード、第２距離範囲Ａ２の信号を取得すると中遅モード、第３距離範囲Ａ３の信号を取得すると大遅モード、第４距離範囲Ａ４の信号を取得すると停止モードを実行用モードに設定する。この制御装置３１では、電波センサ２５からの信号値に応じて、更に適切な動作モードを設定することができる。更に、制御装置３１は、パターン３において、電波センサ２５から第１距離範囲Ａ１及び第１速度範囲Ｓ１の検出値を取得すると小遅モード、第１速度範囲Ｓ１の信号を取得せず且つ第２距離範囲Ａ２の信号を取得すると中遅モード、第２距離範囲Ａ２及び第１速度範囲Ｓ１の信号を取得すると大遅モード、第３距離範囲Ａ３の信号を取得すると停止モードを実行用モードに設定する。この制御装置３１では、電波センサ２５からの信号値に応じて、更に適切な動作モードを設定することができる。更にまた、制御装置３１は、パターン４において、電波センサ２５から第１距離範囲Ａ１の信号を取得せず且つ第１速度範囲Ｓ１の信号を取得すると小遅モード、第１距離範囲Ａ１の信号を取得せず且つ第２速度範囲Ｓ２の信号を取得すると中遅モード、第１距離範囲Ａ１の信号を取得せず且つ第３速度範囲Ｓ３の信号を取得すると大遅モード、第１距離範囲Ａ１の信号を取得すると停止モードを実行用モードに設定する。この制御装置３１では、電波センサ２５からの信号値に応じて、更に適切な動作モードを設定することができる。
　また、制御装置３１は、パターン２、３において、第１距離範囲Ａ１内に移動物体がないときには通常モードを実行用モードに設定する。この制御装置３１では、移動物体がないときには高速で動作するため、作業性の低下をより抑制することができる。更に、パターン２では、パターン１の速度チャネルを距離チャネルに置き換えてより多段としており、使用者が選択可能となっているため、制御装置３１では、距離と速度を用いるか、より多段の距離を選択可能であり、より細かな動作モードを設定することによって、安全性と作業性とを両立したより適切な制御を行うことができる。
　なお、本開示は上述した実施形態に何ら限定されることはなく、本開示の技術的範囲に属する限り種々の態様で実施し得ることはいうまでもない。
　例えば、上述した実施形態では、パターン１～４を選択可能としたが、パターン２～４のいずれか１以上のパターンを省略してもよいし、例えば、速度４チャネルのパターンなど、パターン１～４以外のパターンを採用してもよい。制御装置３１は、少なくともパターン１を使用可能であれば、移動物体の距離と速度とに基づいて実行用モードを設定するから、安全性と作業性とを両立したより適切な制御を行うことができる。
　上述した実施形態では、モード設定情報３４のパターン１～４において、距離範囲と速度範囲とに応じた動作モードが適宜設定されているものとしたが、この動作モードの設定は、パターン１～４に示したものに限られない。例えば、モード設定情報３４のパターン１において、距離信号なし且つ第２速度範囲Ｓ２の信号が取得された場合、小遅モードを実行用モードに設定するものとしたが、これを通常モードとしてもよいし、中遅モードとしてもよい。同様に、パターン１において、第１距離範囲Ａ１及び第１速度範囲Ｓ１の信号が取得された場合、中遅モードを実行用モードに設定するものとしたが、これを小遅モードとしてもよいし、大遅モードとしてもよい。モード設定情報３４では、電波センサ２５から取得した距離値がより短いときにはより遅い傾向の動作モードを実行用モードに設定し、電波センサ２５から取得した速度値がより速いときにはより遅い傾向の動作モードを実行用モードに設定するものとすればよい。また、上述した実施形態では、小遅モード、中遅モード及び大遅モードがあるものとしたが、これに限定されず。これらのうち１～２つのいずれかの動作モードを省略してもよいし、更に１以上の動作モードを加えるものとしてもよい。この制御装置３１においても、移動物体の距離と速度とに基づいて実行用モードを設定するから安全性と作業性とを両立したより適切な制御を行うことができる。
　上述した実施形態では、ワーク作業装置２０は、ワークＷの移動作業を行うものとして主として説明したが、特にこれに限定されず、ワーク作業装置２０は、ワークＷに対して所定作業を行う作業部を備えるものとすれば、様々な作業を実行するものとしてもよい。例えば、ワーク作業装置２０は、採取位置から配置位置へ移動することを主として説明したが、部品を組み付ける組付け作業、加工を施す加工作業、粘性材料を塗布する塗布作業、加熱する加熱作業、化学的及び／又は物理的な所定処理を行う処理作業及び検査を行う検査作業などとしてもよい。また、ワーク作業装置２０は、多関節アーム２２を備えるアームロボットとしたが、特にこれに限定されず、ワーク作業装置はワークを移送する無人搬送車（ＡＧＶ）としてもよい。また、上述した実施形態では多関節アーム２２を作業部としたが、無人搬送車自体を作業部としてもよいし、無人搬送車が有する搬送物を出し入れする搬送部を作業部としてもよい。また、ワークＷは、例えば、機械部品、電気部品、電子部品、化学部品など各種の部品のほか、食品、バイオ、生物関連の物品などのいずれの物品としてもよい。
　上述した実施形態では、制御装置３１をワーク作業装置２０の外部に接続された制御ＰＣ３０として説明したが、特にこれに限定されず、例えば、ワーク作業装置２０の内部に備えるコントローラを制御装置３１としてもよい。
　ここで、本開示の制御装置は、以下のように構成してもよい。例えば、本開示の制御装置において、前記制御部は、前記電波センサから取得した前記距離情報がより短いときにはより遅い傾向の動作モードを前記実行用モードに設定し、前記電波センサから取得した前記速度情報がより速いときにはより遅い傾向の前記動作モードを前記実行用モードに設定するものとしてもよい。この制御装置では、移動物体が作業部に接触しやすい状況では作業部の動作をより遅くする傾向にするため、安全性と作業性とを両立したより適切な制御を行うことができる。
　本開示の制御装置において、前記制御部は、前記距離情報として第１距離範囲と前記第１距離よりも短い第２距離範囲との検出値を取得し、前記速度情報として第１速度範囲と前記第１速度よりも速い第２速度範囲との検出値を取得し、取得した検出値に基づいて、下記（１）～（３）のいずれか１以上で前記作業部の実行用モードを設定するものとしてもよい。この制御装置では、電波センサからの検出値に応じて、更に適切な動作モードを設定することができる。
（１）前記電波センサから前記第１距離範囲及び前記第１速度範囲の検出値を取得すると、前記第１モードを前記実行用モードに設定する。
（２）前記電波センサから前記第１距離範囲及び前記第２速度範囲の検出値を取得すると、前記第２モードを前記実行用モードに設定する。
（３）前記電波センサから前記第２距離範囲の検出値を取得すると、前記停止モードを前記実行用モードに設定する。
　本開示の制御装置において、前記動作モードには、前記第２モードよりも遅い動作で前記作業部を動作させる第３モード、を更に含み、前記制御部は、前記距離情報として第１距離範囲と前記第１距離よりも短い第２距離範囲と前記第２距離よりも短い第３距離範囲との検出値を取得し、前記速度情報として第１速度範囲の検出値を取得し、取得した検出値に基づいて、下記（４）～（７）のいずれか１以上で前記作業部の実行用モードを設定するものとしてもよい。この制御装置では、電波センサからの検出値に応じて、更に適切な動作モードを設定することができる。
（４）前記電波センサから前記第１距離範囲及び前記第１速度範囲の検出値を取得すると、前記第１モードを前記実行用モードに設定する。
（５）前記電波センサから前記第１速度範囲の検出値を取得せず、且つ前記第２距離範囲の検出値を取得すると、前記第２モードを前記実行用モードに設定する。
（６）前記電波センサから前記第２距離範囲及び前記第１速度範囲の検出値を取得すると、前記第３モードを前記実行用モードに設定する。
（７）前記電波センサから前記第３距離範囲の検出値を取得すると、前記停止モードを前記実行用モードに設定する。
　本開示の制御装置において、前記動作モードには、前記第２モードよりも遅い動作で前記作業部を動作させる第３モード、を更に含み、前記制御部は、前記距離情報として第１距離範囲の検出値を取得し、前記速度情報として第１速度範囲の検出値と前記第１速度よりも速い第２速度範囲の検出値と前記第２速度よりも速い第３速度範囲の検出値とを取得し、取得した検出値に基づいて、下記（８）～（１１）のいずれか１以上で前記作業部の実行用モードを設定するものとしてもよい。この制御装置では、電波センサからの検出値に応じて、更に適切な動作モードを設定することができる。
（８）前記電波センサから前記第１距離範囲の検出値を取得せず、且つ前記第１速度範囲の検出値を取得すると、前記第１モードを前記実行用モードに設定する。
（９）前記電波センサから前記第１距離範囲の検出値を取得せず、且つ前記第２速度範囲の検出値を取得すると、前記第２モードを前記実行用モードに設定する。
（１０）前記電波センサから前記第１距離範囲の検出値を取得せず、且つ前記第３速度範囲の検出値を取得すると、前記第３モードを前記実行用モードに設定する。
（１１）前記電波センサから前記第１距離範囲の検出値を取得すると、前記停止モードを前記実行用モードに設定する。
　本開示の制御装置において、前記制御部は、前記電波センサからの検出値で所定の第１距離範囲内に移動物体がないときには、前記第１モードよりも速い通常動作で前記作業部を動作させる通常モードを前記作業部の実行用モードに設定するものとしてもよい。この制御装置では、移動物体がないときには高速で動作するため、作業性の低下をより抑制することができる。
　本開示の制御装置において、前記制御装置は、前記距離情報と前記速度情報とを含む距離速度情報を前記電波センサから取得するか、前記距離速度情報における前記速度情報を前記距離情報に置き換えてより多段とした多段距離情報を前記電波センサから取得するかを使用者が選択した選択情報を有し、前記制御部は、前記多段距離情報が選択されているときには、前記距離速度情報を取得するときに比してより多段に異なる速度を含む前記動作モードを前記実行用モードに用いるものとしてもよい。この制御装置では、距離と速度を用いるか、より多段の距離を用いることができるため、より細かな動作モードを設定することによって、安全性と作業性とを両立したより適切な制御を行うことができる。
　多段距離情報を用いる制御装置において、前記動作モードには、前記第２モードよりも遅い動作で前記作業部を動作させる第３モード、を更に含み、前記制御部は、前記距離情報として第１距離範囲と前記第１距離よりも短い第２距離範囲と前記第２距離よりも短い第３距離範囲と前記第３距離よりも短い第４距離範囲との検出値を取得し、取得した検出値に基づいて、下記（１２）～（１５）のいずれか１以上で前記作業部の実行用モードを設定するものとしてもよい。この制御装置では、電波センサからの検出値に応じて、更に適切な動作モードを設定することができる。
（１２）前記電波センサから前記第１距離範囲の検出値を取得すると、前記第１モードを前記実行用モードに設定する。
（１３）前記電波センサから前記第２距離範囲の検出値を取得すると、前記第２モードを前記実行用モードに設定する。
（１４）前記電波センサから前記第３距離範囲の検出値を取得すると、前記第３モードを前記実行用モードに設定する。
（１５）前記電波センサから前記第４距離範囲の検出値を取得すると、前記停止モードを前記実行用モードに設定する。
　本開示のワーク作業装置は、ワークに対して所定の作業を実行する作業部と、前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報と検出可能な電波センサと、上述したいずれかの制御装置と、を備えたものである。このワーク作業装置は、上述したいずれかの制御装置を備えるため、制御装置と同様の効果を得ることができる。
　本開示のワーク作業システムは、ワークに対して所定の作業を実行する作業部と、前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報と検出可能な電波センサとを備えたワーク作業装置と、上述したいずれかの制御装置と、を備えたものである。このワーク作業システムは、上述したいずれかの制御装置を備えるため、この制御装置と同様の効果を得ることができる。
　本開示の制御方法は、
　ワークに対して所定の作業を実行する作業部を備え、第１の動作で前記作業部を動作させる第１モードと、前記第１モードよりも遅い第２の動作で前記作業部を動作させる第２モードと、前記作業部の動作を停止させる停止モードとを含む動作モードを有するワーク作業装置に用いられる制御方法であって、
　前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報とを電波センサから取得し、取得した前記距離情報及び前記速度情報に基づいて、前記作業部の実行用モードを前記動作モードから設定するステップ、
　を含むものである。
　この制御方法では、上述した制御装置と同様に、速度を考慮して動作モードを設定するから、安全性と作業性とを両立したより適切な制御を行うことができる。なお、この制御方法において、上述したいずれかの制御装置の態様を採用してもよいし、上述したいずれかの制御装置の機能を発現するステップを含むものとしてもよい。
　本明細書で開示する制御装置、ワーク作業装置、ワーク作業システム及び制御方法は、ワークに対して所定作業を実行する装置の技術分野に利用可能である。
１０　ワーク作業システム、２０　ワーク作業装置、２１　作業部、２２　多関節アーム、２３　エンドエフェクタ、２４　駆動部、２５　電波センサ、３０　制御ＰＣ（パソコン）、３１　制御装置、３２　ＣＰＵ、３３　記憶部、３４　モード設定情報、３５　選択情報、Ａ１　第１距離範囲、Ａ２　第２距離範囲、Ａ３　第３距離範囲、Ａ４　第４距離範囲、Ｓ１　第１速度範囲、Ｓ２　第２速度範囲、Ｓ３　第３速度範囲、Ｗ　ワーク。

Claims (8)

  1. 　ワークに対して所定の作業を実行する作業部を備え、第１の動作で前記作業部を動作させる第１モードと、前記第１モードよりも遅い第２の動作で前記作業部を動作させる第２モードと、前記作業部の動作を停止させる停止モードとを含む動作モードを有するワーク作業装置に用いられる制御装置であって、
    　前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報とを電波センサから取得し、取得した前記距離情報及び前記速度情報に基づいて、前記作業部の実行用モードを前記動作モードから設定する制御部、
    　を備えた制御装置。
  2. 　前記制御部は、前記電波センサから取得した前記距離情報がより短いときにはより遅い傾向の動作モードを前記実行用モードに設定し、前記電波センサから取得した前記速度情報がより速いときにはより遅い傾向の前記動作モードを前記実行用モードに設定する、請求項１に記載の制御装置。
  3. 　前記制御部は、前記距離情報として第１距離範囲と前記第１距離よりも短い第２距離範囲との検出値を取得し、前記速度情報として第１速度範囲と前記第１速度よりも速い第２速度範囲との検出値を取得し、取得した検出値に基づいて、下記（１）～（３）のいずれか１以上で前記作業部の実行用モードを設定する、請求項１または２に記載の制御装置。
    （１）前記電波センサから前記第１距離範囲及び前記第１速度範囲の検出値を取得すると、前記第１モードを前記実行用モードに設定する。
    （２）前記電波センサから前記第１距離範囲及び前記第２速度範囲の検出値を取得すると、前記第２モードを前記実行用モードに設定する。
    （３）前記電波センサから前記第２距離範囲の検出値を取得すると、前記停止モードを前記実行用モードに設定する。
  4. 　前記制御部は、前記電波センサからの検出値で所定の第１距離範囲内に移動物体がないときには、前記第１モードよりも速い通常動作で前記作業部を動作させる通常モードを前記作業部の実行用モードに設定する、請求項１～３のいずれか１項に記載の制御装置。
  5. 　前記距離情報と前記速度情報とを含む距離速度情報を前記電波センサから取得するか、前記距離速度情報における前記速度情報を前記距離情報に置き換えてより多段とした多段距離情報を前記電波センサから取得するかを使用者が選択した選択情報を有し、
    　前記制御部は、前記多段距離情報が選択されているときには、前記距離速度情報を取得するときに比してより多段に異なる速度を含む前記動作モードを前記実行用モードに用いる、請求項１～４のいずれか１項に記載の制御装置。
  6. 　ワークに対して所定の作業を実行する作業部と、
    　前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報と検出可能な電波センサと、
    　請求項１～５のいずれか１項に記載の制御装置と、
    　を備えたワーク作業装置。
  7. 　ワークに対して所定の作業を実行する作業部と、前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報と検出可能な電波センサとを備えたワーク作業装置と、
    　請求項１～５のいずれか１項に記載の制御装置と、
    　を備えたワーク作業システム。
  8. 　ワークに対して所定の作業を実行する作業部を備え、第１の動作で前記作業部を動作させる第１モードと、前記第１モードよりも遅い第２の動作で前記作業部を動作させる第２モードと、前記作業部の動作を停止させる停止モードとを含む動作モードを有するワーク作業装置に用いられる制御方法であって、
    　前記ワーク作業装置の外側にある移動物体と前記作業部との間の距離情報及び前記移動物体が前記作業部へ向かう速度情報とを電波センサから取得し、取得した前記距離情報及び前記速度情報に基づいて、前記作業部の実行用モードを前記動作モードから設定するステップ、
    　を含む制御方法。
PCT/JP2019/000703 2019-01-11 2019-01-11 制御装置、ワーク作業装置、ワーク作業システム及び制御方法 WO2020144852A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2020565139A JP7145237B2 (ja) 2019-01-11 2019-01-11 制御装置、ワーク作業装置、ワーク作業システム及び制御方法
EP19909309.7A EP3909726A4 (en) 2019-01-11 2019-01-11 CONTROL DEVICE, WORKING APPARATUS, WORKING SYSTEM AND CONTROL METHOD
PCT/JP2019/000703 WO2020144852A1 (ja) 2019-01-11 2019-01-11 制御装置、ワーク作業装置、ワーク作業システム及び制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2019/000703 WO2020144852A1 (ja) 2019-01-11 2019-01-11 制御装置、ワーク作業装置、ワーク作業システム及び制御方法

Publications (1)

Publication Number Publication Date
WO2020144852A1 true WO2020144852A1 (ja) 2020-07-16

Family

ID=71520310

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/000703 WO2020144852A1 (ja) 2019-01-11 2019-01-11 制御装置、ワーク作業装置、ワーク作業システム及び制御方法

Country Status (3)

Country Link
EP (1) EP3909726A4 (ja)
JP (1) JP7145237B2 (ja)
WO (1) WO2020144852A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220288784A1 (en) * 2019-08-30 2022-09-15 Johnan Corporation Control device, control method, and program
WO2023135664A1 (ja) * 2022-01-12 2023-07-20 株式会社Fuji ロボットの安全装置およびロボットシステム

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006043861A (ja) * 2004-08-09 2006-02-16 Honda Motor Co Ltd マン・マシン作業システム
JP2010120139A (ja) * 2008-11-21 2010-06-03 New Industry Research Organization 産業用ロボットの安全制御装置
JP2012130986A (ja) * 2010-12-21 2012-07-12 Toyota Motor Corp 移動体
JP2013545625A (ja) * 2010-12-16 2013-12-26 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング 操作装置のため、特に産業用ロボットのための安全装置、並びに、安全装置の動作方法
WO2014008929A1 (de) * 2012-07-10 2014-01-16 Siemens Aktiengesellschaft Roboteranordnung und verfahren zum steuern eines roboters
JP2014176932A (ja) * 2013-03-15 2014-09-25 Yaskawa Electric Corp ロボットシステム、及び、ロボットシステムの制御方法
JP2016193473A (ja) * 2015-04-01 2016-11-17 富士電機株式会社 駆動制御装置および安全制御システム
JP2017080845A (ja) * 2015-10-28 2017-05-18 株式会社デンソーウェーブ ロボット制御システム
WO2018131237A1 (ja) * 2017-01-13 2018-07-19 三菱電機株式会社 協働ロボットシステム、及びその制御方法
JP2018126818A (ja) 2017-02-07 2018-08-16 トヨタ自動車株式会社 ロボット制御装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110298579A1 (en) * 2010-06-08 2011-12-08 Cedes Safety & Automation Ag Dynamically adaptable safety zones

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006043861A (ja) * 2004-08-09 2006-02-16 Honda Motor Co Ltd マン・マシン作業システム
JP2010120139A (ja) * 2008-11-21 2010-06-03 New Industry Research Organization 産業用ロボットの安全制御装置
JP2013545625A (ja) * 2010-12-16 2013-12-26 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング 操作装置のため、特に産業用ロボットのための安全装置、並びに、安全装置の動作方法
JP2012130986A (ja) * 2010-12-21 2012-07-12 Toyota Motor Corp 移動体
WO2014008929A1 (de) * 2012-07-10 2014-01-16 Siemens Aktiengesellschaft Roboteranordnung und verfahren zum steuern eines roboters
JP2014176932A (ja) * 2013-03-15 2014-09-25 Yaskawa Electric Corp ロボットシステム、及び、ロボットシステムの制御方法
JP2016193473A (ja) * 2015-04-01 2016-11-17 富士電機株式会社 駆動制御装置および安全制御システム
JP2017080845A (ja) * 2015-10-28 2017-05-18 株式会社デンソーウェーブ ロボット制御システム
WO2018131237A1 (ja) * 2017-01-13 2018-07-19 三菱電機株式会社 協働ロボットシステム、及びその制御方法
JP2018126818A (ja) 2017-02-07 2018-08-16 トヨタ自動車株式会社 ロボット制御装置

Non-Patent Citations (1)

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

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220288784A1 (en) * 2019-08-30 2022-09-15 Johnan Corporation Control device, control method, and program
WO2023135664A1 (ja) * 2022-01-12 2023-07-20 株式会社Fuji ロボットの安全装置およびロボットシステム

Also Published As

Publication number Publication date
EP3909726A4 (en) 2022-01-19
JPWO2020144852A1 (ja) 2021-09-27
JP7145237B2 (ja) 2022-09-30
EP3909726A1 (en) 2021-11-17

Similar Documents

Publication Publication Date Title
US10564635B2 (en) Human-cooperative robot system
JP6364096B2 (ja) ロボットシステム
US10213922B2 (en) Robot control apparatus and robot system
US20160008978A1 (en) Robot control device for preventing misjudgment by collision judging part
WO2020144852A1 (ja) 制御装置、ワーク作業装置、ワーク作業システム及び制御方法
JPH05104391A (ja) ロボツトを用いた扉開閉制御装置
US9599978B2 (en) Numerical control apparatus having function of reducing path to start point in canned cycle
JP4391381B2 (ja) 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法
US10780579B2 (en) Work robot system
JPWO2019106963A1 (ja) 機械設備制御システム、機械設備制御装置、及び機械設備制御方法
EP1418663A1 (en) Electric motor controller resonance frequency detection apparatus
JP2014037031A (ja) 生産システム、ロボット、制御装置、プログラム、及び生産方法
US20210283774A1 (en) Robot, control device, and information processing device
JP2009202335A (ja) 減速機の異常判定装置及び減速機の異常判定方法
CN110315558B (zh) 协作机器人的控制装置和控制方法
JP2001037289A (ja) サーボモータおよび多関節ロボットの異常負荷検出制御方法
CN114074323B (zh) 一种确保机器人速度和动量边界限制的安全系统
CN113771026A (zh) 一种提升安全控制性能的工业机器人及其控制方法
JP5382419B2 (ja) 原点サーチ支援装置及びプログラム
JP3855629B2 (ja) ロボットの干渉検出装置
US20210178577A1 (en) Control method and robot system
US11485012B2 (en) Control method and robot system
KR100624891B1 (ko) 공작기계의 급속이송제어방법
JP2008253132A (ja) サーボモータおよび多関節ロボットの異常負荷検出制御方法
JPH09141582A (ja) 力制御ロボットの接触位置検出装置

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: 19909309

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2020565139

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: 2019909309

Country of ref document: EP

Effective date: 20210811