WO2023038120A1 - ロボット制御システム - Google Patents

ロボット制御システム Download PDF

Info

Publication number
WO2023038120A1
WO2023038120A1 PCT/JP2022/033899 JP2022033899W WO2023038120A1 WO 2023038120 A1 WO2023038120 A1 WO 2023038120A1 JP 2022033899 W JP2022033899 W JP 2022033899W WO 2023038120 A1 WO2023038120 A1 WO 2023038120A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
safety
work
switching
scene
Prior art date
Application number
PCT/JP2022/033899
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 株式会社デンソーウェーブ
Publication of WO2023038120A1 publication Critical patent/WO2023038120A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06Safety devices

Definitions

  • the present invention relates to a robot control system.
  • Robots such as industrial robots are provided with a control mechanism to prevent the robot from colliding with other objects such as workpieces, or to ensure safety in the event of a collision.
  • a control method when an abnormal load is detected in servo motor control a torque command of a predetermined magnitude is issued in a direction opposite to the rotational direction of the servo motor immediately before the abnormal load is detected.
  • An abnormal load detection control method for a servomotor has been proposed, which is characterized in that the servomotor is given a predetermined time.
  • the main purpose of the present invention is to provide a robot control system that can favorably improve the safety and work efficiency of robots.
  • the safety-related input signal including a parameter correlated to the force and/or speed of the robot at work and pre-stored criteria for the parameter.
  • a safety-related part that has a motion determination part that determines the motion of the robot and that realizes the safety function of the robot by generating a safety-related output signal according to the determination result;
  • a situation identification unit that identifies the working situation of the robot during work from among a plurality of preset work situations in which the robot works;
  • a criterion switching unit for switching the criterion for the parameters referred to by the motion determining unit to a criterion corresponding to the work situation identified by the situation identifying unit;
  • FIG. 1 is a schematic diagram showing an example layout of a factory to which the robot control system according to the first embodiment of the present invention can be applied;
  • FIG. 1 is a perspective view of a robot to which a robot control system according to a first embodiment of the invention can be applied;
  • FIG. 3 is a block diagram showing an electrical configuration of the robot shown in FIG. 2;
  • FIG. 3 is a flow chart showing the work flow of the robot shown in FIG. 2;
  • FIG. 3 is a schematic diagram comparing work scenes of the robot shown in FIG. 2 ;
  • 3 is a schematic diagram showing the relationship between safety-related parts and non-safety-related parts provided in the robot control system according to the first embodiment of the present invention;
  • 4 is a flowchart showing motion monitoring processing performed by the robot control system according to the first embodiment of the present invention
  • 4 is a table illustrating control devices for instructing switching of safety functions used in the robot control system according to the first embodiment of the present invention
  • 4 is a flowchart showing task monitoring processing performed by the robot control system according to the first embodiment of the present invention
  • FIG. 4 is a configuration diagram of a request command transmitted from a non-safety-related part to the robot control system according to the first embodiment of the present invention
  • 4 is a table for explaining the structure of a request command transmitted from a non-safety-related part to the robot control system according to the first embodiment of the present invention
  • 4 is a flow chart showing the flow of a scene change sequence by the robot control system according to the first embodiment of the present invention
  • 4 is a table for explaining determination criteria for each scene in the robot control system according to the first embodiment of the present invention
  • FIG. 10 is a graph showing the relationship between the reference value and the detection value of the judgment criteria set by the safety-related part when the work scene changes.
  • FIG. 10 is a graph showing the relationship between the reference value and the detection value of the judgment criteria set by the safety-related part when the work scene changes.
  • FIG. 10 is a flow chart showing scene switching monitoring processing performed by the robot control system according to the second embodiment of the present invention.
  • FIG. 9 is a timing chart showing changes in detected values when work scenes are switched by the robot control system according to the second embodiment of the present invention;
  • FIG. 11 is a flowchart showing scene switching monitoring processing performed by a robot control system according to a third embodiment of the present invention;
  • FIG. FIG. 11 is a timing chart showing changes in detected values when work scenes are switched by the robot control system according to the third embodiment of the present invention;
  • FIG. FIG. 11 is a schematic diagram showing an object detection area applied in a robot control system according to a fourth embodiment of the present invention;
  • FIG. 11 is a flowchart showing special switching monitoring processing performed by the robot control system according to the third embodiment of the present invention;
  • a robot control system applied to a robot such as an industrial robot includes a non-safety-related part that controls the drive of the robot and a safety-related part that realizes the safety function of the robot.
  • the safety-related part for example, when an obstacle such as a person collides, the robot is forced to stop, or the force (thrust) and speed of the robot being driven are monitored and It is conceivable to forcibly stop the robot when it moves.
  • the present invention has been made in view of the above problems, and a main object thereof is to suitably improve the safety and work efficiency of robots. Means for solving the above problems will be described below.
  • a motion determination unit that determines motion of the robot based on safety-related input signals containing parameters correlated with at least one of the force and speed of the robot during operation and pre-stored criteria for the parameters. a safety-related part that realizes the safety function of the robot by generating a safety-related output signal according to the determination result; a situation identification unit that identifies the working situation of the robot during work from among a plurality of preset work situations in which the robot works; a criterion switching unit for switching the criterion for the parameters referred to by the motion determining unit to a criterion corresponding to the work situation identified by the situation identifying unit; A robot control system with
  • the safety function in order to improve the safety of the robot, it is also possible to configure the safety function to change sequentially each time the operating state (position, orientation, speed, etc.) of the robot changes.
  • a configuration increases the control load on the robot control system, which affects the original function of the robot control system (robot drive control).
  • robot drive control considering the fact that the movement of the robot changes for each task, as shown in this feature, switching the determination criteria for each task scene can reduce the impact on the original functions of the robot control system.
  • safety can be improved.
  • a stock area E1 in which shelves 12 for storing materials conveyed by a conveyor 11 and shelves 13 for storing empty containers (so-called returnable boxes) 18 are arranged, and a stock area E1 for molding works.
  • a processing area E2 in which a plurality of processing machines 14 are arranged, a stacking area E3 for stacking formed works, and a passage E4 connecting these areas E1 to E3 are provided.
  • the robot 20 shown in this embodiment moves between the areas E1 to E3 through the passage E4 and engages in predetermined work in each place.
  • the robot 20 includes an AGV (Automated Guided Vehicle) 31, a vertical articulated robot arm 41 mounted on the AGV 31, and a control device 50 (see FIG. 2) that controls the AGV 31 and the robot arm 41. 3).
  • AGV Automated Guided Vehicle
  • control device 50 see FIG. 2 that controls the AGV 31 and the robot arm 41. 3).
  • the AGV 31 is provided with a travel motor 35 and a magnetic sensor 36 capable of detecting the magnetism of a guide tape for magnetic induction laid on the floor of the factory 10 .
  • the traveling control of the AGV 31, for example, the drive control and steering control of the traveling motor 35, is performed based on the magnetism and the like.
  • guide tapes are arranged in the areas E1 to E3 and the path E4 so as to connect the areas E1 to E3, and the guide tapes define the moving route (running route) of the robot 20.
  • a mounting portion 32 on which the container 18 is mounted is formed on the upper surface of the body of the AGV 31 , and the container 18 can be moved while being mounted on the mounting portion 32 .
  • the AGV 31 is also provided with a laser scanner 37 for detecting obstacles on the path of the robot 20 and an emergency stop switch 38 operated by an operator or the like in an emergency.
  • These laser scanner 37 and emergency stop switch 38 function as input units for safety-related units, which will be described later, and are configured to bring the robot 20 to an emergency stop when an obstacle is detected or an emergency stop operation is detected.
  • there is In this emergency stop not only the AGV 31 but also the robot arm 41 are to be stopped.
  • the robot arm 41 includes a base fixed to the upper surface of the body of the AGV 31 (next to the placement section 32), an arm attached to the base, and a hand 42 (end effector) provided at the tip (tip) of the arm. have.
  • the arm is formed by connecting a plurality of movable parts, and for each joint part, there are a drive motor 45 that drives the movable parts, a rotary encoder 46 that detects the rotation angle of each joint part (shaft), and each joint part (shaft). ) is provided (see FIG. 3).
  • the drive motor 45, the rotary encoder 46, and the torque sensor 47 are connected to the control device 50.
  • the rotation angle and the like detected by the rotary encoder 46 are Drive control of each drive motor 45 is performed based on the above.
  • control device 50 includes a drive control section 51 and a monitoring control section (safety controller) 52 of the control device 50 that drive and control each section of the robot 20 such as the AGV 31 and the robot arm 41 .
  • the drive control unit 51 includes a semiconductor integrated circuit capable of calculation and a storage device. Examples of operable semiconductor integrated circuits include arithmetic units such as CPU (Central Processing Unit), ASIC (Application Specific Integrated Circuit), MPU (Micro Processor Unit), FGPA (Field Programmable Gate Array), FPAA (Field Programmable Analog Array) and the like, and PLDs (Programmable Logic Devices), etc., can be cited, and one of them can be used alone, or two or more of them can be used in combination.
  • CPU Central Processing Unit
  • ASIC Application Specific Integrated Circuit
  • MPU Micro Processor Unit
  • FGPA Field Programmable Gate Array
  • FPAA Field Programmable Analog Array
  • the storage device includes a main storage device and an auxiliary storage device.
  • the main memory includes SRAM (Static RAM), DRAM (Dynamic RAM), pseudo SRAM, FeRAM (Ferroelectric RAM), MRAM (Magnetoresistive RAM), ReRAM (Resistive RAM), PRAM (Phase change RAM), etc. One of these may be used alone, or two or more may be used in combination.
  • Auxiliary storage devices include hard disk drives (HDDs), solid state drives (SSDs), optical disks, magneto-optical disks, flash memories, etc., and one of these may be used alone or in combination of two or more. can be done.
  • the drive control unit 51 may include a device in which a main memory device, an auxiliary memory device, and a semiconductor integrated circuit capable of operation are integrated in advance.
  • the monitoring control unit 52 realizes the safety function of the robot 20 by outputting safety-related output signals in response to safety-related input signals.
  • the monitor control unit 52 also includes a semiconductor integrated circuit capable of performing calculations and a storage device, and can be appropriately configured from the semiconductor integrated circuit capable of performing various calculations and the storage device, etc., similar to the drive control unit 51 .
  • the monitor control part 52 is demonstrated as what is comprised by FPGA (safety FPGA).
  • a teaching pendant 60 can be connected to the control device 50 via a communication cable.
  • a setting support application is installed in the teaching pendant 60 to assist the user in setting the movement of the robot 20 (including so-called teaching).
  • the teaching pendant 60 transmits an operation sequence (operation program) indicating the movement of the robot 20 set by the user to the control device 50, and the drive control unit 51 of the control device 50 controls the AGV 31 and the robot arm 41 based on this operation sequence. drive control.
  • the teaching pendant 60 also includes a semiconductor integrated circuit and a storage device capable of performing calculations, and can be appropriately configured with the above-described semiconductor integrated circuits and storage devices capable of performing various calculations, similar to the drive control unit 51 .
  • FIG. 1 The work performed by the robot 20 will be described below with reference to FIGS. 1 and 4.
  • FIG. 1 The robot 20 first sets an empty container 18 on itself in the stock area E1 (scene SN1). Specifically, the robot 20 extends the robot arm 41 to grab an empty container 18 stored on the shelf 13 and places the container 18 on its own placement section 32 . After that, the robot arm 41 is returned to the standby posture and moved to the processing area E2 through the path E4 (scene SN2). Note that the robot arm 41 in the standby posture is prevented from protruding from the AGV 31 when the robot 20 is viewed from above.
  • the robot 20 collects finished workpieces from the plurality of machining machines 14 arranged in the machining area E2 (scene SN3). Specifically, the robot 20 extends the robot arm 41 to grab a workpiece held by a chuck of the processing machine 14 with a hand 42, takes out the workpiece, and stores it in the set container 18. The robot 20 repeats this movement for each processing machine 14, and the collection is completed when the number of collected works reaches a predetermined number. After completing the collection, the robot 20 returns the robot arm 41 to the waiting posture, and conveys the container 18 containing the works to the stacking area E3 through the path E4 (scene SN4).
  • the robot 20 unloads the container 18 containing the works. Specifically, the robot 20 stacks the container 18 on the pallet 15 (scene SN5). The container 18 group stacked on the pallet 15 is sequentially conveyed to the next process (for example, another processing process).
  • the robot 20 After unloading in the stacking area E3, the robot 20 returns the robot arm 41 to the standby posture and moves from the stacking area E3 to the end point of the conveyor 11 through the passage E4 (scene SN6). Then, the robot 20 receives the container 18 containing the work material from the conveyor 11 (scene SN7). Specifically, the container 18 is set on the placement section 32 by a crane attached to the conveyor 11 . Upon receiving this, the robot arm 41 temporarily turns to avoid collision with the container 18 .
  • the robot 20 in which the container 18 is set transports the container 18 through the passage E4 to the stock area E1 (scene SN8). After reaching the stock area E1, the robot 20 stores the set container 18 on the shelf 12 (scene SN9).
  • the robot 20 repeats the series of operations of scenes SN1 to SN9 again.
  • the work routine of the robot 20 is constructed by the scenes SN1 to SN9. Note that scenes SN7 to SN9 are skipped depending on the operation status of the conveyor 11. FIG.
  • the above scene switching is preferably performed at the timing when all of the multiple tasks in the current scene are completed. As a result, it is possible to suppress unintentional movements of the robot 20 that may occur due to scene switching during the task, and to improve the safety of the robot 20 .
  • Scenes SN1 to SN9 differ not only in the area where the robot 20 is located and the specific content of the work, but also in the relationship with humans (whether or not there is cooperation, etc.). Some scenes in the work routine, specifically scenes SN3 to SN5, will be described below with reference to FIG. In the following description, "scene” is also referred to as "work scene” for convenience. A work scene is an example of a work situation.
  • the processing area E2 where the work (picking) of scene SN3 is performed is a collaborative area where the person in charge of the area (person) works together with the robot 20. Specifically, each work of taking out the material from the container 18 stored on the shelf 12 and putting it into the processing machine 14, the setting work of each processing machine 14, and the operation confirmation work of each processing machine 14 This is the role of the person in charge of the machining area E2, and the role of the robot 20 is to collect the workpieces after machining. That is, in the processing area E2, both the person in charge of the area and the robot 20 share the work related to the processing machine .
  • the work area is defined to be passage E4, and for the work (palletizing) of scene SN5, the work area is defined to be stacking area E3.
  • Each work of scenes SN4 and SN5 is different from scene SN3 in that it is a single work (non-collaborative work) of the robot 20 .
  • people such as the person in charge of the area
  • people are basically prohibited from entering the scene SN5.
  • the possibility of contact between the human and the robot 20 is higher in scene SN4 than in scene SN5.
  • the robot 20 may come into contact with people during the work routine, and is equipped with a configuration that enhances the safety of the robot 20 in addition to the laser scanner 37 and the emergency stop switch 38 described above.
  • a configuration relating to the safety function of the robot 20 will be supplementarily described below with reference to FIG.
  • the robot control system CS applied to the robot 20 is installed inside the robot 20 in this embodiment, and performs various controls of the robot 20 .
  • the robot control system CS also includes a safety-related part X that realizes the safety function of the robot 20 by outputting a safety-related output signal in response to a safety-related input signal, and an AGV 31 whose safety is confirmed by the safety-related part X. and a non-safety-related part Y that controls the driving of the AGV 31 and the robot arm 41 when the operation of the robot arm 41 is permitted.
  • the safety-related part X is composed of an input part X1 for inputting the safety-related input signal, a logic part X2 for confirming safety, and an output part X3 for outputting the safety-related output signal.
  • the input unit X1 includes various physical input means such as an emergency stop switch 38, various sensors such as a laser scanner 37, a rotary encoder 46 and a torque sensor 47, and the like.
  • the logic unit X2 includes a monitoring control unit (safety controller) 52 provided in the control device 50, and the output unit X3 includes various output means such as a safety contactor attached to the control device 50.
  • the logic section X2 is realized by a semiconductor integrated circuit and a storage device that are included in the monitor control section 52, and various functions of the logic section X2 are realized.
  • the safety contactor is connected to a switch provided in the drive circuit for the travel motor 35 of the AGV 31 and a switch provided in the drive circuit for the drive motor 45 of the robot arm 41 .
  • the safety-related part X shown in this embodiment includes the rotary encoder 46 and the torque sensor 47 in addition to the laser scanner 37 and the emergency stop switch 38 . That is, the detection signal from the rotary encoder 46 and the detection signal from the torque sensor 47 are input to the logic section X2 as the safety-related input signals.
  • the logic section X2 monitors the motion of the robot 20 based on detection signals from the rotary encoder 46 and the torque sensor 47.
  • FIG. operation monitoring processing executed as a part of regular processing by the logic unit X2 (monitoring control unit 52 of the control device 50) will be described with reference to the flowchart of FIG.
  • step S101 the logic unit X2 detects the force (so-called tool center point) of the hand (so-called tool center point) of the robot 20 (robot arm 41) based on the detection signals from the rotary encoder 46 and the torque sensor 47. (thrust), speed, and position (coordinates).
  • the logic unit X2 determines whether the hand force is weaker than a predetermined reference value (force threshold). This reference value is stored in advance in the memory of the control device 50 . If the force of the hand is weaker than the reference value, the logic unit X2 proceeds to step S103 and determines whether the speed of the hand is slower than the reference value (speed threshold). If the speed of the hand is slower than the reference value, the logic unit X2 proceeds to step S104 and determines whether the position of the hand is within the reference range (permissible range of motion). That is, the logic section X2 includes a motion determination section that determines motion of the robot based on safety-related input signals and determination criteria. If the position of the hand is within the reference range, the logic unit X2 ends this operation control process. In the following description, each reference value and reference range are also referred to as "determination criteria”.
  • logic section X2 determines whether any of the three requirements shown in steps S102-S104 are not satisfied. If any of the three requirements shown in steps S102-S104 are not satisfied, logic section X2 generates a predetermined safety-related output signal. The logic section X2 then outputs the safety-related output signal to each target section via the output section X3 to implement the safety function. Specifically, the logic unit X2 outputs a safety-related signal via the output unit X3, and after executing each process for emergency stop and abnormality notification in step S105, ends this operation monitoring process. do. In the emergency stop process, the logic unit X2 forcibly cuts off the power supply to the motors 35 and 45 via the output unit X3 to stop the robot 20 (hereinafter also referred to as emergency stop).
  • the logic unit X2 turns on a warning lamp provided on the robot 20 via the output unit X3, and transmits information indicating that an abnormality has occurred to the management system of the factory 10.
  • the force, speed, and position of the hand of the robot 20 are motion monitoring parameters for monitoring the motion of the robot 20 .
  • motion monitoring parameters are not limited to the force, speed, and position of the hand of the robot 20 .
  • parameters indicating force rotational torque
  • speed rotational speed
  • position of each joint shaft
  • the criterion of the motion monitoring parameter also functions as a target for suppressing (restricting) the motion of the robot arm 41 (specifically, the hand).
  • the robot arm 41 is pushed and pulled by momentum, and the movement that exceeds the above-described criterion is not performed. can be set. Even in such a case, the movement of the robot arm 41 is corrected so that it does not exceed the criterion, thereby suppressing frequent emergency stops caused by exceeding the criterion during work.
  • the safety function of the robot 20 specifically, the judgment criteria of each operation monitoring parameter can be switched in a plurality of stages.
  • a configuration related to switching of safety functions will be described with reference to FIG. 8 .
  • a control device capable of switching safety functions by the safety-related part X (1) a teaching pendant 60, (2) a drive control part 51 (specifically, a pack script), and (3) an external general-purpose input/output (hereinafter referred to as IO). There are three. All of these three control devices correspond to the non-safety-related part Y.
  • the connected external device can also function as a non-safety-related part.
  • the external device also includes a semiconductor integrated circuit capable of performing calculations and a storage device, and like the drive control unit 51, may be appropriately configured of the semiconductor integrated circuit capable of performing various calculations and the storage device. obtain.
  • An application for switching the safety function is installed in the teaching pendant 60, and when the user performs an operation to switch the criterion of the operation monitoring parameter, a command including a command (request command) instructing the switching is issued.
  • a group of information including information and diagnostic information (CRC, first diagnostic information) for diagnosing whether the command has been transmitted or received normally is sent from the teaching pendant 60 as the non-safety-related part Y to the safety FPGA of the safety-related part X. sent to.
  • the safety FPGA switches the judgment criteria of the operation monitoring parameters based on the commands included in the command information.
  • the specific configuration of the logic section X2 of the safety-related section X is not limited to the safety FPGA, and may be a microcomputer or CPU.
  • sensors, the control center of the factory 10, etc. are communicably connected to the IO, and switching of safety functions is permitted from external devices other than the teaching pendant.
  • the robot control system CS shown in this embodiment employs a configuration in which the safety function can be actively switched based on the judgment of the control device 50 . Specifically, the determination criteria for the motion monitoring parameters are switched according to the work scene of the robot 20 . A task monitoring process executed by the drive control unit 51 as a part of the regular process in order to realize such switching will be described below.
  • the drive control unit 51 identifies the work situation of the robot 20 during work from a plurality of preset work situations (work scenes) in which the robot 20 works.
  • the movement of the robot 20 in the work scene is defined by a combination of a plurality of tasks.
  • the task monitoring process shown in FIG. It is determined whether or not it is time to complete all the tasks related to the current work.
  • step S201 If it is not the timing when all the tasks have been completed, the drive control unit 51 makes a negative determination in step S201 and terminates this task monitoring process. When it is time to complete all the tasks, the drive control unit 51 makes an affirmative determination in step S201, and proceeds to step S202.
  • the operation program referred to by the drive control unit 51 includes scene-related information for specifying the next work scene when the last task is completed. , to identify the next work scene based on this scene-related information. As described above, the drive control unit 51 functions as a situation identification unit (a scene identification unit in this embodiment) in steps S201 and S202.
  • step S203 the drive control unit 51 determines an instruction to switch the safety function to the safety FPGA of the safety-related unit X according to the work scene specified in step S202. More specifically, the drive control unit 51 sets a request command requesting switching of the safety function and a CRC, which is diagnostic information for diagnosing whether the request command has been successfully transmitted and received.
  • the safety function in this embodiment is defined for each work scene (scenes SN1 to SN9) of the robot 20 . In other words, it can be said that the request command set in step S203 requests the safety-related part X to switch the work scene. In view of such circumstances, it can be said that the request command for instructing safety function switching is a "scene change command".
  • the request command consists of a command ID (first information) that includes information for identifying the control device that is the transmission source and information that indicates that the current request is to switch the safety function, and is referred to in subsequent judgments.
  • data scene number, second information indicating the criteria for determination.
  • step S203 After setting the request command and the CRC in step S203, the scene change sequence is started in step S204, and the task monitoring process ends (see FIG. 9). After that, the task monitoring process is avoided until the scene change sequence ends.
  • the safety-related part X based on the instruction from the drive control part 51 included in the non-safety-related part Y, sets the criteria for the parameters referred to by the operation determination part of the safety-related part X to the identified task. Switch to the criteria corresponding to the situation (work scene).
  • the safety-related section X functions as a criterion switching section.
  • the non-safety-related part Y instructs the safety-related part X to switch the safety function of the safety-related part X, specifically to switch the judgment criteria of the operation monitoring parameters.
  • an information group including diagnosis information including a request command as instruction information and CRC is sent to the safety-related part X (see ts1).
  • the safety-related part X Upon receiving an instruction from the non-safety-related part Y, the safety-related part X first determines whether the instruction has normally reached the safety-related part X based on diagnostic information. Specifically, the safety-related part X diagnoses whether an abnormality such as damage has occurred in the current request command and CRC. More specifically, the safety-related part X determines whether the sum of the command ID number and the data number of the request command matches the CRC (see ts2). If they match, the safety-related part X considers that the current instruction has been sent and received normally, and then diagnoses whether the request command itself, which is an instruction, is normal.
  • diagnostic information Specifically, the safety-related part X diagnoses whether an abnormality such as damage has occurred in the current request command and CRC. More specifically, the safety-related part X determines whether the sum of the command ID number and the data number of the request command matches the CRC (see ts2). If they match, the safety-related part X considers that the current instruction has
  • the safety-related part X refers to the command ID, specifies that the current instruction is to switch the safety function, and determines whether the data is within the range corresponding to the current command ID. (see ts3). As described above, when the command ID is "11" to “13", the data is any one of “1” to “9”. If the current data is any of "1” to "9", the safety-related part X determines that the request command is normal.
  • the safety-related part X notifies the control center of the factory 10 that an abnormality such as a communication error has occurred, and terminates this scene change sequence. do.
  • the safety-related part X accepts the command, and switches the safety function, that is, the judgment criteria of the operation monitoring parameter according to the instruction of the non-safety-related part Y. (see ts4).
  • the safety-related part X (specifically, the memory of the control device 50) stores the correspondence relationship between the data number and each operation monitoring parameter. The safety-related part X switches the operation monitoring parameters based on the designated data number and the correspondence stored in the memory.
  • the determination criterion for the force operation monitoring parameter 70 N
  • the determination for the speed operation monitoring parameter Reference 125 mm/s
  • Criteria for position operation monitoring parameters upper area of AGV 31 + outer area of AGV 31 (outer area in plan view of robot 20 ) in consideration of work take-out operation.
  • the force of the hand exceeds 70 N
  • the speed of the hand exceeds 125 mm/s
  • the position of the hand exceeds the upper area of AGV 31 + the extension area for picking.
  • the robot 20 is brought to an emergency stop based on what has been done.
  • the criterion for force operation monitoring parameters 140 N
  • the criterion for speed operation monitoring parameters 250 mm/s
  • Criteria for monitoring parameters upper region of AGV 31 .
  • the force of the hand exceeds 140 N
  • the speed of the hand exceeds 250 mm/s
  • the position of the hand deviates from the upper region of the AGV 31 (when the robot arm 41 moves from the AGV 31 in plan view)
  • the robot 20 is brought to an emergency stop on the basis of any of the above cases.
  • the criterion for force operation monitoring parameter upper limit of ability (maximum strength) + ⁇ N
  • the criterion for speed operation monitoring parameter Capability upper limit (maximum speed)+ ⁇ mm/s
  • determination criteria for position operation monitoring parameters capacity upper limit (maximum movable range)+ ⁇ .
  • the safety-related part X notifies the non-safety-related part Y that the instruction has been received. Specifically, an acknowledge signal is sent to the non-safety-related part Y (see ts5).
  • the non-safety-related part Y is set as information for specifying the setting of the safety function after switching to the safety-related part X when an acknowledge signal is received from the safety-related part X, that is, as a current reference target.
  • Requests information for identifying criteria for operation monitoring parameters see ts6. This request may also include diagnostic information (eg, CRC).
  • the safety-related part X In response to the confirmation request from the non-safety-related part Y, the safety-related part X sends a request command (specifically, a command imitating the request command) as information for specifying the judgment criteria to the non-safety-related part Y. and CRC (second diagnostic information), which is diagnostic information for diagnosing whether the transmission and reception of the request command was performed normally (see ts7), to respond to the confirmation request of the non-safety-related part Y do.
  • the request command from the safety-related part X like the request command from the non-safety-related part Y, contains information for identifying that the transmission source is the safety-related part X, and data (scene number) indicating a criterion to be referred to in the subsequent determination.
  • the sum of the command ID and the data of the request command sent from the safety-related part X to the non-safety-related part Y is the request sent from the non-safety-related part Y to the safety-related part X at the start of this sequence.
  • a mismatch occurs with respect to the sum of the command ID of the command and the data.
  • the CRC attached to the request command sent from the safety-related part X to the non-safety-related part Y mismatch against the CRC.
  • the non-safety-related part Y Upon receiving the response from the safety-related part X, the non-safety-related part Y diagnoses whether this response has been received normally based on the CRC, which is the second diagnostic information. That is, the non-safety-related part Y diagnoses based on the request command and the CRC whether or not this response has been normally transmitted and received. Specifically, the non-safety-related part Y determines whether the sum of the command ID number and the data number of the request command matches the CRC (see t8). If they match, the non-safety-related part Y considers that this reply has been sent and received normally, and then responds to the request from the non-safety-related part Y so that the safety function of the safety-related part X is normal.
  • the CRC which is the second diagnostic information. That is, the non-safety-related part Y diagnoses based on the request command and the CRC whether or not this response has been normally transmitted and received. Specifically,
  • the non-safety-related part Y diagnoses whether the criterion actually set in the safety-related part X is the criterion specified by the instruction in the command information. Specifically, the non-safety-related part Y stores the relationship between the command ID of the request command from the safety-related part X and the data. It is determined whether the command ID and data of the request command sent to the safety-related part X match the contents.
  • the scene change sequence is completed when it is confirmed that the response from the safety-related part X matches its own instructions.
  • switching of the judgment criteria by the safety-related part X is performed after all tasks in the work scene are completed.
  • the control load in the system is preferably distributed compared to a configuration in which switching is performed during work by performing switching between them. can be made.
  • switching of the judgment criteria by the safety-related part X is performed after all tasks in the work scene are completed. That is, it is done after the work in progress is completed.
  • switching of the judgment criteria by the safety-related part X until after the completion of the work in progress 1, it is possible to prevent the occurrence of an event in which a movement that would otherwise pose no problem is caught in the monitoring, It is possible to improve work efficiency by reducing the chance of emergency stop of the robot.
  • the non-safety-related part Y instructs the safety-related part X to switch.
  • This instruction consists of a request command and a CRC, and based on the request command and the CRC, the safety-related part X diagnoses whether the instruction has been received normally and whether the instruction itself is normal. If no abnormality is found in the diagnosis, the safety-related part X receives the instruction from the non-safety-related part Y, and the safety-related part X switches the criterion to be referred to according to the instruction.
  • the safety-related part X notifies the non-safety-related part Y that the instruction has been received. Request information that can specify (criterion after switching).
  • the safety-related part X sends to the non-safety-related part Y an information group consisting of the information CRC.
  • the non-safety-related part Y diagnoses whether the response from the safety-related part X has arrived normally based on the CRC, and diagnoses whether the actually set judgment criteria are the judgment criteria specified by the initial instruction. do.
  • the non-safety-related part Y can confirm whether the switching of the safety function in the safety-related part X has been performed normally according to its own instruction.
  • the safety function of the non-safety-related part Y is switched to the safety-related part X, the decrease in reliability due to the change of the safety function is suppressed, and the safety function is changed.
  • the input for the change it is possible to avoid that the constraint related to the change is strengthened compared to the case where the input from the input unit X1 (so-called safety input) is used.
  • the operability of changing the safety function can be favorably improved.
  • two round-trip communications are performed between the non-safety-related part Y and the safety-related part X with the switching of the safety function interposed therebetween.
  • the related part X or the non-safety related part Y uses the first diagnostic information or the second diagnostic information to confirm whether normal communication has been performed.
  • Normal communication means that safety-related part X and non-safety-related part Y are likely to operate normally. Therefore, by confirming the normality of communication twice, it can be confirmed with a very high probability that both the safety-related part X and the non-safety-related part Y are operating normally.
  • two round trips of communication are performed between the non-safety-related part Y and the safety-related part X with the switching of the safety functions in between. was operating normally.
  • the configuration for diagnosing whether or not the instruction itself from the non-safety-related part Y is normal by comparing the type of instruction stored in advance in the safety-related part X with the current instruction. Then, when a command is damaged due to stuck bits, a communication error, or the like, it is possible to suitably suppress switching of the safety function based on the damaged command.
  • the work scene is identified and the determination criteria for monitoring are changed for each work scene. This can contribute to improving the safety of the robot and improving the work efficiency.
  • the safety function in order to improve the safety of the robot, it is also possible to configure the safety function to change sequentially each time the operating state (position, orientation, speed, etc.) of the robot changes.
  • a configuration increases the control load on the robot control system, which affects the original function of the robot control system (robot drive control).
  • robot drive control considering the fact that the movement of the robot changes for each task, it is necessary to switch the determination criteria for each task scene (work situation) as shown in the present embodiment.
  • the robot control system selects the determination criteria for each work scene based on its own quick judgment. As a result, it is possible to suppress the occurrence of a long waiting time for switching the safety function, thereby contributing to an improvement in work efficiency.
  • the monitoring of the robot's strength and speed becomes excessively severe. can be prevented from becoming This is preferable for improving the work efficiency of the robot.
  • Second Embodiment> As for the robot control system CS shown in the first embodiment, the work efficiency and safety of the robot 20 are improved by changing the safety function according to the work scene.
  • One of the features of this embodiment is that it is devised to smoothly transition the work scene when changing the safety function. In the following, first, with reference to FIG. 13, the focused event will be described.
  • Changes in the criteria (reference values) when the work scene is switched can be broadly classified into the following two patterns. That is, the pattern is roughly divided into a pattern in which the reference value is raised by switching the work scene as shown in FIG. 13A and a pattern in which the reference value is lowered by the switching of the work scene as shown in FIG. 13B.
  • the force of the hands of the robot 20 is exemplified, but the same phenomenon occurs with the speed of the hands.
  • the hand force (detected value) of the robot 20 changes to be lower than the reference value.
  • the reference value is increased, and the difference between the detected value and the reference value is large. That is, even if the reference value is raised in accordance with the switching of work scenes, the detected value remains below the reference value.
  • Switching the work scene relaxes the above-mentioned output restrictions and the like, and the hand force and speed of the robot 20 can be increased. Therefore, immediately after the switching of the work scene, specifically at the timing of t1, which is the first monitoring cycle (sampling cycle) after the switching of the work scene, the detection value remains below the newly set reference value. there is In other words, an emergency stop of the robot 20 due to the detection value exceeding the reference value does not occur when the work scene is switched.
  • the force (detection value) of the hand of the robot 20 changes to be lower than the reference value.
  • the reference value is increased at the timing t0 at which the work scene switching occurs (the judgment criterion is relaxed), while in FIG. Standard values have been lowered (judgment standards have become stricter).
  • pattern L in FIG. 13B in the period up to timing t0, when the detected value transitions so as to fall below both the pre-switching and post-switching reference values, The detected value does not exceed the reference value after switching at the timing of t1.
  • the configuration related to the switching of work scenes is devised in consideration of such circumstances.
  • the device specifically, the scene switching monitoring process executed by the monitoring control unit 52 as part of the operation monitoring process (periodic process) will be described.
  • FIG. 14 for the sake of convenience, the time scale of the portion immediately after the switching of the work scene and the time scale of the portion where the detection value normally exceeds the reference value are enlarged more than the time scale of the other portions. It is described as a mode.
  • the monitoring control unit 52 first determines whether or not the special monitoring flag is set in the flag storage area of the memory in step S301. If the special monitoring flag is not set, the monitoring control unit 52 makes a negative determination in step S301 and proceeds to step S302. In step S302, the monitoring control unit 52 determines whether switching of the work scene has occurred. Specifically, the monitoring control unit 52 determines whether or not an instruction to switch the safety function has been received from the non-safety-related unit Y. If the work scene has not been switched, the monitoring control unit 52 ends this monitoring process. When the work scene is switched, the monitoring control unit 52 proceeds to step S303. In step S303, the monitoring controller 52 switches the criterion.
  • the monitoring control unit 52 switches the reference value referred to in motion determination to the reference value corresponding to the new work scene.
  • the monitoring control unit 52 sets a special monitoring flag in the flag storage area of the memory, and terminates this monitoring process.
  • the work scene before switching is referred to as "work scene A”, the reference value corresponding to the work scene A as “reference value FA”, and the work scene after switching as “work scene B”, corresponding to the work scene B.
  • the reference value will be described as "reference value FB”.
  • step S301 if the special monitoring flag is set, the monitoring control unit 52 switches the work scene from work scene A to work scene B in step S305, and then moves the robot 20 (hand). It is determined whether or not it is time to check the movement first.
  • the memory is provided with a counter for grasping the number of executions of the main monitoring process after the work scene is switched. The value n of this counter changes from "0" to "1" when the special monitoring flag is set. Cleared to 0.
  • step S305 the monitoring control unit 52 refers to the value n of this counter and determines whether it is the timing of the first confirmation.
  • step S305 the process proceeds to step S306.
  • step S306 the monitoring control unit 52 determines whether the current detection value Ft1 is below the reference value FB after switching. If the detected value Ft1 is lower than the reference value FB, the monitoring control unit 52 clears the special monitoring flag in step S307 and terminates this monitoring process. If the detected value Ft1 has reached the reference value FB, the monitoring control unit 52 makes a negative determination in step S306, proceeds to step S308, and starts interrupting force and speed reduction control.
  • the monitoring control unit 52 intervenes in drive control of the drive motor 45 to suppress the movement of the hand of the robot 20. Specifically, the monitoring control unit 52 limits the power supplied to the drive motor 45 to a certain extent. This interruption of the reduction control is continued until the monitor cycle reaches the upper limit of n times (until a predetermined period of time elapses). Note that the degree of restriction and the upper limit number of times may be calculated based on the reference value FA and the reference value FB when executing the process of step S308, or may be read out from a program bank or the like registered in advance. may be Incidentally, the robot 20 is not stopped by the interruption of the reduction control.
  • the detected value is forcibly lowered by the start of the decrease control interrupt in step S308.
  • the monitoring control unit 52 sets the reduction control target value Tn (intermediate target value Tn or target value Tn) of the detection value Ftn in each monitoring period after starting the reduction control interruption.
  • the reduction rate of the reduction control in step S308 is defined to be constant, and the reduction control target value Tn is set based on the reduction rate and the detected value Ft1.
  • step S310 the monitoring control unit 52 determines whether the current detection value Ftn is below the current reduction control target value Tn set in step S310. If the current detection value Ftn is not less than the current reduction control target value Tn, there is a possibility that an unexpected movement (abnormality) has occurred in the robot 20. After executing each process for emergency stop and abnormality notification in , this monitoring process is terminated. In the emergency stop process, the monitoring control unit 52 forcibly cuts off the power supply to the motors 35 and 45 to bring the robot 20 to an emergency stop. Then, the monitoring control unit 52 turns on a warning lamp provided on the robot 20 in the abnormality notification process, and transmits information to the effect that an abnormality has occurred to the management system of the factory 10 .
  • step S310 if the current detection value Ftn is lower than the current reduction control target value Tn, the monitoring control unit 52 makes an affirmative determination in step S310 and proceeds to step S312.
  • step S312 the monitoring control unit 52 determines whether or not the current detection value Ftn is below the reference value FB, which is the reference value after switching. If a negative determination is made in step S312, the monitoring control unit 52 proceeds to step S313, and the current monitoring period, that is, the number of times this monitoring process has been executed after switching the work stage is equal to the upper limit set in step S309. It is determined whether or not the number of times has been reached. When determining that the upper limit number of times has been reached, the monitoring control unit 52 proceeds to step S311.
  • step S311 the monitoring control unit 52 terminates this monitoring process after executing the emergency stop of the robot 20 and the abnormality notification. If it is determined in step S313 that the upper limit number of times has not been reached, the monitoring control unit 52 adds "1" to the counter value n in step S314, and terminates this monitoring process.
  • step S312 if an affirmative determination is made in step S312, that is, if the detected value Ftn is below the reference value FB after switching, the monitoring control unit 52 proceeds to step S315.
  • step S315 the monitor control unit 52 terminates the interruption of the reduction control. As a result, the forced reduction of the detection value is canceled.
  • step S316 the monitoring control unit 52 clears the special monitoring flag and terminates this monitoring process.
  • the detected value (detected value Ft0) is positioned between reference value FA and reference value FB.
  • the detected value Ft1 remains above the reference value FB. Normally, an emergency stop and anomaly notification would be executed at this time, but the emergency stop and anomaly notification based on this detected value are avoided. Then, at the timing of t1, a decrease control interrupt is started to forcibly lower the detected value.
  • the detected values Ft2 to Ft4 are lower than the reduction control target values T2 to T4, respectively, and the detected values are lowered as planned. Then, at timing t5, the period falls below the reference value FB as planned before reaching the upper limit number of times. This completes the reduction control interrupt. Hypothetically, if the detection value is not lowered as planned during the timing from t2 to t5, an emergency stop and an abnormality notification are executed at that time.
  • the actual detected value basically changes below the reference value FB. Then, as shown at timings t6 to t7, when the detected value changes so as to reach the reference value FB, emergency stop and abnormality notification are executed.
  • the configuration shown in this embodiment is applied to a configuration in which the distance to the person is detected using the laser scanner 37 or the like, and the work scene of the robot 20 (for example, a human collaboration scene) is switched according to the detection result of the distance to the person.
  • the reference value when the distance between the robot 20 and the person is relatively short is set lower than the reference value when the distance between the robot 20 and the person is relatively long (reference value for long distance).
  • Further enhancement of safety can be expected by configuring as follows. However, since the distance to a person may change suddenly, the impact on productivity and the like may be significant due to the increased chance of the above-mentioned erroneous stop occurring when the reference value changes from high to low.
  • the monitoring control unit 52 first determines whether or not the switching preparation flag is set in the memory in step S401. If the switching preparation flag is not set, the monitoring control unit 52 proceeds to step S402. In step S402, if the work scene has been switched, the monitoring control unit 52 switches the determination criteria in step S403. exit.
  • step S404 the monitor control unit 52 grasps the progress of the current work.
  • step S405 the monitoring control unit 52 determines whether or not the current detection value Fx is below the reference value (reference value FB) for the next scheduled work scene (work scene B). If the detected value Fx is lower than the reference value FB, the monitoring control unit 52 terminates this monitoring process. If the detected value Fx has reached the reference value FB, the monitoring controller 52 proceeds to step S406.
  • step S406 the monitoring control unit 52 determines the force and speed reduction based on the difference between the current detection value Fx and the reference value FB and the remaining time (for example, estimated time) until the next scheduled work scene. Determines whether it is time to start the control interrupt. That is, the monitoring control unit 52 determines whether the timing is appropriate for lowering the detection value to be lower than the reference value FB within the remaining time. If a negative determination is made in step S406, the monitoring control unit 52 terminates this monitoring process as it is if there is still plenty of remaining time in consideration of the current detection value and the like. If it is determined in step S406 that the timing is appropriate, the monitoring control unit 52 starts interruption of reduction control in step S408. In this reduction control interruption, the monitor control unit 52 intervenes in the drive control of the drive motor 45 to suppress the movement of the hand of the robot 20 . Specifically, the monitoring control unit 52 limits the power supplied to the drive motor 45 to a certain extent.
  • the appropriate timing is “variable” in the present embodiment, it can also be “fixed”. In other words, when the remaining time reaches the predetermined time, it may be configured such that the interruption of the reduction control is started under the condition that the detected value at that time exceeds the reference value FB.
  • step S406 the monitoring control unit 52 sets the switching preparation flag in the flag storage area of the memory, and terminates this monitoring process.
  • step S409 the monitoring control unit 52 determines whether switching of the work scene has occurred. If the work scene has been switched, the monitoring control unit 52 switches the determination criteria in step S410, specifically changing from the reference value FA to the reference value FB. Thereafter, in step S411, the monitoring control unit 52 determines whether the current detection value Ft0 is below the reference value FB. As described above, in the present embodiment, the switching of work scenes is grasped in advance, and an interrupt of reduction control is executed aiming at the switching. As a result, the detection value Ft0 is basically less than the reference value FB at the timing when the work scene is switched.
  • step S411 the monitoring control unit 52 terminates the reduction control interruption in step S412, clears the switching preparation flag in step S413, and terminates this monitoring process.
  • step S411 the monitoring control unit 52 executes each process of emergency stop and abnormality notification in step S414, and then terminates this monitoring process.
  • the detection value (detection value Fx) is the reference value FA corresponding to the current work scene A and the reference value corresponding to the next work scene B.
  • FB the monitoring control unit 52 specifies in advance the next work scene B and the remaining time until the next work scene B, and the detection value at the present time and the reference value FB corresponding to the next work scene B , and the remaining time until the timing t0, it is determined that it is the appropriate timing to start the reduction control interruption, and the reduction control interruption is started.
  • the reference value switches from reference value FA to reference value FB, and it is determined whether the current detected value is below reference value FB.
  • the detection value is lowered as planned by the interrupt of the decrease control, the detection value falls below the reference value FB at the timing t0, and the robot 20 is not brought to an emergency stop or the like.
  • the robot 20 is brought to an emergency stop or the like.
  • the laser scanner 37 is used to estimate the distance to the person, and the work scene of the robot 20 (for example, palletizing in scene SN5 in which human collaboration is not assumed) is detected as the distance to the person. It is configured to switch between a work scene that does not assume a person (hereinafter referred to as work scene 1) and a work scene that assumes a person (hereinafter referred to as work scene 2) by switching, and a safety function (judgment criteria ) is different from that of the first embodiment.
  • work scene 1 Considering that the determination criterion (reference value F1) in work scene 1 is lower than the determination criterion (reference value F2) in work scene 2, work scene 2 requires more safety considerations than work scene 1. It can be said that it is a scene where
  • a detection area (monitoring area) by the laser scanner 37 is set between a surrounding area CE1 that is immediately adjacent to the robot 20, a non-detection area CE3 that is not monitored by the laser scanner 37, and the surrounding area CE1. and a buffer area CE2 are provided.
  • the work scene is the work scene 1 in which no human is assumed as described above.
  • the work scene 1 is switched to the work scene 2.
  • FIG. 19 the technical idea shown in the third embodiment is applied to such sudden switching, and by preparing in advance for switching the work scene, safety and production efficiency (work efficiency) are improved. We are working to improve
  • the configuration related to the advance preparation specifically, the special switching monitoring processing executed as part of the operation monitoring processing in the monitoring control unit 52 will be described.
  • the monitoring control unit 52 first determines whether or not the switching preparation flag is set in the memory in step S501. If the switching preparation flag is not set, the monitoring control unit 52 proceeds to step S502. In step S ⁇ b>502 , the monitoring control unit 52 determines whether or not an object (person) is detected in the buffer area CE ⁇ b>2 based on information from the laser scanner 37 . If a negative determination is made in step S502, the monitoring control unit 52 ends this monitoring process as it is. If an affirmative determination is made in step S502, the monitoring control unit 52 advances to step S503 to confirm the determination criteria (reference values) for the next work scene in advance.
  • step S503 the monitoring control unit 52 confirms in advance the reference value F2 when the work scene 2 is set.
  • step S504 the monitoring control unit 52 determines whether the detected value Fx at the present time is below the reference value F2 of the work scene 2 assumed to be switched next. If the detected value Fx is lower than the reference value F2, the monitoring control unit 52 ends this monitoring process. If the detected value Fx has reached the reference value F2, the monitoring controller 52 proceeds to step S505.
  • the monitoring control unit 52 starts interrupting force and speed reduction control. In this reduction control interruption, the monitor control unit 52 intervenes in the drive control of the drive motor 45 to suppress the movement of the hand of the robot 20 . Specifically, the monitoring control unit 52 limits the power supplied to the drive motor 45 to a certain extent. After that, the monitoring control unit 52 sets the switching preparation flag in the flag storage area of the memory in step S506, and terminates this monitoring process.
  • step S507 the monitoring control unit 52 determines whether or not an object (person) has been detected in the buffer area CE2. If a negative determination is made in step S507, that is, if the object (person) is no longer detected in the buffer area CE2, the monitoring control unit 52 proceeds to step S508 and terminates the reduction control interruption. After that, the monitoring control unit 52 clears the switching preparation flag in step S509, and terminates this monitoring process.
  • step S507 the monitoring control unit 52 proceeds to step S510. It should be noted that an affirmative determination is made in step S507 even when an object (person) is detected in the surrounding area CE1, and the monitoring control unit 52 proceeds to step S510.
  • step S510 the monitoring control unit 52 determines whether switching from work scene 1 to work scene 2 has occurred. Specifically, the monitoring control unit 52 determines whether or not an object (person) is detected in the surrounding area CE1. When switching to the work scene 2 has occurred, the monitoring control unit 52 switches the determination criteria in step S511, specifically changing from the reference value F1 to the reference value F2. Thereafter, the monitoring control unit 52 determines whether the current detection value Ft0 is below the reference value F2 in step S512. As described above, in the present embodiment, switching of work scenes is predicted in advance, and an interrupt of reduction control is executed aiming at the switching. As a result, the detection value Ft0 is basically lower than the reference value F2 at the timing when the work scene is switched.
  • step S512 the monitoring control unit 52 terminates the reduction control interruption in step S508, clears the switching preparation flag in step S509, and terminates this monitoring process.
  • step S512 the monitoring control unit 52 executes each process of emergency stop and abnormality notification in step S513, and then terminates this monitoring process.
  • each of the following configurations may be applied to each of the above embodiments individually, or may be applied to each of the above embodiments by combining a part or all of them.
  • Each of the following configurations may be applied individually to a new configuration made up of a combination of embodiments, or a part or all of them may be combined and applied.
  • the work scene (scenes SN1 to SN9) of the robot 20 is determined, and the determination criteria for the motion monitoring parameters (force, speed, position) are switched according to the determined work scene.
  • the drive control unit 51 identifies the area in which the robot 20 is located, and the safety-related unit X determines the area identified. It is also possible to adopt a configuration in which the determination criteria for the operation monitoring parameters are switched. In this way, the work area is identified as the work situation instead of the work scene. In this case, the drive control section 51 can function as an area identification section.
  • the drive control unit 51 determines the work scene of the robot 20 and the location of the robot 20. It is also possible to adopt a configuration in which both areas are discriminated, and the safety-related part X switches the determination criteria of the operation monitoring parameters according to them.
  • the drive control unit 51 controls the progress of the work routine by the time elapsed from the start of the routine or the current time. , and the safety-related section X switches the criterion for the operation monitoring parameter based on the time or time. Further, in consideration of the case where a delay occurs in the schedule, it is possible to adopt a configuration in which the safety-related part X switches the determination criteria of the operation monitoring parameters based on time or time and information indicating the delay time. In this way, time is grasped instead of the work scene as the work situation. In this case, the drive control section 51 can function as a grasping section.
  • the safety-related part X may switch the determination criteria according to the elapsed time or the current time.
  • break times are often provided periodically, and it is assumed that there is a high possibility that there will be more people in the aisle E4 or the like during this time period.
  • the determination criteria are switched so that the determination criteria for when the robot 20 passes through the passage E4 during the break time are stricter than the determination criteria for when the robot 20 passes through the passage E4 outside the break time.
  • the three motion monitoring parameters of force, speed, and position are used together in any work scene. You can change the type and number.
  • force and speed may be parameters for motion monitoring in a first scene
  • force, speed, and position may be parameters for motion monitoring in a second scene.
  • ⁇ It is also possible to subdivide the work scenes shown in the above embodiments according to the type of motion of the robot 20, and switch the determination criteria of the motion monitoring parameters for each subdivided scene of the safety-related part X.
  • the scene of picking up the workpiece from the processing machine 14 and the scene of moving to the next processing machine may be set as separate scenes, and the determination criteria may be switched.
  • the safety-related section X may switch the determination criteria between the first half (until the workpiece is gripped) and the second half (until the workpiece is moved to the container 18) of the workpiece removal scene.
  • the work scene 1 is subdivided into a scene in which the distance to the person is assumed to be relatively close and a scene in which the distance to the person is assumed to be relatively long, and each of these subdivided scenes It is also possible to adopt a configuration in which the safety-related part X switches the criterion.
  • the safety-related part X is configured to switch the determination criteria of the operation monitoring parameters at the timing of moving from the previous work scene to the next work scene. It is not denied that the decision criteria of the action monitoring parameters are switched at the end, or the action monitoring parameters are switched at the beginning of the next work scene.
  • the motion of the robot 20 may be temporarily stopped until the switching is completed. It is also possible to have a configuration in which the robot 20 is temporarily stopped in switching to a stricter criterion, while continuing to operate the robot 20 in switching to a looser criterion.
  • a CRC is added as diagnostic information for diagnosing whether transmission and reception between the non-safety-related part Y and the safety-related part X are performed normally.
  • the manner in which this CRC is set is arbitrary, and it is not always necessary to set it based on the command ID and data of the request command.
  • the force, speed, and position of the robot 20 exceed the capabilities of the robot 20, i.e., values that cannot substantially occur are determined as motion monitoring parameters. Although this has been set as a reference, this may be changed so that motion monitoring is skipped in the palletizing of scene SN5. In other words, the motion monitoring function of the robot 20 may be turned off in a specific work scene.
  • switching of the determination criteria for the motion monitoring parameters and switching of the limits of the force, speed, and position (movement area) are performed according to the work scene of the robot 20. It is not limited to this. It suffices at least to switch the criterion of the operation monitoring parameter, and it is possible to omit the switching of the limit.
  • judgment criteria for operation monitoring parameters are stored in advance in association with scene numbers.
  • the non-safety-related part Y may be configured to send to the safety-related part X information individually indicating each criterion in place of the scene number of the work scene.
  • the determination criteria may be configured such that the non-safety-related section Y sends a value indicating the determination criteria to the safety-related section X.
  • the case where the robot 20 is applied to the processing line of the factory 10 is exemplified, but the application of the robot 20 is not limited to the processing line. It is also possible to apply the robot 20 to assembly lines, inspection lines, and packing lines. Further, the movement range of the robot 20 is not limited to one line, but may be configured to move over a plurality of lines, for example, to engage in individual work on each line.
  • the diagnostic information such as the first diagnostic information and the second diagnostic information is CRC, but the diagnostic information is not limited to this.
  • the diagnostic information may include error detection codes other than CRC. Examples of error detection codes include, but are not particularly limited to, block codes such as parity codes, checksums, and cyclic codes, error detection such as hashes, error correction such as block codes, and convolutional codes.
  • the diagnostic information may also include positional information of the hand of the robot 20 .
  • the following characteristic group A is intended to improve the reliability of the robot's safety functions and to facilitate the change of safety functions. It was made.
  • a safety-related part controls movement of the robot based on safety-related input signals including parameters correlated to at least one of force and speed of the robot during operation and pre-stored criteria for the parameters. and realizing the safety function by generating a safety-related output signal according to the determination result of the operation determination unit,
  • the non-safety-related part instructs the safety-related part to switch the judgment criteria by sending an information group including command information and first diagnostic information to the safety-related part.
  • the information includes information indicating a criterion to be referred to in the determination by the motion determination unit,
  • the safety-related part diagnoses whether the instruction has been received normally based on the first diagnostic information, and determines whether the instruction itself is normal. Diagnosis is made based on the instruction information, and when it is diagnosed that the instruction has been received normally and the instruction itself is normal, the instruction is received and the judgment criteria referred to in the judgment are set according to the instruction information.
  • the previous non-safety-related part identifies the criterion set as a reference target by switching based on the instruction to the safety-related part. requesting possible identifying information;
  • the safety-related part responds to a request from the non-safety-related part by sending an information group consisting of the identifying information and the second diagnostic information to the non-safety-related part,
  • the non-safety-related part diagnoses whether the response has been received normally based on the second diagnostic information.
  • a robot control system for diagnosing whether the criterion specified by the instruction is met.
  • an instruction to switch from the non-safety-related part to the safety-related part is given first.
  • the indication includes command information and first diagnostic information.
  • the safety-related part diagnoses whether the instruction has been received normally based on the first diagnostic information, and diagnoses whether the instruction itself is normal based on the command information. If no abnormality is found in the diagnosis, the safety-related part switches the criteria to be referred to according to the instruction from the non-safety-related part. In other words, even if the instruction is from a non-safety-related part, if it is determined that there is no abnormality due to a transmission error or the like in the instruction, the determination criteria are switched.
  • the safety function in the safety-related part is not changed unless the instruction from the non-safety-related part is normally accepted, thereby ensuring the certainty of safety control, and setting change by operation from the non-safety-related part is possible.
  • the safety-related department notifies the non-safety-related department that the instruction has been received. It requests identification information that can identify the judgment criteria).
  • the safety-related part sends an information group consisting of identification information and second diagnostic information to the non-safety-related part.
  • the non-safety-related part diagnoses whether the response from the safety-related part has arrived normally based on the second diagnostic information, and whether the actually set judgment criteria are the judgment criteria specified by the initial instruction. Diagnose.
  • the non-safety-related part can confirm whether the switching of the safety function in the safety-related part has been performed normally according to its own instruction.
  • the safety-related part or the non-safety-related part confirms whether normal communication is performed using the first diagnostic information or the second diagnostic information.
  • Successful communication indicates that safety-related and non-safety-related parts are likely to operate normally. Therefore, by confirming the normality of communication twice, it is possible to confirm with a very high probability that both the safety-related part and the non-safety-related part are operating normally.
  • the configuration shown in this feature even when switching the safety function of the safety-related part from the non-safety-related part, it is possible to suppress the decrease in reliability due to the change of the safety function, and the input for changing the safety function is suppressed. Also, it is possible to avoid that the restriction related to the change is strengthened compared to the case where the input from the safety-related input unit (so-called safety input) is used. As a result, the operability of changing the safety function can be favorably improved.
  • robot force, speed and position not only the force, speed and position at the tool center point of the robot, but also the force (rotational torque) and speed (rotational torque) of each axis of the robot velocity) and position.
  • the safety-related unit has a storage device that stores the type of the command information,
  • the robot control system according to feature A1 wherein the safety-related part confirms whether the command information is included in the type stored in the storage device in the diagnosis in the safety-related part.
  • the safety-related part checks whether the instruction (command information) itself from the non-safety-related part is normal by comparing the type of command information stored in advance with the current command information.
  • the command information includes first information that can identify which of the non-safety-related parts the information is from, and second information that specifies candidates for the criteria to be referred to, a combination of the first information and the second information is stored in the storage device;
  • the robot control system according to feature A2, wherein in the diagnosis, the safety-related part confirms whether a combination of the first information and the second information is stored in the storage device.
  • command information is damaged due to stuck bits, communication errors, etc., it can be easily suppressed from accidentally matching command information from other non-safety-related parts. If the command information is constructed by combining the first information and the second information, it is unlikely that both pieces of information will be damaged at the same time. can.
  • the first diagnostic information is determined based on the command information;
  • the robot control system according to any one of features A1 to A3, wherein the safety-related unit diagnoses whether the command has been received normally by comparing the first diagnostic information and the command information.
  • the first diagnostic information (value) is determined (changed) according to the command information. If at least one of the command information and the first diagnostic information is damaged, the relationship between the two will be broken, and it will be possible to identify an abnormality in the command through diagnosis.
  • the amount of information increases compared to the command information alone. That is, the signal consisting of the command information and the first diagnostic information becomes longer, and the amount of information to be confirmed in the normality/abnormality diagnosis increases, thereby improving the validity of the diagnosis result. As a result, it is possible to dramatically improve the reliability of safety function switching (change) by input from a non-safety-related part.
  • Feature A5 The robot control system according to any one of features A1 to A4, wherein the second diagnostic information differs according to a criterion referred to in the determination by the motion determination unit among the plurality of criteria.
  • the identification information sent to the safety-related department in response to the safety-related department is accompanied by the second diagnostic information.
  • This second diagnostic information differs (variable value) according to the criteria referred to by the operation determination section of the safety-related section. That is, it is possible to confirm not only communication abnormality but also whether the identification information is normal from the second diagnostic information, and the reliability of response can be improved with a simple configuration.
  • the second diagnostic information is determined based on the identifying information;
  • the robot control according to any one of features A1 to A5, wherein the non-safety-related part diagnoses whether the response has been received normally by comparing the second diagnostic information and the identification information. system.
  • the second diagnostic information (value) is determined (changed) according to the identifying information. If at least one of the identifying information and the second diagnostic information is damaged, the relationship between the two will be broken, and it will be possible to identify the occurrence of an abnormality in the response through diagnosis.
  • Such a configuration can contribute to further improving the reliability of the robot control system.
  • the second diagnostic information when the second diagnostic information is added to the identification information, the amount of information increases compared to the identification information alone. That is, the signal consisting of the identifying information and the second diagnostic information becomes longer, and the amount of information to be confirmed in normality/abnormality diagnosis increases, thereby improving the validity of the diagnosis result.
  • Feature A7 The robot control system according to any one of features A1 to A6, wherein the second diagnostic information is created so as to be inconsistent with the first diagnostic information.
  • the first diagnostic information and the second diagnostic information do not match when switching the safety function.
  • the first diagnostic information is sent back as it is as the second diagnostic information due to an accidental error such as bit fixation, the first diagnostic information and the second diagnostic information will match. The above error can be found quickly.
  • Each of the command information and the identification information includes information indicating a criterion to be referred to by the motion determination unit among the plurality of criteria, and information indicating a sender of the command information and the identification information.
  • the first diagnostic information is determined based on the command information included in the instruction, and the second diagnostic information is determined based on the identifying information included in the response.
  • the robot control system according to any one of .
  • the first diagnostic information included in the instruction from the non-safety-related part and the second diagnostic information included in the response from the safety-related part are each determined based on the command information including the information indicating the sender and the identification information. be done. That is, when switching the safety function, basically the first diagnostic information and the second diagnostic information do not match. Here, if the first diagnostic information is sent back as it is as the second diagnostic information due to an accidental error such as bit fixation, the first diagnostic information and the second diagnostic information will match. Missed errors can be quickly found.
  • the criteria include a force criterion for the force parameter and a speed criterion for the speed parameter, and a plurality of each of the force criterion and the speed criterion are defined;
  • the safety-related unit stores combination information (scene number) indicating a combination of the force reference and the speed reference to be referred to in the determination by the motion determination unit,
  • the robot control system according to any one of features A1 to A8, wherein the command information is information (scene number) correlated with the combination information.
  • a motion determination unit that determines motion of the robot based on safety-related input signals containing parameters correlated with at least one of the force and speed of the robot during operation and pre-stored criteria for the parameters. a safety-related part that realizes the safety function of the robot by generating a safety-related output signal according to the determination result; a situation identification unit that identifies the working situation of the robot during work from among a plurality of preset work situations in which the robot works; a criterion switching unit for switching the criterion for the parameters referred to by the motion determining unit to a criterion corresponding to the work situation identified by the situation identifying unit; A robot control system with
  • the safety function in order to improve the safety of the robot, it is also possible to configure the safety function to change sequentially each time the operating state (position, orientation, speed, etc.) of the robot changes.
  • a configuration increases the control load on the robot control system, which affects the original function of the robot control system (robot drive control).
  • robot drive control considering the fact that the movement of the robot changes for each task, as shown in this feature, switching the determination criteria for each task scene can reduce the impact on the original functions of the robot control system.
  • safety can be improved.
  • the work situation is a work scene executed by the robot;
  • the robot control system according to feature B1 wherein the situation identification unit is a scene identification unit that identifies the work scene of the robot.
  • a drive control unit (drive control unit 51 of the control device 50) that controls the drive of the robot according to a set operation program, The robot control system according to feature B2, wherein the scene identifying unit identifies the work scene based on scene-related information included in the operating program being executed.
  • the work situation is a work area defined for each work performed by the robot;
  • the robot control system according to feature B1 wherein the situation identification unit is an area identification unit that identifies a work area of the robot.
  • Having one robot handle multiple tasks is preferable in terms of promoting automation such as manufacturing.
  • the safety function of the robot is made uniform regardless of the work area, it becomes difficult to achieve both improved safety and improved work efficiency.
  • the work area is identified and the monitoring determination criteria are changed for each work area. This can contribute to improving the safety of the robot and improving the work efficiency.
  • safety is improved while suppressing the impact on the original functions of the robot control system. There is a clear technical significance that it can be done.
  • Feature B5. further comprising a drive control unit that controls the robot so that the robot operates according to a predetermined time schedule according to a set operation program;
  • the predetermined time schedule is defined so that multiple types of work are executed in order according to time or time,
  • the work situation is the time or the time,
  • the situation identification unit is a comprehension unit that comprehends the current time or the time,
  • the determination criterion switching unit causes the motion determination unit to The robot control system of feature B1, wherein the criterion for the referenced parameter is switched to the criterion corresponding to the predetermined time or the predetermined time.
  • the safety functions of the robot are made uniform regardless of the time schedule, it becomes difficult to achieve both improved safety and improved work efficiency.
  • the current time for example, the elapsed time from the start of the work routine
  • the monitoring judgment criteria is changed. This can contribute to improving the safety of the robot and improving the work efficiency.
  • the work situation includes a cooperative situation (for example, scene SN3) in which the robot and a person cooperate and a non-cooperative situation (for example, scenes SN4 and SN5) in which the robot and a person do not cooperate,
  • the robot according to any one of features B1 to B5, wherein the determination criterion switching unit performs the switching by making the determination criterion in the cooperative state and the determination criterion in the non-cooperative state different. control system.
  • the safety and work efficiency of the robot can be improved by changing the judgment criteria according to those situations. can be suitably improved.
  • the situation identification unit is capable of identifying the following work situations,
  • the robot control system according to any one of features B1 to B6, wherein the criterion switching unit performs the switching between an earlier work situation and a later work situation.
  • switching between them can favorably distribute the control load in the system compared to a configuration in which switching is performed during work. Also, when moving to the next work situation, there is a high possibility that the distance to the person or the like will change as the situation changes. Therefore, as shown in this feature, it is preferable to adopt a configuration in which switching is performed in preparation for the next situation in order to improve the safety of the robot.
  • Feature B8 When the determination result by the motion determination unit indicates that the determination standard is exceeded, the robot is urgently stopped, When the judgment standard is lowered due to the switching of the work situation, the robot is urgently stopped even if the judgment result by the motion judging unit indicates that the judgment result exceeds the judgment standard. suppressing the movement of the robot so as to forcibly lower the parameter without stopping the robot for a predetermined grace period after the lowering;
  • the robot control system according to any one of features B1 to B7, wherein, during the predetermined grace period, it is determined whether to stop the robot based on the decreasing tendency of the parameter.
  • the robot does not immediately stop (emergency stop) even if the criterion is lowered when the work situation is switched. In other words, the robot does not suddenly stop due to the lowering of the criterion. Then, when such a situation occurs, it is determined whether to stop the robot based on the decreasing tendency of the parameters during the predetermined grace period.
  • the safety function determination criteria
  • Feature B9 When the determination result by the motion determination unit indicates that the determination standard is exceeded, the robot is urgently stopped, identifying the switching to the work situation and the criterion set when the next work situation occurs before the switching; If the criterion set for the next work situation is exceeded during a predetermined period before switching to the next work situation, the excess occurs before the switch to the next work situation.
  • the robot control system according to any one of features B1 to B7, wherein movement of the robot is restrained to forcibly lower the parameter such that the is eliminated.
  • the configuration shown in this feature it is possible to specify (estimate or confirm) the change of the work situation in advance, and to confirm in advance that the criterion for the next work situation is exceeded during the predetermined period before the change. If so, the movement of the robot is suppressed to forcibly lower the parameter. As a result, the excess of the criterion is suppressed at the switching timing.
  • Feature B10 The robot control system according to any one of features B1 to B9, wherein the switching of the criterion by the criterion switching unit is disabled until one task being executed is completed.
  • a drive control unit that controls the drive of the robot according to a set operation program, In the operation program, the movement of the robot in the work situation is defined by a combination of a plurality of tasks,
  • the robot control system according to any one of features B1 to B9, wherein the drive control unit switches the work situation at a timing when all of the plurality of tasks in the current work situation are completed.
  • the drive control unit switches the work status when all the tasks in the current work status are completed. It is possible to ensure the reliability more reliably.
  • the parameter includes a parameter indicating the position of the robot during work, When the criterion switching unit switches the criterion for at least one of the parameters of the force and the speed, the criterion for the parameter indicating the position can also be switched accordingly.
  • the robot control system according to any one of features B1 to B9.

Abstract

ロボットの安全性及び作業効率を好適に向上させることのできるロボット制御システムを提供する。 作業中のロボットの力及び速さの少なくとも何れかに相関のあるパラメータを含んだ安全関連入力信号及び予め記憶されている当該パラメータ用の判定基準に基づいて前記ロボットの動きを判定する動作判定部を有し、その判定結果に応じて安全関連出力信号を生成することにより当該ロボットの安全機能を実現する安全関連部と、予め設定された前記ロボットが作業を行う複数の作業状況の中から、作業中の前記ロボットの作業状況を識別する状況識別部と、前記動作判定部により参照される前記パラメータ用の判定基準を、前記状況識別部により識別された前記作業状況に対応する判定基準に切り替える判定基準切替部と、を備えているロボット制御システムが提供される。

Description

ロボット制御システム
 本発明は、ロボット制御システムに関する。
 産業用ロボット等のロボットには、当該ロボットがワーク等の他の物体に衝突しないように、または衝突した場合に安全を確保するために制御するための機構が設けられる。例えば、特許文献1には、サーボモータの制御における異常負荷検出時の制御方法において、前記異常負荷の検出直前のサーボモータの回転方向と逆方向のトルクであって所定の大きさのトルク指令を前記サーボモータに所定時間与えることを特徴とするサーボモータの異常負荷検出制御方法が提案されている。
特開2001-037289号公報
 本発明の主たる目的は、ロボットの安全性及び作業効率を好適に向上させることのできるロボット制御システムを提供することにある。
 本発明の一態様によれば、作業中のロボットの力及び速さの少なくとも何れかに相関のあるパラメータを含んだ安全関連入力信号及び予め記憶されている当該パラメータ用の判定基準に基づいて前記ロボットの動きを判定する動作判定部を有し、その判定結果に応じて安全関連出力信号を生成することにより当該ロボットの安全機能を実現する安全関連部と、
 予め設定された前記ロボットが作業を行う複数の作業状況の中から、作業中の前記ロボットの作業状況を識別する状況識別部と、
 前記動作判定部により参照される前記パラメータ用の判定基準を、前記状況識別部により識別された前記作業状況に対応する判定基準に切り替える判定基準切替部と、
を備えているロボット制御システムが提供される。
 本発明によれば、ロボットの安全性及び作業効率を好適に向上させることのできるロボット制御システムを提供することができる。
本発明の第1の実施形態に係るロボット制御システムが適用され得る工場のレイアウトの一例を示す概略図である。 本発明の第1の実施形態に係るロボット制御システムが適用され得るロボットの斜視図である。 図2に示すロボットの電気的構成を示すブロック図である。 図2に示すロボットの作業の流れを示すフローチャートである。 図2に示すロボットの作業シーンを対比した概略図である。 本発明の第1の実施形態に係るロボット制御システムが備える安全関連部と非安全関連部との関係を示す概略図である。 本発明の第1の実施形態に係るロボット制御システムが行う動作監視処理を示すフローチャートである。 本発明の第1の実施形態に係るロボット制御システムにおいて用いられる安全機能の切替を指示するコントロールデバイスを例示した表である。 本発明の第1の実施形態に係るロボット制御システムが行うタスク監視処理を示すフローチャートである。 本発明の第1の実施形態に係るロボット制御システムが非安全関連部から送信されるリクエストコマンドの構成図である。 本発明の第1の実施形態に係るロボット制御システムが非安全関連部から送信されるリクエストコマンドの構成を説明するための表である。 本発明の第1の実施形態に係るロボット制御システムによるシーンチェンジシーケンスの流れを示すフローチャートである。 本発明の第1の実施形態に係るロボット制御システムにおけるシーン毎の判定基準を説明する表である。 作業シーンの移り変わりにおける安全関連部が設定する判定基準の基準値と検出値との関係を示すグラフ図である。 作業シーンの移り変わりにおける安全関連部が設定する判定基準の基準値と検出値との関係を示すグラフ図である。 本発明の第2の実施形態に係るロボット制御システムが行うシーン切替時監視用処理を示すフローチャートである。 本発明の第2の実施形態に係るロボット制御システムによって作業シーンが切り替わる際の検出値の変化を示すタイミングチャートである。 本発明の第3の実施形態に係るロボット制御システムが行うシーン切替時監視用処理を示すフローチャートである。 本発明の第3の実施形態に係るロボット制御システムによって作業シーンが切り替わる際の検出値の変化を示すタイミングチャートである。 本発明の第4の実施形態に係るロボット制御システムにおいて適用される物体の検出領域を示す概略図である。 本発明の第3の実施形態に係るロボット制御システムが行う特殊切替時監視用処理を示すフローチャートである。
<1.発明に至る経緯>
 まず、本発明の具体的な実施態様の説明に先立ち、本発明者の本発明に至るまでの経緯について説明する。 産業用ロボット等のロボットに適用されるロボット制御システムには、ロボットの駆動制御等を行う非安全関連部に加え、ロボットの安全機能を実現する安全関連部とするものがある。例えば、安全関連部については、例えば人等の障害物が衝突した場合にロボットを強制停止させたり、駆動中のロボットの力(推力)や速さを監視して安全用の基準を外れるような動きとなった場合にロボットを強制停止させたりするものが考えられる。
 一方で、近年では、ロボット技術の進歩により1のロボットが従事可能な作業の種類についても増加傾向にある。1のロボットを様々な作業に従事させる場合には、安全機能が画一的では安全性の向上と作業効率の向上とを両立することが困難となり得る。このような事情に鑑みて、本発明者は、ロボットの安全機能を切り替える構成を考案した。しかしながら、安全機能の切替が頻繁になった場合にはロボット制御システムにおける制御負荷が過度に増え、ロボット制御システムの本来の機能(すなわちロボットの駆動制御を実行する機能)への影響が大きくなると想定される。例えば、ロボットの位置や向きの変化に応じて安全機能を逐次変化させようとすれば、上記影響は顕著となる。このような影響は、ロボットの作業効率の低下を招く要因となるため好ましくない。また、ユーザによる安全機能の切替操作が必須となることは、ロボットの利便性を低下させる要因となるため好ましくない。このように、ロボットの安全性の向上と作業性との向上を実現し、ロボットの利用促進を図る上では、安全機能の変更に係る構成には未だ改善の余地がある。
 本発明は、上記課題に鑑みてなされたものであり、その主たる目的は、ロボットの安全性及び作業効率を好適に向上させることにある。
 以下、上記課題を解決するための手段について記載する。
 第1の手段. 作業中のロボットの力及び速さの少なくとも何れかに相関のあるパラメータを含んだ安全関連入力信号及び予め記憶されている当該パラメータ用の判定基準に基づいて前記ロボットの動きを判定する動作判定部を有し、その判定結果に応じて安全関連出力信号を生成することにより当該ロボットの安全機能を実現する安全関連部と、
 予め設定された前記ロボットが作業を行う複数の作業状況の中から、作業中の前記ロボットの作業状況を識別する状況識別部と、
 前記動作判定部により参照される前記パラメータ用の判定基準を、前記状況識別部により識別された前記作業状況に対応する判定基準に切り替える判定基準切替部と、
を備えているロボット制御システム。
 1のロボットが異なる複数の作業を担うことは、製造等の自動化を促進する上で好ましい。但し、作業状況に関わらずロボットの安全機能を画一的とした場合には、安全性の向上と作業効率の向上との両立が難しくなる。この点、本特徴に示す構成では、作業状況を識別して、作業状況毎に監視用の判定基準が変更される。これにより、ロボットの安全性の向上と作業効率の向上とに寄与できる。
 ここで、ロボットの安全性を向上させる上では、ロボットの動作状態(位置、向き、速さ等)が変わる毎に安全機能を逐次変化させる構成とすることも可能である。しかしながら、このような構成とした場合には、ロボット制御システムにおける制御負荷が大きくなり、ロボット制御システム本来の機能(ロボットの駆動制御)に影響が及ぶこととなる。この点、ロボットの動きが作業毎に変わる点に鑑みれば、本特徴に示すように作業シーン毎に判定基準を切り替える構成とすることにはロボット制御システムの本来の機能への影響を抑えつつ、安全性を向上できるという明確な技術的意義がある。
 <2.第1の実施形態>
 以下、工場などで用いられる産業用ロボットに具現化した第1の実施形態について図面を参照しつつ説明する。先ず、図1を参照して、本ロボットが適用された工場について説明する。
 工場10の一画には、コンベア11により搬送された材料を収納する棚12や空のコンテナ(所謂通箱)18を収納する棚13が配設されたストックエリアE1と、ワークを成形するための加工機14が複数配設された加工エリアE2と、成形されたワークを集積する集積エリアE3と、それらエリアE1~E3を繋ぐ通路E4とが設けられている。本実施形態に示すロボット20は、通路E4を通ってエリアE1~E3間を移動し、各所で定められた作業に従事する。
 図2に示すように、ロボット20は、AGV(Automated Guided Vehicle)31と、当該AGV31に搭載された垂直多関節型のロボットアーム41と、それらAGV31及びロボットアーム41を制御する制御装置50(図3参照)とを備えている。
 AGV31には、走行モータ35と、工場10の床に敷設された磁気誘導用のガイドテープの磁気を検出可能な磁気センサ36とが設けられており、制御装置50では、磁気センサ36により検出された磁気等に基づいてAGV31の走行制御、例えば走行モータ35の駆動制御や操舵制御を行う。本実施形態では、エリアE1~E3を繋ぐようにしてそれらエリアE1~E3及び通路E4にガイドテープが配置されており、当該ガイドテープによってロボット20の移動経路(走行ルート)が規定されている。
 AGV31のボディ上面には、コンテナ18が載置される載置部32が形成されており、当該コンテナ18を載置部32に載せた状態で移動可能となっている。また、AGV31には、ロボット20の進路上の障害物を検出するためのレーザスキャナ37や緊急時に作業者等によって操作される非常停止スイッチ38が配設されている。これら、レーザスキャナ37及び非常停止スイッチ38は後述する安全関連部の入力部として機能し、障害物を検出した場合や非常停止操作を検出した場合には、ロボット20を非常停止させる構成となっている。この非常停止においては、AGV31だけでなくロボットアーム41についても停止対象となる。
 ロボットアーム41は、AGV31のボディ上面(載置部32の隣)に固定されたベースと、当該ベースに取り付けられたアームと、アームの先端(手先)に設けられたハンド42(エンドエフェクタ)とを有している。アームは複数の可動部が連結されてなり、関節部毎に、それら可動部を駆動させる駆動モータ45と、各関節部(軸)の回転角度を検出するロータリエンコーダ46と、各関節部(軸)の回転トルクを検出するトルクセンサ47とが配設されている(図3参照)。図3に示すように、駆動モータ45、ロータリエンコーダ46、トルクセンサ47は、制御装置50に接続されており、制御装置50の駆動制御部51では、ロータリエンコーダ46により検出された回転角度等に基づいて各駆動モータ45の駆動制御を行う。
 ここで、制御装置50は、AGV31やロボットアーム41の等のロボット20の各部の駆動制御を行う制御装置50の駆動制御部51と監視制御部(セーフティコントローラ)52とを含む。
 駆動制御部51は、演算可能な半導体集積回路と、記憶装置とを含んで構成される。演算可能な半導体集積回路としては、例えば、CPU(Central Processing Unit)、ASIC(Application Specific Integrated Circuit)、MPU(Micro Processor Unit)等の演算装置、FGPA(Field Programmable Gate Array)、FPAA(Field Programable Analog Array)等のPLD(Programmable Logic Device)等が挙げられ、これらのうち1種を単独でまたは2種以上を組み合わせて構成することができる。また、記憶装置は、主記憶装置と補助記憶装置を含む。主記憶装置としては、SRAM(Static RAM)、DRAM(Dynamic RAM)、疑似SRAM、FeRAM(Ferroelectric RAM)、MRAM(Magnetoresistive RAM)、ReRAM(Resistive RAM)、PRAM(Phase change RAM)等が挙げられ、これらのうち1種を単独でまたは2種以上を組み合わせて構成することができる。補助記憶装置としては、ハードディスクドライブ(HDD)、ソリッドステートドライブ(SSD)、光ディスク、光磁気ディスク、フラッシュメモリ等が挙げられ、これらのうち1種を単独でまたは2種以上を組み合わせて構成することができる。なお、駆動制御部51は、主記憶装置や補助記憶装置と演算可能な半導体集積回路とが一体に予め組み込まれた装置を含んでもよい。
 また、監視制御部52は、安全関連入力信号に応答して安全関連出力信号を出力することによりロボット20の安全機能を実現する。監視制御部52も、演算可能な半導体集積回路と、記憶装置とを含んで構成され、駆動制御部51と同様に上記の各種演算可能な半導体集積回路および記憶装置等により適宜構成され得る。なお、本実施形態においては、監視制御部52は、FPGA(安全FPGA)により構成されるものとして説明する。
 制御装置50には、通信ケーブルを介してティーチングペンダント60を接続可能となっている。ティーチングペンダント60には、設定支援アプリケーションがインストールされており、ユーザによるロボット20の動きの設定(所謂ティーチングを含む)が支援される。ティーチングペンダント60は、ユーザにより設定されたロボット20の動きを示す動作シーケンス(動作プログラム)を制御装置50に送信し、制御装置50の駆動制御部51はこの動作シーケンスに基づいてAGV31やロボットアーム41の駆動制御を行う。また、ティーチングペンダント60も、演算可能な半導体集積回路、記憶装置とを含んで構成され、駆動制御部51と同様に上記の各種演算可能な半導体集積回路および記憶装置等により適宜構成され得る。
以下、図1及び図4を参照して、ロボット20が担当する作業について説明する。
 ロボット20は、先ずストックエリアE1にて空のコンテナ18を自身にセットする(シーンSN1)。具体的には、ロボット20は、ロボットアーム41を伸ばして棚13に収容されている空のコンテナ18を掴み、当該コンテナ18を自身の載置部32へ載せる。その後は、ロボットアーム41を待機姿勢に戻し、通路E4を通って加工エリアE2へ移動する(シーンSN2)。なお、待機姿勢となっているロボットアーム41は、ロボット20を上方から見てAGV31からのはみ出しが回避される。
 加工エリアE2においては、ロボット20は、当該加工エリアE2に配列された複数の加工機14から加工が完了したワークを収集する(シーンSN3)。具体的には、ロボット20は、ロボットアーム41を伸ばして加工機14のチャックに保持されているワークをハンド42で掴み、当該ワークを取り出してセットされているコンテナ18に収容する。ロボット20は、この動きを加工機14毎に繰り返し、集まったワークの数が所定数に達した場合に収集完了となる。収集完了後は、ロボット20は、ロボットアーム41を待機姿勢に戻し、ワークを収容したコンテナ18を通路E4を通って集積エリアE3へ搬送する(シーンSN4)。
 集積エリアE3では、ロボット20は、ワークを収容しているコンテナ18の荷下ろしを行う。具体的には、ロボット20は、当該コンテナ18をパレット15上に段積みする(シーンSN5)。パレット15に段積みされたコンテナ18群は、次の工程(例えば別の加工工程)へと順次搬送される。
 なお、上記シーンSN3ではワークが整列した状態でコンテナ18に収容されるが、何らかの要因によってコンテナ18内でワークが山積みとなった場合には、コンテナ18の段積みの妨げになり得る。そこで、上記シーンSN4では、ロボットアーム41により必要に応じてコンテナ18内でワークの位置を変更する作業が実行される。この変更作業は搬送と並行して行われる。
 集積エリアE3にて荷下ろしを終えたロボット20は、ロボットアーム41を待機姿勢に戻し、通路E4を通って集積エリアE3からコンベア11の終点へと移動する(シーンSN6)。そして、ロボット20は、コンベア11からワークの材料が収容されたコンテナ18を受け取る(シーンSN7)。具体的には、コンベア11に併設されたクレーンによってコンテナ18が載置部32にセットされる。この受け取りに際しては、ロボットアーム41がコンテナ18との衝突を回避すべく、一時的に向きを変える。
 コンテナ18がセットされたロボット20は、当該コンテナ18を通路E4を通ってストックエリアE1へ搬送する(シーンSN8)。ストックエリアE1へ到達した後は、ロボット20は、セットされているコンテナ18を棚12へ収納する(シーンSN9)。
 収納完了後は、ロボット20は、再びシーンSN1~SN9の一連の作業を繰り返す。このように、本実施形態では、シーンSN1~SN9によってロボット20の作業ルーティーンが構築されている。なお、コンベア11の稼動状況によっては、シーンSN7~SN9はスキップされる。
 なお、上記のシーンの切り替えは、好ましくは、現在のシーンの複数のタスクが全て完了したタイミングで行われる。これにより、タスクの途中でシーンが切り替わることにより生じうるロボット20の不本意な動作を抑制し、ロボット20の安全性を向上させることができる。
 シーンSN1~SN9では、ロボット20が位置するエリアや作業の具体的な内容だけでなく、人との関係(協働の有無等)が異なる。以下、図5を参照して、作業ルーティーンにおける一部のシーン、具体的にはシーンSN3~シーンSN5について説明する。なお、以下の説明では便宜上、「シーン」を「作業シーン」とも称する。作業シーンは、作業状況の一例である。
 シーンSN3の作業(ピッキング)が行われる加工エリアE2は、ロボット20とともにエリア担当者(人)が作業する協働エリアとなっている。具体的には、棚12に収納されているコンテナ18から材料を取り出して加工機14へ投入する投入作業、各加工機14のセッティング作業及び各加工機14の動作確認作業の各作業は、当該加工エリアE2のエリア担当者の役割となっており、加工後のワークを収集する収集作業はロボット20の役割となっている。つまり、加工エリアE2では、エリア担当者及びロボット20の両者が加工機14に係る作業を分担して行う。
 シーンSN4の作業(搬送)については、作業エリアが通路E4となるように規定されており、シーンSN5の作業(パレタイジング)については、作業エリアが集積エリアE3となるように規定されている。シーンSN4,SN5の各作業については、ロボット20の単独作業(非協働作業)となっている点で何れもシーンSN3と異なる。但し、通路E4については人(エリア担当者等)も通行可となっているのに対して、シーンSN5については基本的に人の立ち入りが禁止となっている。つまり、シーンSN4とシーンSN5とでは、エリアの運用の違いによってロボット20と人とが接触する可能性に差が生じている。具体的には人とロボット20とが接触する可能性はシーンSN5よりもシーンSN4の方が高くなっている。
 このように、ロボット20は、作業ルーティーン中に人と接触する可能性があり、上記レーザスキャナ37や非常停止スイッチ38以外にもロボット20の安全性を高める構成を備えている。以下、図6を参照してロボット20の安全機能に係る構成について補足説明する。
 ロボット20に適用されているロボット制御システムCSは、本実施形態においてはロボット20内に設置され、ロボット20の各種制御を行う。また、ロボット制御システムCSは、安全関連入力信号に応答して安全関連出力信号を出力することによりロボット20の安全機能を実現する安全関連部Xと、当該安全関連部Xにより安全が確認されAGV31やロボットアーム41の動作が許可されている場合にそれらAGV31やロボットアーム41の駆動制御を行う非安全関連部Yとに分類される。
 安全関連部Xは、上記安全関連入力信号を入力する入力部X1と、安全確認を行う論理部X2と、安全関連出力信号を出力する出力部X3とで構成されている。本実施形態では、入力部X1は、非常停止スイッチ38等の各種物理的入力手段、レーザスキャナ37、ロータリエンコーダ46及びトルクセンサ47等の各種センサ等を含む。また、本実施形態では、論理部X2は、制御装置50に設けられた監視制御部(セーフティコントローラ)52を含み、出力部X3は、制御装置50に付属の安全コンタクタ等の各種出力手段を含む。そして、論理部X2は、これを構成する監視制御部52に含まれる演算可能な半導体集積回路と記憶装置とにより実現され、論理部X2の各種機能が実現される。
 安全コンタクタは、AGV31の走行モータ35用の駆動回路に設けられたスイッチやロボットアーム41の駆動モータ45用の駆動回路に設けられたスイッチに接続されている。これらスイッチに安全コンタクタから安全関連出力信号が出力されることで、各モータ35,45への電力供給が遮断され、ロボット20が強制的に停止される。
 上述したように、本実施形態に示す安全関連部Xは、レーザスキャナ37や非常停止スイッチ38の他に上記ロータリエンコーダ46及びトルクセンサ47を含んでいる。つまり、ロータリエンコーダ46からの検出信号やトルクセンサ47からの検出信号が、上記安全関連入力信号として論理部X2に入力される。論理部X2は、ロータリエンコーダ46及びトルクセンサ47からの検出信号に基づいてロボット20の動作を監視する。ここで、論理部X2(制御装置50の監視制御部52)にて定期処理の一環として実行される動作監視処理を図7のフローチャートを参照して説明する。
 動作監視処理においては先ず、論理部X2は、ステップS101にて上記ロータリエンコーダ46及びトルクセンサ47からの検出信号に基づいて、ロボット20(ロボットアーム41)の手先(所謂ツールセンタポイント)の力(推力)、速さ、位置(座標)の各動作監視用パラメータを特定する。
 続くステップS102では、論理部X2は、手先の力が予め定められている基準値(力の閾値)よりも弱いかを判定する。この基準値については制御装置50のメモリに予め記憶されている。手先の力が基準値よりも弱い場合には、論理部X2は、ステップS103に進み、手先の速さが基準値(速さの閾値)よりも遅くなっているかを判定する。手先の速さが基準値よりも遅い場合には、論理部X2は、ステップS104に進み、手先の位置が基準範囲(動作許容範囲)内となっているかを判定する。すなわち、論理部X2は、安全関連入力信号および判定基準に基づいてロボットの動きの判定を行う動作判定部を備えている。論理部X2は、手先の位置が基準範囲内となっている場合には、そのまま本動作制御処理を終了する。以下の説明では、各基準値及び基準範囲を「判定基準」とも称する。
 一方、ステップS102~S104に示す3つの要件の何れかを満たしていない場合には、論理部X2は、所定の安全関連出力信号を生成する。そして、論理部X2は、安全関連出力信号を出力部X3を介して目的とする各部に出力して、安全機能を実現する。具体的には、論理部X2は、安全関連信号を出力部X3を介して出力することにより、ステップS105にて緊急停止用及び異常報知用の各処理を実行した後、本動作監視処理を終了する。緊急停止用の処理では、論理部X2は、出力部X3を介してモータ35,45への電力供給を強制的に遮断することでロボット20を停止(以下、非常停止ともいう)させる。そして、異常報知用の処理では論理部X2は、出力部X3を介してロボット20に設けられた警告ランプを点灯させるとともに、異常が発生した旨の情報を工場10の管理システムへ送信する。このように、本実施形態では、ロボット20の手先の力、速さ、位置が当該ロボット20の動作を監視するための動作監視用パラメータとなっている。
 なお、動作監視用パラメータについてはロボット20の手先の力、速さ、位置に限定されるものではない。これらに代えて又は加えて、各関節部(軸)の力(回転トルク)、速さ(回転速度)、位置を示す各パラメータを動作監視用のパラメータとすることも可能である。
 また、本実施形態では、動作監視用パラメータの判定基準がロボットアーム41(詳しくは手先)の動きを抑制(制限)するための目標としても機能する。例えば、ユーザがロボットアーム41等に直接触れてロボット20に動きを教示(ティーチング)する場合には、勢いに任せてロボットアーム41が押し引きされることで、上記判定基準を超えるような動きが設定され得る。このような場合であっても、ロボットアーム41の動きが判定基準を超えない範囲で収まるように補正されることにより、作業中に判定基準を超えることで非常停止が頻発することを抑制している。
 ここで、ロボット20を様々な作業に従事させる場合には、安全機能が画一的となって安全性の向上と作業効率の向上とを両立することが難しくなると想定される。本実施形態では、このような事情に配慮して、ロボット20の安全機能、具体的には各動作監視用パラメータの判定基準を複数段階で切替可能としている。以下、図8を参照して、安全機能の切り替えに係る構成について説明する。
 安全関連部Xによる安全機能を切替可能なコントロールデバイスとして、(1)ティーチングペンダント60、(2)駆動制御部51(詳しくはパックスクリプト)、(3)外部汎用入出力(以下、IOという)の3つが設けられている。これら3つのコントロールデバイスについては何れも非安全関連部Yに相当する。なお、該部汎用入出力については、接続先の外部機器も非安全関連部として機能し得る。この場合において、当該外部機器も、演算可能な半導体集積回路と、記憶装置とを含んで構成され、駆動制御部51と同様に上記の各種演算可能な半導体集積回路および記憶装置等により適宜構成され得る。
 ティーチングペンダント60には安全機能切替用のアプリケーションがインストールされており、ユーザにより動作監視用パラメータの判定基準の切替操作が行われた場合には、当該切り替えを指示する指令(リクエストコマンド)を含む指令情報及び当該指令が正常に送受信されたかを診断するための診断用情報(CRC、第1診断用情報)を含む情報群が非安全関連部Yとしてのティーチングペンダント60から安全関連部Xの安全FPGAに送信される。安全FPGAでは、この指令情報に含まれる指令に基づいて動作監視用パラメータの判定基準を切り替える。例えば、ユーザが上述したティーチングを行う場合には、ユーザの操作に応じて動作監視用パラメータの判定基準を切り替えることにより安全機能が教示作業の妨げになることを好適に抑制できる。なお、安全関連部Xの論理部X2に係る具体的構成については安全FPGAに限定されるものではなく、マイコンやCPUとすることも可能である。
 なお、IOにはセンサや工場10のコントロールセンタ等が通信可能に接続されており、ティーチングペンダント以外の外部機器からも安全機能の切り替えが許容されている。
 また、本実施形態に示すロボット制御システムCSについては、制御装置50の判断によって能動的に安全機能を切替可能な構成が採用されている。具体的には、ロボット20の作業シーンに応じて動作監視用パラメータの判定基準の切り替えがなされる構成となっている。以下、このような切替を実現すべく、駆動制御部51にて定期処理の一環として実行されるタスク監視処理について説明する。
 まず、駆動制御部51は、予め設定されたロボット20が作業を行う複数の作業状況(作業シーン)から、作業中のロボット20の作業状況を識別する。ロボット20の動作プログラムでは作業シーンにおけるロボット20の動きが複数のタスクの組み合わせによって規定されており、図9に示すタスク監視処理においては先ず、駆動制御部51は、ステップS201にて現在進行している作業に係る全てのタスクが完了したタイミングであるか否かを判定する。
 全てのタスクが完了したタイミングではない場合には、駆動制御部51は、ステップS201にて否定判定をして、そのまま本タスク監視処理を終了する。全てのタスクが完了したタイミングである場合には、駆動制御部51は、ステップS201にて肯定判定をして、ステップS202に進む。駆動制御部51にて参照される上記動作プログラムには、最後のタスクが終了する時点で次の作業シーンを特定するためのシーン関連情報が含まれており、ステップS202では、駆動制御部51は、このシーン関連情報に基づいて次の作業シーンを識別する。以上のように駆動制御部51は、ステップS201およびS202において状況識別部(本実施形態ではシーン識別部)として機能する。
 次に、ステップS203では、駆動制御部51は、ステップS202にて特定した作業シーンに応じて安全関連部Xの安全FPGAに対する安全機能の切り替えの指示を決定する。より具体的には、駆動制御部51は、安全機能の切り替えを要求するリクエストコマンドと、当該リクエストコマンドの送受信が正常に行われたかを診断するための診断用情報であるCRCとを設定する。本実施形態における安全機能については、ロボット20の作業シーン(シーンSN1~SN9)毎に規定されている。つまり、ステップS203にて設定されるリクエストコマンドについては、作業シーンの切り替えを安全関連部Xに要求しているとも言える。このような事情に鑑みれば安全機能切替を指示するリクエストコマンドは「シーンチェンジコマンド」であるとも言える。
 またここで、図10A、10Bを参照して、リクエストコマンド及びCRCについて補足説明する。リクエストコマンドは、送信元となるコントロールデバイスを識別するための情報と、今回のリクエストが安全機能の切り替えであることを示す情報とを含むコマンドID(第1情報)と、以降の判定にて参照すべき判定基準を示すデータ(シーン番号、第2情報)とで構成されている。
 安全機能の切り替えに係るリクエストコマンドの送信元が、ティーチングペンダント60である場合にはコマンドID=「11」、駆動制御部51(詳しくはパックスクリプト)である場合にはコマンドID=「12」、IOである場合にはコマンドID=「13」となる。
 また、安全機能の切り替えに係るリクエストコマンドが設定される場合のデータについては、「1」~「9」の9つの番号の何れかとなる。例えば、次の作業シーンがシーンSN3(ピッキング)である場合にはデータ=「3」、次の作業シーンがシーンSN4(搬送)である場合にはデータ=「4」、次の作業シーンがSN5(パレタイジング)である場合にはデータ=「5」となる。
 CRCは、コマンドIDとデータの番号とのチェックサムである。例えば、駆動制御部51が送信元であり且つ次の作業シーンがシーンSN4の搬送である場合には、CRC=「12」+「4」=「16」となる。
 ステップS203にてリクエストコマンド及びCRCを設定した後は、ステップS204にてシーンチェンジシーケンスを開始して、当該タスク監視処理を終了する(図9参照)。以降は、シーンチェンジシーケンス終了までタスク監視処理が回避される。
 次に、図11を参照して非安全関連部Yと安全関連部X(本実施形態においては安全FPGA)とで実行されるシーンチェンジシーケンスについて説明する。以下では、安全関連部Xは、非安全関連部Yに含まれる駆動制御部51からの指示に基づき、安全関連部Xの動作判定部により参照されるパラメータ用の判定基準を、識別された作業状況(作業シーン)に対応する判定基準に切り替える。以下のシーンチェンジシーケンスでは、安全関連部Xは、判定基準切替部として機能する。
 シーンチェンジシーケンスにおいては先ず非安全関連部Yから安全関連部Xに当該安全関連部Xの安全機能の切り替え、具体的には動作監視用パラメータの判定基準の切り替えを指示する。具体的には、指令情報としてのリクエストコマンド及びCRCを含む診断用情報を含む情報群を安全関連部Xに送る(ts1参照)。
 安全関連部Xは、非安全関連部Yからの指示を受けたことに基づいて、まず、指示が正常に安全関連部Xに届いたかを診断用情報に基づき判断する。具体的には、安全関連部Xは、今回のリクエストコマンド及びCRCに破損等の異常が発生していないかを診断する。より具合的には、安全関連部Xは、リクエストコマンドのコマンドIDの番号とデータの番号とを足した数が、CRCと一致しているかを判定する(ts2参照)。これらが一致している場合には、安全関連部Xは、今回の指示が正常に送受信されたとみなし、次に指示であるリクエストコマンド自体が正常であるかを診断する。具体的には、安全関連部Xは、コマンドIDを参照して、今回の指示が安全機能の切り替えであることを特定し、データが今回のコマンドIDに対応する範囲内であるかを判定する(ts3参照)。上述したように、コマンドIDが「11」~「13」である場合には、データが「1」~「9」の何れかとなる。今回のデータが「1」~「9」の何れかである場合には、安全関連部Xは、リクエストコマンドが正常であると判定する。
 なお、ts2又はts3にて正常でないと診断した場合には、安全関連部Xは、工場10のコントロールセンタ等に通信エラー等の異常が発生している旨を報知し、本シーンチェンジシーケンスを終了する。
 今回のリクエストコマンドが正常であると診断した場合には、安全関連部Xは、当該コマンドを受理し、非安全関連部Yの指示に応じて安全機能、すなわち動作監視用パラメータの判定基準を切り替える(ts4参照)。具体的には、安全関連部X(詳しくは制御装置50のメモリ)には、データの番号と各動作監視用パラメータとの対応関係が記憶されている。安全関連部Xは、指定されたデータの番号と、メモリに記憶されている対応関係とに基づいて、動作監視用パラメータを切り替える。
 例えば、図12に示すように、次の作業シーンがデータ=「3」の「ピッキング」である場合には、力の動作監視用パラメータの判定基準=70N、速さの動作監視用パラメータの判定基準=125mm/s、位置の動作監視用パラメータの判定基準=AGV31の上方領域+ワークの取り出し動作を考慮したAGV31の外側領域(ロボット20の平面視における外側領域)となる。このケースでは、手先の力が70Nを超えた場合、手先の速さが125mm/sを超えた場合、手先の位置がAGV31の上方領域+ピッキング用の拡張領域を外れた場合の何れかに該当したことに基づいてロボット20が非常停止されることとなる。
 次の作業シーンがデータ=「4」の「搬送」である場合には、力の動作監視用パラメータの判定基準=140N、速さの動作監視用パラメータの判定基準=250mm/s、位置の動作監視用パラメータの判定基準=AGV31の上方領域となる。このケースでは、手先の力が140Nを超えた場合、手先の速さが250mm/sを超えた場合、手先の位置がAGV31の上方領域を外れた場合(平面視にてロボットアーム41がAGV31からはみ出した場合)の何れかに該当したことに基づいてロボット20が非常停止されることとなる。
 次の作業シーンがデータ=「5」の「パレタイジング」である場合には、力の動作監視用パラメータの判定基準=能力上限(最大強さ)+αN、速さの動作監視用パラメータの判定基準=能力上限(最大速さ)+βmm/s、位置の動作監視用パラメータの判定基準=能力上限(最大可動範囲)+γとなる。このケースでは、判定基準が何れも能力の上限を超えているため、実質的に非常停止は回避されることとなる。
 図11の説明に戻り、安全機能(動作監視用パラメータの判定基準)の切り替えが完了した後は、安全関連部Xは、指示を受理した旨を非安全関連部Yに報知する。具体的には、アクノレッジ信号を非安全関連部Yに送る(ts5参照)。非安全関連部Yは、安全関連部Xからアクノレッジ信号が届いた場合に、安全関連部Xに対して切替後の安全機能の設定を特定するための情報、すなわち現在参照対象として設定されている動作監視用パラメータの判定基準を特定するための情報を要求する(ts6参照)。この要求においても、診断用情報(例えば、CRC)を付加してもよい。
 安全関連部Xは、非安全関連部Yからの確認要求に応じて、当該非安全関連部Yに、上記判定基準を特定するための情報としてのリクエストコマンド(詳しくはリクエストコマンドを模したコマンド)と当該リクエストコマンドの送受信が正常に行われたかを診断するための診断用情報であるCRC(第2診断用情報)とを送ることにより(ts7参照)、非安全関連部Yの確認要求に応答する。安全関連部Xからのリクエストコマンドは、非安全関連部Yからの上記リクエストコマンドと同様に、送信元が安全関連部Xであることを識別するための情報と、今回のリクエストが安全機能の切り替えであることを示す情報とを含むコマンドIDと、以降の判定にて参照すべき判定基準を示すデータ(シーン番号)とで構成される。そして、CRCについては今回返答するコマンドのコマンドIDの番号とデータ番号とを足した数となる。例えば、現在の設定が非安全関連部Yからの要求に応じてシーンSN5の「パレタイジング」に対応している場合には、コマンドID=「19」、データ番号=「5」、CRC=「24」を返す。因みに、CRCは、コマンドIDとデータ番号とに基づいて決定されるのであれば足り、その具体的な計算方法については任意である。
 なお、安全関連部Xから非安全関連部Yに送信されるリクエストコマンドのコマンドIDとデータとの和については、今回のシーケンスの開始時に非安全関連部Yから安全関連部Xに送信されたリクエストコマンドのコマンドIDとデータとの和に対して不一致となる。同様に、安全関連部Xから非安全関連部Yに送信されるリクエストコマンドに付随するCRCについては、今回のシーケンスの開始時に非安全関連部Yから安全関連部Xに送信されたリクエストコマンドに付随したCRCに対して不一致となる。
 安全関連部Xから応答を受けた非安全関連部Yは、第2診断用情報であるCRCに基づいて今回の応答が正常に届いたかを診断する。すなわち、非安全関連部Yは、今回の返答が正常に送受信されたかをリクエストコマンドとCRCとに基づいて診断する。具合的には、非安全関連部Yは、リクエストコマンドのコマンドIDの番号とデータの番号とを足した数が、CRCと一致しているかを判定する(t8参照)。これらが一致している場合には、非安全関連部Yは、今回の返答が正常に送受信されたとみなし、次に非安全関連部Yからのリクエストに応じて安全関連部Xの安全機能が正常に切り替わったかを判定する(t9参照)。すなわち、非安全関連部Yは、安全関連部Xにおいて実際に設定されている判定基準が、指令情報中の指示により指定した判定基準となっているかを診断する。具体的には、非安全関連部Yには安全関連部XからのリクエストコマンドのコマンドIDとデータとの関係が記憶されており、非安全関連部Yは、これらの関係を踏まえて、自身が安全関連部Xに送ったリクエストコマンドのコマンドID及びデータと内容が一致しているかを判定する。
 安全関連部Xからの返答が自身の指示に一致していることが確認された場合に、シーンチェンジシーケンス完了となる。
 ここで、本実施形態では安全関連部Xによる判定基準の切り替えは、作業シーンのすべてのタスクが終了した後に行われている。このように、先の作業シーンが完了しその後の作業シーンへ移行となる場合には、その間で切り替えを行うことで作業中に切り替えを行う構成と比較して、システムにおける制御負荷を好適に分散させることができる。また、次の作業シーンに移る場合には、状況が変化することで、人等との距離が変化する可能性が高い。そこで、次のシーンに備えて切り替えを行う構成とすることは、ロボットの安全性の向上を図る上でも好ましい。
 また、本実施形態では安全関連部Xによる判定基準の切り替えは、作業シーンのすべてのタスクが終了した後に行われている。すなわち、実行中の作業が完了した後に行われている。このように、実行中の1の作業の完了後まで安全関連部Xによる判定基準の切り替えを不可とすることにより、本来であれば問題のない動きが監視に引っかかるといった事象の発生を防止し、ロボットの非常停止等の機会を低減させて、作業効率を向上させることができる。
 以上詳述した第1の実施形態によれば、以下の優れた効果が期待できる。
 安全機能(判定基準)を切り替える場合には、非安全関連部Yから安全関連部Xに切り替えの指示がなされる。この指示はリクエストコマンド及びCRCで構成されており、安全関連部Xではリクエストコマンド及びCRCに基づいて指示が正常に届いたかが診断され、当該指示自体が正常であるかが診断される。診断で異常無しとなった場合には、安全関連部Xにおいて非安全関連部Yからの指示が受理され、安全関連部Xは当該指示に従って参照対象となる判定基準を切り替える。つまり、非安全関連部Yからの指示であっても、当該指示に送信エラー等による異常が無いと安全関連部Xが判断した場合には、判定基準の切り替えがなされる。このようにして、非安全関連部Yからの安全な切替を実現すれば、ロボット制御システムCSにおける安全機能の変更に係る操作性を好適に向上させることができる。
 次に、安全関連部Xから非安全関連部Yへ指示を受理した旨が報知され、当該報知を受けた非安全関連部Yは安全関連部Xに対して現在参照対象となっている判定基準(切替後の判定基準)を特定可能な情報を要求する。安全関連部Xではこれに応答して、当該情報CRCとからなる情報群を非安全関連部Yに送る。非安全関連部Yは、安全関連部Xからの応答が正常に届いたかをCRCに基づいて診断し、実際に設定されている判定基準が当初の指示により指定した判定基準となっているかを診断する。つまり、非安全関連部Yでは、自身の指示によって安全関連部Xにおける安全機能の切り替えが正常に行われたかを確認可能となっている。
 本実施形態に示した構成によれば、非安全関連部Yから安全関連部Xの安全機能を切り替える場合であっても、安全機能の変更に対する信頼性の低下を抑制し、安全機能を変更するための入力についても入力部X1からの入力(所謂安全入力)とする場合と比較して当該変更に係る制約が強くなることを回避できる。これにより、安全機能変更の操作性を好適に向上させることができる。
 さらには、上記実施形態によれば、非安全関連部Yと安全関連部Xとの間で安全機能の切り替えを挟んで2往復の通信が行われ、1往復の通信が行われるたびに、安全関連部Xまたは非安全関連部Yにより第1診断用情報または第2診断用情報を用いて正常な通信が行われたかが確認される。正常な通信が行われたことは、安全関連部Xおよび非安全関連部Yが正常に動作する可能性が高いことを示している。したがって、2度の通信の正常性の確認により、極めて高い確率で安全関連部Xおよび非安全関連部Yの双方が正常に動作していることが確認できる。さらには、非安全関連部Yと安全関連部Xとの間で安全機能の切り替えを挟んで2往復の通信が行われることにより、安全機能の切り替え中に非安全関連部Yおよび安全関連部Xが正常に動作していたことが担保される。
 因みに、1のロボットを様々な作業に従事させる場合、作業に応じて安全機能を変更(操作)可能とすることは、安全性に配慮しつつロボットの作業効率の向上を図る上で有利となる。非安全関連部Yからの安全機能の切り替えを可能とすることは、複数種類の作業へのロボットの適用を促し、工場の自動化を推進する上でも好ましい。
 本実施形態に示したように、安全関連部Xにおいて予め記憶されている指令の種類と今回の指令とを照合することにより非安全関連部Yからの指示自体が正常であるかを診断する構成とすれば、ビットの固着や通信エラー等によって指令が損傷した場合に、当該損傷した指令に基づいて安全機能が切り替わってしまうことを好適に抑制できる。
 複数種類の判定基準(力基準、速さ基準)について切り替えを行う場合には、各判定基準を個別に指定するのではなく、予め規定されたそれら基準の組み合わせ(シーン番号)を指定することにより、非安全関連部Yから安全関連部Xへの指示が複雑になることを抑制できる。これは、安全機能に配慮しつつロボットが従事可能な作業の数が増やす上で好ましい構成である。
 1のロボットが異なる複数の作業を担うことは、製造等の自動化を促進する上で好ましい。但し、作業シーンに関わらずロボットの安全機能を画一的とした場合には、安全性の向上と作業効率の向上との両立が難しくなる。この点、本実施形態に示した構成では、作業シーンを識別して、作業シーン毎に監視用の判定基準が変更される。これにより、ロボットの安全性の向上と作業効率の向上とに寄与できる。
 ここで、ロボットの安全性を向上させる上では、ロボットの動作状態(位置、向き、速さ等)が変わる毎に安全機能を逐次変化させる構成とすることも可能である。しかしながら、このような構成とした場合には、ロボット制御システムにおける制御負荷が大きくなり、ロボット制御システム本来の機能(ロボットの駆動制御)に影響が及ぶこととなる。この点、ロボットの動きが作業毎に変わる点に鑑みれば、本実施形態に示したように作業シーン(作業状況)毎に判定基準を切り替える構成とすることにはロボット制御システムの本来の機能への影響を抑えつつ、安全性を向上できるという明確な技術的意義がある。
 動作プログラムに含まれるシーン関連情報に基づいて作業シーンを識別可能とすれば、ロボット制御システムが自身の速やかな判断によって作業シーン毎の判定基準を選択する構成を実現できる。これにより、安全機能の切替に大きな待ち時間が発生することを抑制し、作業効率向上に寄与できる。
 また、判定基準を切替可能とすることはロボットの安全性に配慮しつつロボットの作業性を向上させる上で好ましい。しかしながら、このような切替機能を具備した場合には、以下の新たな懸念が生じる。すなわち、仮に偶発的な理由等で1の作業中に突如として判定基準の切り替えが発生すると、本来であれば問題のない動きが監視に引っかかるといった事象が発生し得る。これは、ロボットの非常停止等の機会を不要に増やして作業効率を低下させる要因となる。そこで、本実施形態に示したように、実行中の1の作業が完了するまで作業シーンに応じた判定基準の切り替えを不可として上記事象の発生を抑えることにより実用上好ましい構成が実現できる。
 なお、手先の位置を示す動作監視用パラメータの判定基準についても力や速さを示す動作監視用パラメータの判定基準とともに切替可能とすることで、ロボットの力や速さの監視が過度にシビアになることを抑制できる。これは、ロボットの作業効率を向上させる上で好ましい。
 <3.第2の実施形態>
 上記第1の実施形態に示したロボット制御システムCSについては、作業シーンに応じて安全機能を変更することによりロボット20の作業効率や安全性の向上等を実現した。本実施形態においては、安全機能の変更に際して、作業シーンを円滑に移行させる工夫がなされていることが特徴の1つとなっている。以下、先ず図13を参照して、着目した事象について説明する。
 作業シーンの切り替えが発生した場合の判定基準(基準値)の変更については、以下の2つのパターンに大別される。すなわち、図13Aに示すように作業シーンの切り替えによって基準値が引き上げられるパターンと、図13Bに示すように作業シーンの切り替えによって基準値が引き下げられるパターンとに大別される。以下の説明では、ロボット20の手先の力について例示するが、手先の速さについても同様の事象が発生する。
 図13Aに示す例では、切替前の作業シーンではロボット20の手先の力(検出値)が基準値よりも低くなるように推移している。作業シーンの切り替えが発生するt0のタイミングでは、基準値が引き上げられており、検出値と基準値との差が大きくなっている。つまり、作業シーンの切り替えに合せて基準値が引き上げられても、検出値が基準値を下回ったままとなる。作業シーンの切り替えによって上述した出力制限等が緩和され、ロボット20の手先の力や速さが増加し得るものの、作業のスケジュールやモータの動きの遅れ等によって瞬時に検出値が跳ね上がるわけではない。このため、作業シーン切替直後、具体的には作業シーンの切替後の最初の監視周期(サンプリング周期)となるt1のタイミングでは、検出値が新たに設定された基準値を下回ったままとなっている。つまり、作業シーンの切替時に検出値が基準値を上回ってロボット20が非常停止されるといった事象は発生していない。
 これに対して、図13Bに示す例では、切替前の作業シーンではロボット20の手先の力(検出値)が基準値よりも低くなるように推移している。この点では、図13Aに示す例と同様である。但し、図13Aでは作業シーンの切り替えが発生するt0のタイミングにて基準値が引き上げられている(判定基準が緩くなっている)一方、図13Bでは作業シーンの切り替えが発生するt0のタイミングにて基準値が引き下げられている(判定基準が厳しくなっている)。図13BのパターンLのように、t0のタイミングまでの期間にて、検出値が切替前及び切替後の両基準値を下回るようにして推移している場合には、当該t0のタイミングや直後のt1のタイミングにて検出値が切替後の基準値を上回ることはない。一方で、図13BのパターンHのように、t0のタイミングまでの期間にて、検出値が切替前の基準値と切替後の基準値との間を推移している場合には、当該t0のタイミングや直後のt1のタイミングにて検出値が切替後の基準値を上回ることとなる。その後、作業シーンの切り替えに伴って上述した出力制限等が厳しくなったとしても直ちに検出値が切替後の基準値を下回るとは限らない。このような事象が発生してロボット20が非常停止されること、すなわち本来であれば必要のないタイミングで非常停止となることは、ロボット20に対する信頼性やロボット20による作業効率(生産効率)の向上を図る上で妨げになり得る。
 本実施形態では、このような事情に配慮して、作業シーンの切り替えに係る構成が工夫されている。以下、図14のフローチャートを参照して、当該工夫、具体的には監視制御部52により動作監視処理(定期処理)の一環として実行されるシーン切替時監視用処理について説明する。なお、図14においては便宜上、作業シーンの切り替え直後となる部分の時間のスケールや検出値が基準値を正規に上回っている部分の時間のスケールを、他の部分の時間のスケールよりも拡大した態様の記載としている。
 シーン切替時監視用処理においては先ず、監視制御部52は、ステップS301にてメモリのフラグ格納エリアに特殊監視フラグがセットされているか否かを判定する。特殊監視フラグがセットされていない場合には、監視制御部52は、ステップS301にて否定判定をしてステップS302に進む。ステップS302では、監視制御部52は、作業シーンの切り替えが発生したかを判定する。具体的には監視制御部52は、非安全関連部Yから安全機能の切り替えの指示を受理したかを判定する。作業シーンの切り替えが発生していない場合には、監視制御部52は、そのまま本監視用処理を終了する。作業シーンの切り替えが発生した場合には、監視制御部52は、ステップS303に進む。ステップS303では、監視制御部52は、判定基準の切り替えを行う。具体的には、監視制御部52は、動作判定にて参照される基準値を新たな作業シーンに対応する基準値に切り替える。続くステップS304では、監視制御部52は、メモリのフラグ格納エリアに特殊監視フラグをセットして本監視用処理を終了する。
 以下便宜上、切替前の作業シーンを「作業シーンA」、当該作業シーンAに対応する基準値を「基準値FA」、切替後の作業シーンを「作業シーンB」、当該作業シーンBに対応する基準値を「基準値FB」として説明する。
 ステップS301の説明に戻り、特殊監視フラグがセットされている場合には、監視制御部52は、ステップS305にて作業シーンを作業シーンAから作業シーンBに切り替えた後、ロボット20(手先)の動きを最初に確認するタイミングとなったか否かを判定する。具体的には、メモリには作業シーン切替後の本監視用処理の実行回数を把握するためのカウンタが設けられている。このカウンタの値nは特殊監視フラグがセットされた際に「0」→「1」となり、以降は本監視用処理が実行される度に1ずつ加算され、特殊監視フラグが消去される際に0クリアされる。ステップS305では、監視制御部52は、このカウンタの値nを参照して最初の確認のタイミングであるかを判定する。
 監視制御部52は、ステップS305にて肯定判定をした場合にはステップS306に進む。ステップS306では、監視制御部52は、今回の検出値Ft1が切替後の基準値FBを下回っているかを判定する。検出値Ft1が基準値FBを下回っている場合には、監視制御部52は、ステップS307にて上記特殊監視フラグを消去して、本監視用処理を終了する。検出値Ft1が基準値FBに達している場合には、監視制御部52は、ステップS306にて否定判定をして、ステップS308に進み、力、速さの減制御の割込みを開始する。
 ステップS308の処理では、監視制御部52は、ロボット20の手先の動きを抑制すべく駆動モータ45の駆動制御に介入する。具体的には、監視制御部52は、駆動モータ45に供給される電力等を一定程度制限する。この減制御の割込みについては、監視周期が上限回数であるn回となるまで(所定期間が経過するまで)繰り返されるまで継続されることとなる。なお、制限の程度及び上限回数については、ステップS308の処理を実行する際に基準値FA及び基準値FBに基づいて算出する構成としてもよいし、プログラムバンク等に予め登録されたものを読み出す構成としてもよい。因みに、本減制御の割込みではロボット20を停止させることはない。
 ステップS308の減制御の割込みが開始されることにより、検出値が強制的に引き下げられることとなる。続くステップS309では、監視制御部52は、減制御の割込みを開始した後の各監視周期における検出値Ftnの減制御目標値Tn(中間目標値Tn又は目標値Tn)を設定する。具体的には、ステップS308の減制御による減少率は一定となるように規定されており、その減少率と上記検出値Ft1とに基づいて減制御目標値Tnが設定される。
 ステップS305の説明に戻り、監視制御部52は、最初の確認のタイミングではないと判定した場合、すなわち2回目以降のタイミングであると判定した場合には、ステップS310に進む。ステップS310では、監視制御部52は、今回の検出値FtnがステップS310にて設定された今回の減制御目標値Tnを下回っているかを判定する。今回の検出値Ftnが今回の減制御目標値Tnを下回っていない場合には、ロボット20に想定外の動き(異常)が発生している可能性があるため、監視制御部52は、ステップS311にて緊急停止用及び異常報知用の各処理を実行した後、本監視用処理を終了する。緊急停止用の処理では、監視制御部52は、モータ35,45への電力供給を強制的に遮断することでロボット20を非常停止させる。そして、監視制御部52は、異常報知用の処理ではロボット20に設けられた警告ランプを点灯させるとともに、異常が発生した旨の情報を工場10の管理システムへ送信する。
 ステップS310の説明に戻り、今回の検出値Ftnが今回の減制御目標値Tnを下回っている場合には、監視制御部52は、ステップS310にて肯定判定をしてステップS312に進む。ステップS312では、監視制御部52は、今回の検出値Ftnが切替後の基準値である基準値FBを下回っているか否かを判定する。ステップS312にて否定判定をした場合には、監視制御部52は、ステップS313に進み、今回の監視周期すなわち作業ステージの切替後に本監視用処理が実行された回数がステップS309で設定された上限回数となったか否かを判定する。上限回数に達していると判定した場合には、監視制御部52は、ステップS311に進む。本来であれば上限回数到達前に検出値が基準値を下回るように減制御の割込みがなされるところ、上限回数到達時にも未だ検出値が基準値を下回るように引き下げられていない場合には、ロボット20の動きに想定外の動き(異常)が発生している可能性があると想定される。そこで、ステップS311にて、監視制御部52は、ロボット20の非常停止及び異常報知を実行した後に本監視用処理を終了する。ステップS313にて上限回数に達していないと判定した場合には、監視制御部52は、ステップS314にて上記カウンタの値nを「1」加算して本監視用処理を終了する。
 ステップS312の説明に戻り、当該ステップS312にて肯定判定をした場合、すなわち検出値Ftnが切替後の基準値FBを下回っている場合には、監視制御部52は、ステップS315に進む。ステップS315では、監視制御部52は、上記減制御の割込みを終了する。これにより、検出値の強制引き下げが解除されることとなる。その後は、ステップS316にて、監視制御部52は、特殊監視フラグを消去して、本監視用処理を終了する。
 ここで、図15のタイミングチャートを参照して、作業シーンAから作業シーンBへの作業シーンの切り替えに伴う検出値の変化について補足説明する。
 作業シーンAから作業シーンBへ切り替わるt0のタイミングでは、検出値(検出値Ft0)が基準値FAと基準値FBとの間に位置している。作業シーン切替直後のt1のタイミング、すなわちt0のタイミングの次周期のt1のタイミングでは、検出値Ft1が基準値FBを上回ったままとなっている。本来であれば、この時点で非常停止且つ異常報知が実行されるところ、この検出値に基づく非常停止及び異常報知については回避される。そして、このt1のタイミングでは、検出値を強制的に引き下げるべく減制御の割込みが開始される。
 以降の各周期(t2~t4のタイミング)では検出値Ft2~Ft4が減制御目標値T2~T4を各々下回っており、予定通りに検出値が引き下げられている。そして、t5のタイミングでは、周期が上限回数に達する前に予定通り基準値FBを下回っている。これにより、減制御の割込みが終了している。仮に、t2~t5のタイミングにて予定通りに検出値が引き下げられなかった場合には、その時点で非常停止及び異常報知が実行される。
 減制御の割込みが終了したt5のタイミング以降は、実際の検出値についても基本的に基準値FBを下回るようにして推移する。そして、t6~t7のタイミングに示すように、検出値が基準値FBに達するように変化した場合に、非常停止及び異常報知が実行されることとなる。
 以上詳述した構成によれば、作業シーンの切り替えに伴って安全機能を変更する場合であっても、当該変更に起因してロボット20が非常停止(誤停止)される機会を減らすことができる。このようにして、ロボット20の誤停止を抑制することは、ロボット20による生産効率の向上等を実現する上で好ましい。
 なお、本実施形態に示す構成をレーザスキャナ37等を用いて人との距離を検出し、ロボット20の作業シーン(例えば人協働シーン)を人との距離の検出結果によって切り替える構成に適用することも可能である。具体的には、ロボット20と人との距離が相対的に近い場合の基準値(近距離対応の基準値)を相対的に遠い場合の基準値(遠距離対応の基準値)よりも低くなるように構成することで更なる安全性の強化が期待できる。但し、人との距離は突発的に変わることがあるため、基準値が高→低となった際に上記誤停止が発生する機会が多くなることで生産性等への影響が顕著となり得る。この点、本実施形態に示した構成を適用すれば、突発的に作業シーンを遠距離対応の作業シーンから近距離対応の作業シーンに切り替わった場合であっても、ロボット20の誤停止等を抑制することができる。
 <4.第3の実施形態>
 上記第2の実施形態では、作業シーンの切替を契機として減制御の割込みを開始する構成とした。本実施形態では減制御の割込みに関する構成が第2の実施形態と相違している。以下、図16のフローチャートを参照して、第2の実施形態との相違点を中心に本実施形態におけるシーン切替時監視用処理について説明する。
 本実施形態におけるシーン切替時監視用処理においては先ず、監視制御部52は、ステップS401にてメモリに切替準備フラグがセットされているか否かを判定する。切替準備フラグがセットされていない場合には、監視制御部52は、ステップS402に進む。ステップS402では作業シーンの切り替えが発生している場合には、監視制御部52は、ステップS403にて判定基準の切り替え、具体的に基準値FA→基準値FBへ変更した後、本監視用処理を終了する。
 作業シーンの切り替えが発生していない場合には、監視制御部52は、ステップS404に進む。ステップS404では、監視制御部52は、現在の作業の進行状況を把握する。続くステップS405では、監視制御部52は、現時点での検出値Fxが次に予定されている作業シーン(作業シーンB)の基準値(基準値FB)を下回っているかを判定する。検出値Fxが基準値FBを下回っている場合には、監視制御部52は、そのまま本監視用処理を終了する。検出値Fxが基準値FBに達している場合には監視制御部52は、ステップS406に進む。
 ステップS406では、監視制御部52は、現在の検出値Fx及び基準値FBの差と、次に予定されている作業シーンまでの残り時間(例えば推定時間)とに基づいて、力、速さ減制御の割込みを開始すべきタイミングであるかを判定する。すなわち、監視制御部52は、残り時間内に検出値を基準値FBよりも低くなるように引き下げる上で適正なタイミングとなったかを判定する。ステップS406にて否定判定をした場合、監視制御部52は、現時点の検出値等を考慮してまだまだ残り時間に余裕がある場合には、そのまま本監視用処理を終了する。ステップS406にて適正なタイミングであると判定した場合には、監視制御部52は、ステップS408にて減制御の割込みを開始する。この減制御の割込みでは、監視制御部52は、ロボット20の手先の動きを抑制すべく駆動モータ45の駆動制御に介入する。具体的には、監視制御部52は、駆動モータ45に供給される電力等を一定程度制限する。
 なお、本実施形態では、適正なタイミングを「可変」としたが、これを「固定」とすることも可能である。つまり、残り時間が所定時間となった場合には、その時点での検出値が基準値FBを超えていることを条件として減制御の割込みを開始する構成としてもよい。
 その後は、ステップS406にて、監視制御部52は、メモリのフラグ格納エリアに切替準備フラグをセットして、本監視用処理を終了する。
 ステップS401の説明に戻り、監視制御部52は、メモリのフラグ格納エリアに切替準備フラグがセットされていると判定した場合には、ステップS409に進む。ステップS409では、監視制御部52は、作業シーンの切り替えが発生したかを判定する。作業シーンの切り替えが発生している場合には、監視制御部52は、ステップS410にて判定基準の切り替え、具体的に基準値FA→基準値FBへ変更を行う。その後は、ステップS411にて、監視制御部52は、今回の検出値Ft0が基準値FBを下回っているかを判定する。上述したように、本実施形態では作業シーンの切り替えが事前に把握され、当該切り替えを目指して減制御の割込みが実行される。これにより、作業シーンの切り替えが実行されるタイミングでは、基本的には検出値Ft0は基準値FBを下回ることとなる。
 ステップS411にて肯定判定をした場合には、監視制御部52は、ステップS412にて減制御の割込みを終了し、ステップS413にて切替準備フラグを消去して、本監視用処理を終了する。
 ステップS411にて否定判定をした場合には、監視制御部52は、ステップS414にて緊急停止及び異常報知の各処理を実行した後、本監視用処理を終了する。
 ここで、図17のタイミングチャートを参照して、作業シーンAから作業シーンBへの作業シーンの切り替えがなされる場合の検出値の変化について補足説明する。
 作業シーンAから作業シーンBへ切り替わるt0のタイミングよりも前のtxのタイミングでは、検出値(検出値Fx)が現在の作業シーンAに対応する基準値FAと次の作業シーンBに対応する基準値FBとの間に位置している。txのタイミングでは、監視制御部52は、次の作業シーンB及び当該次の作業シーンBまでの残り時間を事前に特定し、現時点での検出値、次の作業シーンBに対応する基準値FB、t0のタイミングまでの残り時間とに基づいて、減制御の割込みを開始する適正なタイミングであると判定され、当該減制御の割込みが開始されている。
 作業シーンAから作業シーンBへ切り替わるt0のタイミングでは、基準値が基準値FAから基準値FBに切り替わり、現時点での検出値が基準値FBを下回っているか判定される。上記減制御の割込みにより検出値が予定通りに引き下げられた場合には、t0のタイミングで検出値が基準値FBを下回り、ロボット20の非常停止等が実行されることはない。これに対して、何らかの事情によって検出値が想定通りに引き下げられずt0のタイミングで検出値が基準値FBに達している場合には、ロボット20が非常停止等が実行されることとなる。
 以上詳述したように、作業シーンの切り替え前に作業シーン切替までの減制御期間(緩衝領域)を設けることにより、作業シーンの切り替えに伴って安全機能を変更する場合であっても、当該変更に起因してロボット20が非常停止(誤停止)される機会を減らすことができる。このようにして、ロボット20の誤停止を抑制することは、ロボット20による生産効率の向上等を実現する上で好ましい。
 <5.第4の実施形態>
 本実施形態に示すロボット20ではレーザスキャナ37を用いて人との距離を推定し、ロボット20の作業シーン(例えば人協働を想定していないシーンSN5のパレタイジング)を人との距離の検出結果によって人を想定していない作業シーン(以下、作業シーン1という)と人を想定した作業シーン(以下、作業シーン2という)とに切り替える構成となっており、且つ当該切り替に際して安全機能(判定基準)を相違するように変更する構成となっている点で上記第1の実施形態と構成が相違している。作業シーン1における判定基準(基準値F1)については、作業シーン2における判定基準(基準値F2)よりも低くなっている点に鑑みれば、作業シーン2は作業シーン1よりも安全性への配慮が強くなるシーンであると言える。
 図18に示すように、レーザスキャナ37による検出領域(監視領域)として、ロボット20の直近となる周辺領域CE1と、レーザスキャナ37による監視外の非検出領域CE3及び当該周辺領域CE1の間に設定された緩衝領域CE2とが設けられている。ロボット20が集積エリアE3にて作業している状況下では、作業シーンは上述した人を想定しない作業シーン1となっており、当該ロボット20に近づいた人が周辺領域CE1へ侵入した場合(周辺領域CE1にて人を検出した場合)には作業シーン1から作業シーン2に切り替わる。本実施形態では、このような突発的な切り替えに際して、上記第3の実施形態に示した技術的思想を適用し、作業シーン切り替えの事前準備を行うことにより、安全性と生産効率(作業効率)との向上を図っている。以下、図19のフローチャートを参照して、当該事前準備に係る構成、具体的には監視制御部52における動作監視処理の一環として実行される特殊切替時監視用処理について説明する。
 特殊切替時監視用処理においては先ず、監視制御部52は、ステップS501にてメモリに切替準備フラグがセットされているか否かを判定する。切替準備フラグがセットされていない場合には、監視制御部52は、ステップS502に進む。ステップS502では、監視制御部52は、レーザスキャナ37からの情報に基づいて緩衝領域CE2にて物体(人)を検出したか否かを判定する。ステップS502にて否定判定をした場合には、監視制御部52は、そのまま本監視用処理を終了する。ステップS502にて肯定判定をした場合には、監視制御部52は、ステップS503に進み、次の作業シーンの判定基準(基準値)を事前確認する。具体的には、人が緩衝領域CE2に侵入した場合にはそのまま周辺領域CE1に侵入される可能性があり、周辺領域CE1への侵入を確認した場合には作業シーンが上記作業シーン1から作業シーン2に切り替わる。そこで、ステップS503では、監視制御部52は、作業シーン2となった場合の基準値F2を事前に確認する。
 続くステップS504では、監視制御部52は、現時点での検出値Fxが次に切り替わると想定される作業シーン2の基準値F2を下回っているかを判定する。検出値Fxが基準値F2を下回っている場合には、監視制御部52は、そのまま本監視用処理を終了する。検出値Fxが基準値F2に達している場合には監視制御部52は、ステップS505に進む。
 ステップS505では、監視制御部52は、力、速さ減制御の割込みを開始する。この減制御の割込みでは、監視制御部52は、ロボット20の手先の動きを抑制すべく駆動モータ45の駆動制御に介入する。具体的には、監視制御部52は、駆動モータ45に供給される電力等を一定程度制限する。その後は、監視制御部52は、ステップS506にてメモリのフラグ格納エリアに切替準備フラグをセットして、本監視用処理を終了する。
 ステップS501の説明に戻り、メモリのフラグ格納エリアに切替準備フラグがセットされていると判定した場合には、監視制御部52は、ステップS507に進む。ステップS507では、監視制御部52は、緩衝領域CE2にて物体(人)を検出したか否かを判定する。ステップS507にて否定判定をした場合、すなわち緩衝領域CE2に物体(人)が検出されなくなった場合には、監視制御部52は、ステップS508に進み、減制御の割込みを終了する。その後、監視制御部52は、ステップS509にて切替準備フラグを消去して、本監視用処理を終了する。
 一方、ステップS507にて肯定判定をした場合には、監視制御部52は、ステップS510に進む。なお、周辺領域CE1にて物体(人)を検出している場合にもステップS507にて肯定判定され、監視制御部52は、ステップS510に進む。
 ステップS510では、監視制御部52は、作業シーン1から作業シーン2への切り替えが発生したかを判定する。具体的には、監視制御部52は、周辺領域CE1にて物体(人)を検出したか否かを判定する。作業シーン2への切り替えが発生している場合には、監視制御部52は、ステップS511にて判定基準の切り替え、具体的に基準値F1→基準値F2へ変更する。その後は、監視制御部52は、ステップS512にて今回の検出値Ft0が基準値F2を下回っているかを判定する。上述したように、本実施形態では作業シーンの切り替えが事前に予測され、当該切り替えを目指して減制御の割込みが実行される。これにより、作業シーンの切り替えが実行されるタイミングでは、基本的には検出値Ft0は基準値F2を下回ることとなる。
 ステップS512にて肯定判定をした場合には、監視制御部52は、ステップS508にて減制御の割込みを終了し、ステップS509にて切替準備フラグを消去して、本監視用処理を終了する。
 ステップS512にて否定判定をした場合には、監視制御部52は、ステップS513にて緊急停止及び異常報知の各処理を実行した後、本監視用処理を終了する。
 以上詳述したように、作業シーン1から作業シーン2への切り替え前に作業シーン切替までの減制御期間を設けることにより、作業シーンの切り替えに伴って安全機能を変更する場合であっても、当該変更に起因してロボット20が非常停止(誤停止)される機会を減らすことができる。このようにして、ロボット20の誤停止を抑制することは、ロボット20による生産効率の向上等を実現する上で好ましい。
 なお、本実施形態においては、非協働となるシーンSN5に作業シーン1及び作業シーン2の切り替えに係る機能を適用した場合について例示したが、これに限定されるものではない。協働となる他の作業シーンに作業シーン1及び作業シーン2の切り替えに係る機能を適用することも可能である。
 <6.その他の実施形態>
 なお、上述した各実施形態の記載内容に限定されず例えば次のように実施してもよい。ちなみに、以下の各構成を個別に上記各実施形態に対して適用してもよく、一部又は全部を組み合わせて上記各実施形態に対して適用してもよい。また、上記各実施形態に示した各種構成の全て又は一部を任意に組み合わせることも可能である。この場合、組み合わせの対象となる各構成の技術的意義(発揮される効果)が担保されることが好ましい。実施形態の組み合わせからなる新たな構成に対して以下の各構成を個別に適用してもよく、一部又は全部を組み合わせて適用することも可能である。
 ・上記各実施形態では、ロボット20の作業シーン(シーンSN1~SN9)を判別し、判別した作業シーンに応じて動作監視用パラメータ(力、速さ、位置)の判定基準を切り替える構成としたが、これを以下のように変更してもよい。すなわちロボット20の作業の種類が当該ロボット20が移動するエリア毎に異なる構成においては、駆動制御部51がロボット20が位置しているエリアを識別し、安全関連部Xが識別したエリアに応じて動作監視用パラメータの判定基準を切り替える構成とすることも可能である。このように、作業状況として作業シーンに代えて作業エリアの識別がなされる。この場合において駆動制御部51は、エリア識別部として機能し得る。また、ロボット20が移動する各エリアにて複数の作業が行われる場合や、複数のエリアにて同じ作業が行われる場合には、駆動制御部51はロボット20の作業シーン及びロボット20が位置しているエリアの両方を判別し、安全関連部Xはそれらに応じて動作監視用パラメータの判定基準を切り替える構成とすることも可能である。
 ・ロボット20が複数の作業(作業ルーティーン)を予め定められたタイムスケジュールで実行する構成においては、駆動制御部51が当該作業ルーティーンの進行を同ルーティーン開始から経過した時間又は現在の時刻によって管理する構成とし、安全関連部Xがそれら時間又は時刻に基づいて動作監視用パラメータの判定基準を切り替える構成とすることも可能である。また、スケジュールに遅延が生じる場合に配慮して、安全関連部Xが時間又は時刻と遅延時間を示す情報とに基づいて動作監視用パラメータの判定基準を切り替える構成とすることも可能である。このように、作業状況として作業シーンに代えて時間又は時刻の把握がなされる。この場合において駆動制御部51は、把握部として機能し得る。
 更に、上記各実施形態に示したようにロボット20の作業シーンに応じて判定基準を切り替える構成に付加して、安全関連部Xが経過した時間又は現在の時刻によって判定基準を切り替える構成とすることも可能である。例えば、工場10においては定期的に休憩時間(お昼休憩等)が設けられることが多く、この時間帯には通路E4等に人が増える可能性が高くなると想定される。このような事情に配慮して、ロボット20が休憩時間に通路E4を通過する場合の判定基準は、休憩時間外に通路E4を通過する場合の判定基準よりも厳しくなるように判定基準を切り替える構成とするとよい。
 ・上記各実施形態では、何れの作業シーンにおいても力、速さ、位置の3つの動作監視用パラメータを併用する構成としたが、作業シーンに応じて判定基準の対象とする動作監視用パラメータの種類や数を変更してもよい。例えば、第1のシーンでは力及び速さを動作監視用パラメータとする一方、第2のシーンでは力、速さ、位置を動作監視用パラメータとすることも可能である。
 ・上記各実施形態に示した作業シーンをロボット20の動作の種類に応じて細分化し、安全関連部Xが細分化されたシーン毎に動作監視用パラメータの判定基準を切り替える構成とすることも可能である。例えば、シーンSN3のピッキングでは、加工機14からワークを取り出すシーンと、隣の加工機へ移るシーンとを個別のシーンとして判定基準を切り替える構成としてもよい。更には、ワークの取り出しシーンの前半(ワークを把持するまで)と後半(ワークをコンテナ18に移すまで)とで安全関連部Xが判定基準を切り替える構成としてもよい。
 また、1の作業シーンを、人との距離が相対的に近くなると想定されるシーンと、人との距離が相対的に遠くなると想定されるシーンとに細分化し、それら細分化したシーン毎に安全関連部Xが判定基準を切り替える構成とすることも可能である。
 ・上記各実施形態では、安全関連部Xが、先の作業シーンから次の作業シーンに移るタイミングで動作監視用パラメータの判定基準を切り替える構成としたが、これを変更し、先の作業シーンの終盤に動作監視用パラメータの判定基準を切り替える構成としたり、次の作業シーンの冒頭で動作監視用パラメータを切り替える構成としたりすることを否定するものではない。
 なお、判定基準の切り替え中にロボット20の動作の継続を許容するか否かについては任意である。動作監視用パラメータの判定基準を切り替える際には当該切り替えが完了するまでロボット20の動作を一時的に停止させる構成としてもよい。また、判定基準を厳しくする切り替えにおいてロボット20を一時停止させる一方、判定基準を緩くする切り替えにおいてはロボット20の動作を継続させる構成とすることも可能である。
 ・上記各実施形態では、非安全関連部Yと安全関連部Xとの送受信が正常に行われているかを診断するための診断用情報としてCRCを付加する構成とした。このCRCの設定態様については任意であり、必ずしもリクエストコマンドのコマンドIDとデータとに基づいて設定する必要はない。
 ・上記各実施形態に示したシーンSN5のパレタイジングでは、ロボット20の力、速さ、位置についてロボット20の能力の限界を超える値、すなわち実質的に発生し得ない値を動作監視用パラメータの判定基準として設定したが、これを変更し、シーンSN5のパレタイジングにおいては動作監視をスキップする構成としてもよい。言い換えれば、特定の作業シーンではロボット20の動作監視機能がOFFとなる構成としてもよい。
 ・上記各実施形態では、ロボット20の作業シーンに応じて動作監視用パラメータの判定基準の切り替えと、力、速さ、位置(移動領域)の制限の切り替えとが実行される構成としたが、これに限定されるものではない。少なくとも動作監視用パラメータの判定基準の切り替えを行うのであれば足り、制限の切り替えについては省略することも可能である。
 ・上記各実施形態では、ロボット20を移動式とした場合について例示したが、固定式のロボット用のロボット制御システムに上記実施形態に示した技術的思想を適用してもよい。例えば、固定式のロボットがコンベア等により供給されるワークの種類に応じて異なる複数種類の作業を実行する構成においては、その作業シーンを判別して、作業シーン毎に動作監視用パラメータの判定基準を切り替える構成とすることも可能である。なお、当該作業シーンについても上述の如く細分化して、細分化されたシーン毎に判定基準を切り替える構成としてもよい。
 ・上記各実施形態に示したように動作監視用パラメータの判定基準を切替可能とすることはロボット20の安全性に配慮しつつロボット20の作業性を向上させる上で好ましい。しかしながら、このような切替機能を具備した場合には、以下の新たな懸念が生じる。すなわち、仮に偶発的な理由等で1の作業中に突如として判定基準の切り替えが発生すると、本来であれば問題のない動きが監視に引っかかるといった事象が発生し得る。これは、ロボット20の非常停止等の機会を不要に増やして作業効率を低下させる要因となる。このような事情に鑑みれば、実行中の1の作業が完了するまで判定基準の切り替えを不可とする(禁止する)ことには技術的意義がある。
 ・シーンSN4の「搬送A」と、シーンSN8の「搬送B」とでは、搬送しているものが異なる。搬送物の条件(例えば重量)の違いを考慮して、搬送Aにおける安全機能(動作監視用パラメータの判定基準)と搬送Bにおける安全機能(動作監視用パラメータの判定基準)とを個別に設定してもよい。
 ・上記各実施形態では、各非安全関連部Y(コントロールデバイス)からのリクエストコマンドについては作業シーンを指定する番号(シーン番号=1~9)が共用となるように構成したが、これに限定されるものではない。何れの非安全関連部Yからのリクエストコマンドかによってシーン番号が個別となる構成としてもよい。例えば、コントロールデバイス=ティーチングコマンドである場合のリクエストコマンドではシーン番号=1~9、コントロールデバイス=パックスクリプトである場合のリクエストコマンドではシーン番号=11~19、コントロールデバイス=IOである場合のリクエストコマンドではシーン番号=21~29としてもよい。
 ・上記各実施形態に示した安全関連部Xには動作監視用パラメータの判定基準をシーン番号に対応付けて予め記憶されており、非安全関連部Yにより指定されたシーン番号から各判定基準を特定する構成としたが、これに限定されるものではない。非安全関連部Yは、作業シーンのシーン番号に代えて各判定基準を個別に示す情報を安全関連部Xに送る構成としてもよい。
 なお、判定基準については安全関連部Xに予め記憶されている構成に代えて、非安全関連部Yから判定基準を示す値を安全関連部Xに送る構成とすることも可能である。
 ・上記各実施形態では、工場10の加工ラインにロボット20を適用した場合について例示したが、ロボット20の適用については加工ラインに限定されるものではない。ロボット20を組立ライン、検査ライン、梱包ラインに適用することも可能である。また、ロボット20の移動範囲については1のラインに限定されるものではなく、複数のラインに亘って移動する構成、例えば各ラインにて個別の作業に従事する構成とすることも可能である。
 ・上記各実施形態では、第1診断用情報、第2診断用情報等の診断用情報がCRCであるものとして例示したが、診断用情報は、これに限定されない。例えば、診断用情報は、CRC以外の誤り検出符号を含んでもよい。誤り検出符号としては、特に限定されないが、例えば、パリティ符号、チェックサム、巡回符号等のブロック符号、ハッシュ等の誤り検出、ブロック符号、畳み込み符号等の誤り訂正が挙げられる。また、診断用情報は、ロボット20の手先の位置情報を含んでもよい。
 <7.上記実施形態から抽出される発明群について>
 以下、上記実施形態から抽出される発明群の特徴について、必要に応じて効果等を示しつつ説明する。なお以下においては、理解の容易のため、上記実施形態において対応する構成を括弧書き等で適宜示すが、この括弧書き等で示した具体的構成に限定されるものではない。
 <特徴A群> 非安全関連部からの安全機能の切替
 以下の特徴A群は、ロボットの安全機能に対する信頼性の向上をしつつ、安全機能変更を容易に可能とするという課題等に鑑みてなされたものである。
 特徴A1.作業中のロボットの安全機能を実現する安全関連部と、非安全関連部と、を有し、
 安全関連部は、作業中の前記ロボットの力及び速さの少なくとも何れかに相関のあるパラメータを含んだ安全関連入力信号及び予め記憶されている当該パラメータ用の判定基準に基づいて前記ロボットの動きの判定を行う動作判定部を有し、当該動作判定部の判定結果に応じて安全関連出力信号を生成することにより前記安全機能を実現し、
 前記非安全関連部は、指令情報と第1診断用情報とを含む情報群を前記安全関連部に送ることにより、当該安全関連部に前記判定基準の切り替えの指示を行い、ここで、前記指令情報は、前記動作判定部による判定にて参照すべき判定基準を示す情報とを含み、
 前記安全関連部は、前記非安全関連部から前記指示を受けた場合に、前記指示が正常に届いたかを前記第1診断用情報に基づいて診断し、前記指示自体が正常であるかを前記指令情報に基づいて診断し、前記指示が正常に届いており且つ前記指示自体が正常であると診断した場合に、前記指示を受理して前記判定にて参照する判定基準を前記指令情報に応じて切り替え、前記非安全関連部からの指示を受理した旨を前記非安全関連部に報知し、
 前非安全関連部は、前記安全関連部により前記指示を受理した旨が報知された場合に、前記安全関連部に対して、当該指示に基づく切り替えにより参照対象として設定された前記判定基準を特定可能な特定用情報を要求し、
 前記安全関連部は、前記特定用情報と第2診断用情報とからなる情報群を前記非安全関連部に送ることにより、前記非安全関連部の要求に応答し、
 前記非安全関連部は、前記安全関連部から前記応答を受けた場合に、前記応答が正常に届いたかを前記第2診断用情報に基づいて診断し、実際に設定されている前記判定基準が前記指示により指定した前記判定基準となっているかを診断する、ロボット制御システム。
 安全機能(判定基準)を切り替える場合には、先ず非安全関連部から安全関連部に切り替えの指示がなされる。この指示は指令情報及び第1診断用情報を含む。安全関連部では第1診断用情報に基づいて指示が正常に届いたかが診断され、指令情報に基づいて当該指示自体が正常であるかが診断される。診断で異常無しとなった場合には、非安全関連部からの指示に基づき、安全関連部では当該指示に従って参照対象となる判定基準を切り替える。つまり、非安全関連部からの指示であっても、当該指示に送信エラー等による異常が無いと判断した場合には、判定基準の切り替えがなされる。このようにして、非安全関連部からの安全な切替を実現すれば、ロボット制御システムにおける安全機能の変更に係る操作性を好適に向上させることができる。すなわち、非安全関連部からの指示を正常に受理した場合でなければ安全関連部における安全機能が変更されないことで安全制御の確実性を担保しつつ、非安全関連部からの操作による設定変更を可能とすることでユーザ利便性を考慮した操作設定を実現して操作手段の設定自由度を向上させることができる。
 次に、安全関連部から非安全関連部へ指示を受理した旨が報知され、当該報知を受けた非安全関連部は安全関連部に対して現在参照対象となっている判定基準(切替後の判定基準)を特定可能な特定用情報を要求する。安全関連部ではこれに応答して、特定用情報と第2診断用情報とからなる情報群を非安全関連部に送る。非安全関連部は、安全関連部からの応答が正常に届いたかを第2診断用情報に基づいて診断し、実際に設定されている判定基準が当初の指示により指定した判定基準となっているかを診断する。つまり、非安全関連部では、自身の指示によって安全関連部における安全機能の切替が正常に行われたかを確認可能となっている。
 さらには、第1の手段に示す構成によれば、非安全関連部と安全関連部との間で安全機能の切り替えを挟んで2往復の通信が行われ、1往復の通信が行われるたびに、安全関連部または非安全関連部により第1診断用情報または第2診断用情報を用いて正常な通信が行われたかが確認される。正常な通信が行われたことは、安全関連部および非安全関連部が正常に動作する可能性が高いことを示している。したがって、2度の通信の正常性の確認により、極めて高い確率で安全関連部および非安全関連部の双方が正常に動作していることが確認できる。さらには、非安全関連部と安全関連部との間で安全機能の切り替えを挟んで2往復の通信が行われることにより、安全機能の切り替え中に非安全関連部および安全関連部が正常に動作していたことが担保される。
 本特徴に示す構成によれば、非安全関連部から安全関連部の安全機能を切り替える場合であっても、安全機能の変更に対する信頼性の低下を抑制し、安全機能を変更するための入力についても安全関連入力部からの入力(所謂安全入力)とする場合と比較して当該変更に係る制約が強くなることを回避できる。これにより、安全機能変更の操作性を好適に向上させることができる。
 因みに、例えば1のロボットを様々な作業に従事させる場合、作業に応じて安全機能を変更(操作)可能とすることは、安全性に配慮しつつロボットの作業効率の向上を図る上で有利となる。本特徴に示すように、非安全関連部からの安全機能の切り替えを可能とすることは、複数種類の作業へのロボットの適用を促し、工場の自動化を推進する上でも好ましい。
 なお、本特徴に示す「ロボットの力、速さ及び位置」については、ロボットのツールセンタポイントにおける力、速さ及び位置だけではなく、ロボットの各軸の力(回転トルク)、速さ(回転速度)、位置も含む。
 特徴A2.前記安全関連部は、前記指令情報の種類を記憶する記憶装置を有し、
 前記安全関連部は、当該安全関連部における前記診断において、前記指令情報が前記記憶装置に記憶されている前記種類に含まれているかを確認する特徴A1に記載のロボット制御システム。
 本特徴に示すように、安全関連部では予め記憶されている指令情報の種類と今回の指令情報とを照合することにより非安全関連部からの指示(指令情報)自体が正常であるかを診断する構成とすれば、ビットの固着や通信エラー等によって指令情報が損傷した場合に、当該損傷した指令情報に基づいて安全機能が切り替わってしまうことを好適に抑制できる。
 特徴A3.前記非安全関連部を複数備え、
 前記指令情報は、何れの前記非安全関連部からの情報であるかを特定可能な第1情報と、参照対象とすべき前記判定基準の候補を指定する第2情報とを含み、
 前記記憶装置には、前記第1情報と前記第2情報との組み合わせが記憶されており、
 前記安全関連部は、前記診断において、前記第1情報と前記第2情報との組み合わせが前記記憶装置に記憶されているかを確認する特徴A2に記載のロボット制御システム。
 ビットの固着や通信エラー等によって指令情報が損傷した場合に、偶発的に他の非安全関連部からの指令情報と一致することを簡易に抑制できる。なお、第1情報及び第2情報の組み合わせによって指令情報を構築した場合、両情報が同時に損傷する可能性は低いため、偶発的に他の指示と一致してしまうといった不都合を生じにくくすることができる。
 特徴A4.前記第1診断用情報は、前記指令情報に基づいて決定され、
 前記安全関連部は、前記第1診断用情報と前記指令情報とを対比することにより、前記指示が正常に届いたかを診断する特徴A1乃至特徴A3のいずれか1つに記載のロボット制御システム。
 本特徴に示す構成によれば、第1診断用情報(値)は指令情報に応じて決まる(変化する)。指令情報及び第1診断用情報の少なくとも一方が損傷した場合には、両者の関係が崩れることとなり、診断によって指示に異常が生じていることを特定可能となる。このような構成とすることで、非安全関連部からの指示(損傷あり)によって誤った切り替えがなされることを好適に抑制できる。
 また、指令情報に第1診断用情報を付加した場合には、指令情報単独の場合と比較して、情報量が増える。つまり、指令情報及び第1診断用情報からなる信号が長くなり、正常/異常の診断で確認すべき情報が多くなることで診断結果の妥当性が向上する。これにより、非安全関連部からの入力による安全機能の切り替え(変更)に対する信頼性を飛躍的に向上させることができる。
 特徴A5.前記第2診断用情報は、前記複数の判定基準のうち前記動作判定部による判定にて参照する判定基準に応じて異なる特徴A1乃至特徴A4のいずれか1つに記載のロボット制御システム。
 安全関連部への応答によって当該安全関連部に送られる特定用情報には第2診断用情報が付随する。この第2診断用情報については安全関連部の動作判定部にて参照される判定基準に応じて異なる(可変値)。つまり、第2診断用情報から通信異常の確認だけでなく特定用情報が正常であるかの確認についても可能となり、応答の確からしさを簡易な構成によって向上させることができる。
 特徴A6.前記第2診断用情報は、前記特定用情報に基づいて決定され、
 前記非安全関連部は、前記第2診断用情報と前記特定用情報とを対比することにより、前記応答が正常に届いたかを診断する特徴A1乃至特徴A5のいずれか1つに記載のロボット制御システム。
 本特徴に示す構成によれば、第2診断用情報(値)は特定用情報に応じて決まる(変化する)。特定用情報及び第2診断用情報の少なくとも一方が損傷した場合には、両者の関係が崩れることとなり、診断によって応答に異常が生じていることを特定可能となる。このような構成とすることで、ロボット制御システムの信頼性の更なる向上に寄与できる。
 また、特定用情報に第2診断用情報を付加した場合には、特定用情報単独の場合と比較して、情報量が増える。つまり、特定用情報及び第2診断用情報からなる信号が長くなり、正常/異常の診断で確認すべき情報が多くなることで診断結果の妥当性が向上する。
 特徴A7.前記第2診断用情報は、前記第1診断用情報と不一致となるようにして作成される特徴A1乃至特徴A6のいずれか1つに記載のロボット制御システム。
 本特徴に示す構成によれば、安全機能の切り替えに際しては基本的に第1診断用情報と第2診断用情報とが不一致となる。ここで、ビット固着等の偶発的なエラーによって第2診断用情報として第1診断用情報がそのまま送り返された場合には、第1診断用情報と第2診断用情報とが一致することとなり、上記エラーを速やかに発見できる。
 特徴A8.前記指令情報及び前記特定用情報は何れも、前記複数の判定基準のうち前記動作判定部による参照対象となる判定基準を示す情報と、それら指令情報及び特定用情報の送り主を示す情報とを含み、
 前記第1診断用情報は、当該指示に含まれる前記指令情報に基づいて決定され、前記第2診断用情報は、当該応答に含まれる前記特定用情報に基づいて決定される特徴A1乃至特徴A7のいずれか1つに記載のロボット制御システム。
 非安全関連部からの指示に含まれる第1診断用情報と安全関連部からの応答に含まれる第2診断用情報とは、送り主を示す情報を含む指令情報及び特定用情報に基づいて各々決定される。つまり、安全機能の切り替えに際しては基本的に第1診断用情報と第2診断用情報とが不一致となる。ここで、ビット固着等の偶発的なエラーによって第2診断用情報として第1診断用情報がそのまま送り返された場合には、第1診断用情報と第2診断用情報とが一致することとなり、上記エラーの見逃しを速やかに発見できる。
 特徴A9.前記判定基準は、前記力のパラメータ用の力基準と、前記速さのパラメータ用の速さ基準とを含み、それら力基準と速さ基準とが各々複数規定されており、
 前記安全関連部には、前記動作判定部による判定にて参照すべき前記力基準と前記速さ基準との組み合わせを示す組合せ情報(シーン番号)が記憶されており、
 前記指令情報は、前記組合せ情報に相関のある情報(シーン番号)となるように構成されている特徴A1乃至特徴A8のいずれか1つに記載のロボット制御システム。
 特徴A8に示すように、複数種類の判定基準(力基準、速さ基準)について切り替えを行う場合には、各判定基準を個別に指定するのではなく、予め規定されたそれら基準の組み合わせを指定することにより、非安全関連部から安全関連部への指示が複雑になることを抑制できる。これは、安全機能に配慮しつつロボットが従事可能な作業の数が増やす上で好ましい構成である。
 <特徴B群> 作業状況毎に安全機能を切替
 以下の特徴B群は、ロボットの安全性及び作業効率を好適に向上させるロボット制御システムを提供するという背景・課題等に鑑みてなされたものである。
 特徴B1.作業中のロボットの力及び速さの少なくとも何れかに相関のあるパラメータを含んだ安全関連入力信号及び予め記憶されている当該パラメータ用の判定基準に基づいて前記ロボットの動きを判定する動作判定部を有し、その判定結果に応じて安全関連出力信号を生成することにより当該ロボットの安全機能を実現する安全関連部と、
 予め設定された前記ロボットが作業を行う複数の作業状況の中から、作業中の前記ロボットの作業状況を識別する状況識別部と、
 前記動作判定部により参照される前記パラメータ用の判定基準を、前記状況識別部により識別された前記作業状況に対応する判定基準に切り替える判定基準切替部と、
を備えているロボット制御システム。 
 1のロボットが異なる複数の作業を担うことは、製造等の自動化を促進する上で好ましい。但し、作業シーンに関わらずロボットの安全機能を画一的とした場合には、安全性の向上と作業効率の向上との両立が難しくなる。この点、本特徴に示す構成では、作業シーンを識別して、作業状況毎に監視用の判定基準が変更される。これにより、ロボットの安全性の向上と作業効率の向上とに寄与できる。
 ここで、ロボットの安全性を向上させる上では、ロボットの動作状態(位置、向き、速さ等)が変わる毎に安全機能を逐次変化させる構成とすることも可能である。しかしながら、このような構成とした場合には、ロボット制御システムにおける制御負荷が大きくなり、ロボット制御システム本来の機能(ロボットの駆動制御)に影響が及ぶこととなる。この点、ロボットの動きが作業毎に変わる点に鑑みれば、本特徴に示すように作業シーン毎に判定基準を切り替える構成とすることにはロボット制御システムの本来の機能への影響を抑えつつ、安全性を向上できるという明確な技術的意義がある。
 特徴B2.前記作業状況は、前記ロボットが実行する作業シーンであり、
 前記状況識別部は、前記ロボットの前記作業シーンを識別するシーン識別部である、特徴B1に記載のロボット制御システム。
 本特徴に示すように作業状況として作業シーンを識別することにより、より容易にロボットの作業シーンを識別することができ、より確実にロボットの安全性の向上と作業効率の向上とに寄与できる。
 特徴B3.設定されている動作プログラムに従って前記ロボットの駆動制御を行う駆動制御部(制御装置50の駆動制御部51)を備え、
 前記シーン識別部は、実行中の前記動作プログラムに含まれるシーン関連情報に基づいて前記作業シーンを識別する特徴B2に記載のロボット制御システム。
 本特徴に示すように動作プログラムに含まれるシーン関連情報に基づいて作業シーンを識別可能とすれば、ロボット制御システムが自身の速やかな判断によって作業シーン毎の判定基準を選択する構成を実現できる。これにより、安全機能の切替に大きな待ち時間が発生することを抑制し、作業効率向上に寄与できる。
 特徴B4.前記作業状況は、前記ロボットが実行する作業毎に規定される作業エリアであり、
 前記状況識別部は、前記ロボットの作業エリアを識別するエリア識別部である、特徴B1に記載のロボット制御システム。
 1のロボットが複数の作業を担うことは、製造等の自動化を促進する上で好ましい。但し、作業エリア関わらずロボットの安全機能を画一的とした場合には、安全性の向上と作業効率の向上との両立が難しくなる。この点、本特徴に示す構成では、作業エリアを識別して、作業エリア毎に監視用の判定基準が変更される。これにより、ロボットの安全性の向上と作業効率の向上とに寄与できる。また、このような構成とすれば、安全機能をロボットの位置や向きの変化に応じて逐次変化させる構成と比較して、ロボット制御システムの本来の機能への影響を抑えつつ、安全性を向上できるという明確な技術的意義がある。
 特徴B5. さらに、設定されている動作プログラムに従って前記ロボットが所定のタイムスケジュールで動作するように前記ロボットを制御する駆動制御部を含み、
 前記所定のタイムスケジュールは、時間又は時刻に応じて複数種の作業が順に実行されるように規定さており、
 前記作業状況は、前記時間又は前記時刻であり、
 前記状況識別部は、現時点での前記時間又は前記時刻を把握する把握部であり、
 前記判定基準切替部は、前記把握部により把握された前記時間又は前記時刻が前記所定のタイムスケジュールにて次の作業に移る所定の時間又は所定の時刻となった場合に、前記動作判定部により参照される前記パラメータ用の判定基準を、前記所定の時間又は前記所定の時刻に対応する判定基準に切り替える、特徴B1に記載のロボット制御システム。
 1のロボットが複数の作業を担うことは、製造等の自動化を促進する上で好ましい。但し、タイムスケジュールに関わらずロボットの安全機能を画一的とした場合には、安全性の向上と作業効率の向上との両立が難しくなる。この点、本特徴に示す構成では、現時点での時間(例えば、作業ルーティーン開始からの経過時間)又は時刻を把握して、所定の時間又は所定の時刻となった場合に監視用の判定基準が変更される。これにより、ロボットの安全性の向上と作業効率の向上とに寄与できる。 
 特徴B6.前記作業状況は、前記ロボットと人とが協働する協働状況(例えばシーンSN3)と、前記ロボットと人とが協働しない非協働状況(例えばシーンSN4,SN5)とを含み、
 前記判定基準切替部は、前記協働状況における前記判定基準と前記非協働状況における前記判定基準とを相違させるようにして前記切り替えを行う特徴B1乃至特徴B5のいずれか1つに記載のロボット制御システム。
 本特徴に示すようにロボットの作業状況が協働状況と非協働状況とを含んでいる場合には、それらの状況に応じて判定基準を相違させることでロボットの安全性と作業効率とを好適に向上させることができる。
 特徴B7.前記状況識別部は、次の作業状況を識別可能となっており、
 前記判定基準切替部は、先の作業状況と後の作業状況との間で、前記切り替えを行う特徴B1乃至特徴B6のいずれか1つに記載のロボット制御システム。
 先の作業状況完了から後の作業状況へ移行となる場合には、その間で切り替えを行うことで作業中に切り替えを行う構成と比較して、システムにおける制御負荷を好適に分散させることができる。また、次の作業状況に移る場合には、状況が変化することで、人等との距離が変化する可能性が高い。そこで、本特徴に示すように、次の状況に備えて切り替えを行う構成とすることは、ロボットの安全性の向上を図る上でも好ましい。
 特徴B8.前記動作判定部による判定結果が前記判定基準を超過しているとする判定結果となった場合に前記ロボットを緊急停止させる構成となっており、
 前記作業状況の切り替わりに伴って前記判定基準が引き下げとなった場合には、前記動作判定部による判定結果が前記判定基準を超過しているとする判定結果となったとしても前記ロボットを緊急停止させず、当該引き下げ後の所定の猶予期間において前記ロボットを停止させることなく前記パラメータを強制的に引き下げるように前記ロボットの動きを抑制し、
 前記所定の猶予期間においては、前記パラメータの減少傾向に基づいて前記ロボットを停止させるかを判定する特徴B1乃至特徴B7のいずれか1つに記載のロボット制御システム。
 本特徴に示す構成によれば、作業状況の切替時に判定基準が引き下げとなったとしても即座にロボットが停止(非常停止)とならない。つまり、判定基準の引き下げが原因となって突如としてロボットが停止することがない。そして、このような状況となった場合は、所定の猶予期間中のパラメータの減少傾向に基づいてロボットを停止させるかが判定される。このような構成とすることにより、作業シーンの切替に伴って安全機能(判定基準)を変更する構成であっても、ロボットの誤停止が生じる機会を減らすことができる。このようにして、ロボットの誤停止を抑制することは、ロボット20による生産効率の向上等を実現する上で好ましい。
 なお、例えば所定の猶予期間中のパラメータの変化の目標を定め、当該所定の猶予期間中にパラメータの変化を確認し、当該変化が目標に達していない場合にはロボットを停止させる構成とするとよい。
 特徴B9.前記動作判定部による判定結果が前記判定基準を超過しているとする判定結果となった場合に前記ロボットを緊急停止させる構成となっており、
 前記作業状況への切り替わりと当該次の作業状況となった場合に設定される前記判定基準とを当該切り替わりよりも前に特定し、
 前記次の作業状況への切り替わりの前の所定の期間中に当該次の作業状況にて設定される前記判定基準に対する超過が生じている場合に、前記次の作業状況への切り替わりまでに当該超過が解消されるようにして前記パラメータを強制的に引き下げるべく前記ロボットの動きを抑制する特徴B1乃至特徴B7のいずれか1つに記載のロボット制御システム。
 本特徴に示す構成によれば、作業状況の切り替わりを事前に特定(推定又は確認)し、次の作業状況における判定基準を超過していることを切り替わり前の所定の期間中に事前に確認できた場合には、パラメータを強制的に引き下げるべくロボットの動きが抑制される。これにより、切り替わりのタイミングにて判定基準の超過が抑制されることとなる。このような構成とすることにより、作業状況の切替に伴って安全機能(判定基準)を変更する構成であっても、ロボットの誤停止が生じる機会を減らすことができる。このようにして、ロボットの誤停止を抑制することは、ロボット20による生産効率の向上等を実現する上で好ましい。
 特徴B10.前記判定基準切替部による前記判定基準の切り替えは、実行中の1の作業が完了するまで不可となる特徴B1乃至特徴B9のいずれか1つに記載のロボット制御システム。
 特徴B1等に示したように判定基準を切替可能とすることはロボットの安全性に配慮しつつロボットの作業性を向上させる上で好ましい。しかしながら、このような切替機能を具備した場合には、以下の新たな懸念が生じる。すなわち、仮に偶発的な理由等で1の作業中に突如として判定基準の切り替えが発生すると、本来であれば問題のない動きが監視に引っかかるといった事象が発生し得る。これは、ロボットの非常停止等の機会を不要に増やして作業効率を低下させる要因となる。そこで、本特徴に示すように、実行中の1の作業が完了するまで判定基準切替部による切り替えを不可とし(例えば禁止し)、上記事象の発生を抑えることにより実用上好ましい構成が実現できる。
 特徴B11.設定されている動作プログラムに従って前記ロボットの駆動制御を行う駆動制御部を備え、
 前記動作プログラムでは前記作業状況における前記ロボットの動きが複数のタスクの組み合わせによって規定されており、
 前記駆動制御部は、現在の前記作業状況における前記複数のタスクが全て完了したタイミングで前記作業状況を切り替える特徴B1乃至特徴B9のいずれか1つに記載のロボット制御システム。
 上記特徴のように、現在の作業状況におけるタスクがすべて完了したタイミングで、駆動制御部が作業状況を切り替えることにより、タスクの途中でロボットの動きが突如変更されることが防止され、ロボットの安全性をより確実に確保できる。
 特徴B12.前記パラメータとして、作業中のロボットの位置を示すパラメータを含み、
 前記判定基準切替部により、前記力又は前記速さの少なくとも何れかのパラメータ用の判定基準を切り替える場合には、それに併せて、前記位置を示すパラメータ用の判定基準についても切替可能となっている特徴B1乃至特徴B9のいずれか1つに記載のロボット制御システム。
 位置監視機能を追加し、位置を示すパラメータの判定基準についても力や速さを示すパラメータの判定基準とともに切替可能とすることで、ロボットの力や速さの監視が過度にシビアになることを抑制できる。これは、ロボットの作業効率を向上させる上で好ましい。
 10…工場、20…ロボット、31…AGV、35…走行モータ、41…ロボットアーム、45…駆動モータ、46…ロータリエンコーダ、47…トルクセンサ、50…制御装置、51…駆動制御部、52…監視制御部、60…ティーチングペンダント、E1…ストックエリア、E2…加工エリア、E3…集積エリア、E4…通路、CS…ロボット制御システム、X…安全関連部、X1…入力部、X2…論理部、X3…出力部、Y…非安全関連部。

Claims (12)

  1.  作業中のロボットの力及び速さの少なくとも何れかに相関のあるパラメータを含む安全関連入力信号及び予め記憶されている当該パラメータ用の判定基準に基づいて前記ロボットの動きを判定する動作判定部を有し、その判定結果に応じて安全関連出力信号を生成することにより当該ロボットの安全機能を実現する安全関連部と、
     予め設定された前記ロボットが作業を行う複数の作業状況の中から、作業中の前記ロボットの作業状況を識別する状況識別部と、
     前記動作判定部により参照される前記パラメータ用の判定基準を、前記状況識別部により識別された前記作業状況に対応する判定基準に切り替える判定基準切替部と、
    を備えているロボット制御システム。
  2.  前記作業状況は、前記ロボットが実行する作業シーンであり、
     前記状況識別部は、前記ロボットの前記作業シーンを識別するシーン識別部である、請求項1に記載のロボット制御システム。
  3.  設定されている動作プログラムに従って前記ロボットの駆動制御を行う駆動制御部を備え、
     前記シーン識別部は、実行中の前記動作プログラムに含まれるシーン関連情報に基づいて前記作業シーンを識別する請求項2に記載のロボット制御システム。
  4.  前記作業状況は、前記ロボットが実行する作業毎に規定される作業エリアであり、
     前記状況識別部は、前記ロボットの作業エリアを識別するエリア識別部である、請求項1に記載のロボット制御システム。
  5.  さらに、設定されている動作プログラムに従って前記ロボットが所定のタイムスケジュールで動作するように前記ロボットを制御する駆動制御部を含み、
     前記所定のタイムスケジュールは、時間又は時刻に応じて複数種の作業が順に実行されるように規定さており、
     前記作業状況は、前記時間又は前記時刻であり、
     前記状況識別部は、現時点での前記時間又は前記時刻を把握する把握部であり、
     前記判定基準切替部は、前記把握部により把握された前記時間又は前記時刻が前記所定のタイムスケジュールにて次の作業に移る所定の時間又は所定の時刻となった場合に、前記動作判定部により参照される前記パラメータ用の判定基準を、前記所定の時間又は前記所定の時刻に対応する判定基準に切り替える、請求項1に記載のロボット制御システム。
  6.  前記作業状況は、前記ロボットと人とが協働する協働状況と、前記ロボットと人とが協働しない非協働状況とを含み、
     前記判定基準切替部は、前記協働状況における前記判定基準と前記非協働状況における前記判定基準とを相違させるようにして前記切り替えを行う請求項1に記載のロボット制御システム。
  7.  前記状況識別部は、次の作業状況を識別可能となっており、
     前記判定基準切替部は、先の作業状況と後の作業状況との間で、前記切り替えを行う請求項1に記載のロボット制御システム。
  8.  前記動作判定部による判定結果が前記判定基準を超過しているとする判定結果となった場合に前記ロボットを緊急停止させる構成となっており、
     前記作業状況の切り替わりに伴って前記判定基準が引き下げとなった場合には、前記動作判定部による判定結果が前記判定基準を超過しているとする判定結果となったとしても前記ロボットを緊急停止させず、当該引き下げ後の所定の猶予期間において前記ロボットを停止させることなく前記パラメータを強制的に引き下げるように前記ロボットの動きを抑制し、
     前記所定の猶予期間においては、前記パラメータの減少傾向に基づいて前記ロボットを停止させるかを判定する請求項1に記載のロボット制御システム。
  9.  前記動作判定部による判定結果が前記判定基準を超過しているとする判定結果となった場合に前記ロボットを緊急停止させる構成となっており、
     前記作業状況への切り替わりと当該次の作業状況となった場合に設定される前記判定基準とを当該切り替わりよりも前に特定し、
     前記次の作業状況への切り替わりの前の所定の期間中に当該次の作業状況にて設定される前記判定基準に対する超過が生じている場合に、前記次の作業状況への切り替わりまでに当該超過が解消されるようにして前記パラメータを強制的に引き下げるべく前記ロボットの動きを抑制する請求項1に記載のロボット制御システム。
  10.  前記判定基準切替部による前記判定基準の切り替えは、実行中の1の作業が完了するまで不可となる請求項1に記載のロボット制御システム。
  11.  設定されている動作プログラムに従って前記ロボットの駆動制御を行う駆動制御部を備え、
     前記動作プログラムでは前記作業状況における前記ロボットの動きが複数のタスクの組み合わせによって規定されており、
     前記駆動制御部は、現在の前記作業状況における前記複数のタスクが全て完了したタイミングで前記作業状況を切り替える請求項1に記載のロボット制御システム。
  12.  前記パラメータとして、作業中のロボットの位置を示すパラメータを含み、
     前記判定基準切替部により、前記力又は前記速さの少なくとも何れかのパラメータ用の判定基準を切り替える場合には、それに併せて、前記位置を示すパラメータ用の判定基準についても切替可能となっている請求項1に記載のロボット制御システム。
PCT/JP2022/033899 2021-09-10 2022-09-09 ロボット制御システム WO2023038120A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021-148199 2021-09-10
JP2021148199A JP2023040965A (ja) 2021-09-10 2021-09-10 ロボット制御システム

Publications (1)

Publication Number Publication Date
WO2023038120A1 true WO2023038120A1 (ja) 2023-03-16

Family

ID=85506451

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/033899 WO2023038120A1 (ja) 2021-09-10 2022-09-09 ロボット制御システム

Country Status (2)

Country Link
JP (1) JP2023040965A (ja)
WO (1) WO2023038120A1 (ja)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001037289A (ja) 1999-05-20 2001-02-09 Yaskawa Electric Corp サーボモータおよび多関節ロボットの異常負荷検出制御方法
JP2016209953A (ja) * 2015-05-08 2016-12-15 株式会社デンソーウェーブ ロボットの安全装置
JP2017077608A (ja) * 2015-10-21 2017-04-27 ファナック株式会社 ロボットの安全監視装置
WO2017094240A1 (ja) * 2015-12-01 2017-06-08 川崎重工業株式会社 ロボットシステムの監視装置
JP2017205858A (ja) * 2016-05-16 2017-11-24 セイコーエプソン株式会社 ロボット、制御装置およびロボットシステム
JP2021094645A (ja) * 2019-12-17 2021-06-24 株式会社安川電機 生産システム、生産方法、及びプログラム
JP2021109294A (ja) * 2020-01-15 2021-08-02 セイコーエプソン株式会社 ロボットの制御方法、及び、ロボットシステム

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001037289A (ja) 1999-05-20 2001-02-09 Yaskawa Electric Corp サーボモータおよび多関節ロボットの異常負荷検出制御方法
JP2016209953A (ja) * 2015-05-08 2016-12-15 株式会社デンソーウェーブ ロボットの安全装置
JP2017077608A (ja) * 2015-10-21 2017-04-27 ファナック株式会社 ロボットの安全監視装置
WO2017094240A1 (ja) * 2015-12-01 2017-06-08 川崎重工業株式会社 ロボットシステムの監視装置
JP2017205858A (ja) * 2016-05-16 2017-11-24 セイコーエプソン株式会社 ロボット、制御装置およびロボットシステム
JP2021094645A (ja) * 2019-12-17 2021-06-24 株式会社安川電機 生産システム、生産方法、及びプログラム
JP2021109294A (ja) * 2020-01-15 2021-08-02 セイコーエプソン株式会社 ロボットの制御方法、及び、ロボットシステム

Also Published As

Publication number Publication date
JP2023040965A (ja) 2023-03-23

Similar Documents

Publication Publication Date Title
JP5218524B2 (ja) ロボットシステムおよびロボット動作規制方法
JP6591818B2 (ja) 産業用ロボットシステムおよびその制御方法
US9254567B2 (en) System for commanding a robot
TWI603827B (zh) Robot system
US10525592B2 (en) Robot system
EP2783798B1 (en) Robot system and method for controlling robot system
CN109313735B (zh) 集装箱装卸设备控制器布置
US9317032B2 (en) Robot and method for operating a robot
JPWO2017033352A1 (ja) 産業用遠隔操作ロボットシステム
CN112192617B (zh) 多桁架传输系统的防碰撞控制方法和多桁架传输系统
US8897912B2 (en) Loading and unloading apparatus and method
JPWO2013175553A1 (ja) ロボット
JP6316909B1 (ja) 協働動作領域を有するロボットシステム
AU2015411123A1 (en) Movement control device for movable device, movement control system, and movement control method for movable device
WO2023038120A1 (ja) ロボット制御システム
WO2023038119A1 (ja) ロボット制御システム
WO2020045483A1 (ja) ロボット制御装置
CN118043180A (en) Robot control system
JP2019522605A (ja) コンテナ取り扱い機器のための通信アレンジメントおよび通信方法
KR102564800B1 (ko) 산업용 로봇의 제어 장치
JP2023162742A (ja) 産業用ロボットシステム
JP2024057965A (ja) ロボット制御システム
JP2024006163A (ja) シミュレーション装置及びシミュレーションプログラム
JP2024006162A (ja) 設定支援装置、設定支援プログラム、安全関連パラメータ群の表示方法
JP2024006161A (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: 22867441

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2022867441

Country of ref document: EP

ENP Entry into the national phase

Ref document number: 2022867441

Country of ref document: EP

Effective date: 20240410