WO2023139763A1 - 制御装置 - Google Patents
制御装置 Download PDFInfo
- Publication number
- WO2023139763A1 WO2023139763A1 PCT/JP2022/002257 JP2022002257W WO2023139763A1 WO 2023139763 A1 WO2023139763 A1 WO 2023139763A1 JP 2022002257 W JP2022002257 W JP 2022002257W WO 2023139763 A1 WO2023139763 A1 WO 2023139763A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- buffer motor
- speed
- unit
- emergency stop
- command
- Prior art date
Links
- 238000001514 detection method Methods 0.000 claims description 20
- 230000001133 acceleration Effects 0.000 claims description 14
- 230000001172 regenerating effect Effects 0.000 description 17
- 238000004364 calculation method Methods 0.000 description 10
- 238000010586 diagram Methods 0.000 description 8
- 230000002093 peripheral effect Effects 0.000 description 7
- 238000012423 maintenance Methods 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000002474 experimental method Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000010801 machine learning Methods 0.000 description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000001746 injection moulding Methods 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000000611 regression analysis Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
Definitions
- the present invention relates to a control device.
- a mechanism that uses the regenerated power of the motor to reduce power consumption For example, as shown in FIG. 5, a motor different from the driving motor of the industrial machine is previously driven at a predetermined speed (hereinafter referred to as base speed). Then, other motors are decelerated in accordance with the timing at which power is consumed in the industrial machine. Then, regenerative electric power is generated from other motors, and by using this, power consumption can be suppressed.
- Other motors installed for such purposes are referred to herein as buffer motors.
- the buffer motor accelerates and decelerates based on the base speed so as to reduce the peak power according to the operation of the drive motor.
- DBM dynamic brake module
- the DBM is a mechanism that causes rotational energy to be consumed by heat by short-circuiting terminals of a servomotor via a resistor.
- the motor can be quickly stopped without coasting during an emergency stop.
- the emergency stop is applied frequently, the DBM becomes hot and cannot be used. Therefore, in some cases, buffer motors that do not pose a serious danger even if they are not stopped quickly in an emergency are used without incorporating a DBM.
- FIG. 6 is a graph illustrating changes in speed, power consumption, and command speed of the buffer motor when the emergency stop is canceled while the buffer motor is coasting.
- an emergency stop is applied at time t1, and then the cause of the emergency stop is resolved and the emergency stop is canceled at time t2.
- the buffer motor is driven to maintain a predetermined base speed Vb.
- the control device solves the above problems by applying a torque limit value to the buffer motor that is within the permissible power consumption from the time the emergency stop is canceled until the base speed is restored.
- One aspect of the present disclosure is a control device that controls a buffer motor supplied with power from a common power source with a drive motor that drives an industrial machine, comprising: an emergency stop detection unit that detects an emergency stop state; a buffer motor command generation unit that outputs a command to return to a base speed that is a reference rotation speed for supplying power; a command speed maintaining unit for commanding the buffer motor command generation unit; a base speed reach determination unit for determining whether the buffer motor has reached a base speed; a torque limit command unit for commanding a torque limit of the buffer motor during returning to the base speed after the emergency stop detection unit detects the emergency stop until the base speed arrival determination unit determines that the buffer motor has reached the base speed; and a buffer motor control unit for controlling a torque in the buffer motor when returning to the base speed after canceling the emergency stop.
- FIG. 1 is a schematic hardware configuration diagram of a control device according to an embodiment of the present invention
- FIG. 3 is a block diagram showing schematic functions of a control device according to the first embodiment of the present invention
- FIG. 10 is a diagram illustrating speed detection delay
- FIG. 4 is a diagram for explaining how the control device according to the first embodiment reduces regenerative power and power consumption of a buffer motor when emergency stop is canceled
- FIG. 5 is a diagram for explaining reduction of power consumption peaks using regenerative power of a buffer motor
- 7 is a graph illustrating changes in speed, power consumption, and command speed of the buffer motor when an emergency stop is canceled while the buffer motor is coasting;
- FIG. 1 is a schematic hardware configuration diagram showing essential parts of a control device according to a first embodiment of the present invention.
- the control device 1 of the present invention can be implemented, for example, as a control device that controls industrial machines such as machine tools and robots based on control programs.
- the CPU 11 included in the control device 1 is a processor that controls the control device 1 as a whole.
- the CPU 11 reads a system program stored in the ROM 12 via the bus 22 and controls the entire control device 1 according to the system program.
- the RAM 13 temporarily stores calculation data, display data, various data input from the outside, and the like.
- the non-volatile memory 14 is composed of, for example, a memory backed up by a battery (not shown) or an SSD (Solid State Drive), and retains the stored state even when the control device 1 is powered off.
- the nonvolatile memory 14 stores data obtained from the industrial machine 2, control programs and data read from the external device 72 via the interface 15, control programs and data input via the input device 71, control programs and data obtained from other devices via the network 5, and the like.
- the control program and data stored in the nonvolatile memory 14 may be developed in the RAM 13 at the time of execution/use.
- Various system programs such as a well-known analysis program are pre-written in the ROM 12 .
- the interface 15 is an interface for connecting the CPU 11 of the control device 1 and an external device 72 such as a USB device. From the external device 72 side, for example, control programs and setting data used for controlling the industrial machine 2 are read. Control programs and setting data edited in the control device 1 can be stored in the external storage means via the external device 72 .
- a PLC (programmable logic controller) 16 executes a ladder program to output and control signals to the industrial machine 2 and peripheral devices of the industrial machine 2 (for example, a tool changer, an actuator such as a robot, and a plurality of sensors 3 such as a temperature sensor and a humidity sensor attached to the industrial machine 2) via an I/O unit 19. It also receives signals from various switches on an operation panel provided on the main body of the industrial machine 2 and signals from peripheral devices, and passes the signals to the CPU 11 after performing necessary signal processing.
- the interface 20 is an interface for connecting the CPU of the control device 1 and the wired or wireless network 5 .
- Other industrial machines 4 such as machine tools and electrical discharge machines, fog computers 6, cloud servers 7, and the like are connected to the network 5 to exchange data with the control device 1 .
- each data read into the memory, data obtained as a result of executing the program, etc. are output via the interface 17 and displayed.
- An input device 71 composed of a keyboard, a pointing device, etc., transfers commands, data, etc. based on operations by an operator to the CPU 11 via the interface 18 .
- the axis control circuit 30 for controlling the axes provided in the industrial machine 2 receives the axis movement command amount from the CPU 11 and outputs the axis command to the servo amplifier 40 .
- the servo amplifier 40 receives this command and drives the servo motor 50 that moves the axis of the machine tool.
- the axis servomotor 50 incorporates a position/velocity detector, and feeds back a position/velocity feedback signal from this position/velocity detector to the axis control circuit 30 to perform position/velocity feedback control.
- Only one axis control circuit 30, one servo amplifier 40, and one servo motor 50 are shown in the hardware configuration diagram of FIG.
- the axis control circuit 35 for controlling the buffer motor 55 receives a rotation command amount for the buffer motor 55 from the CPU 11 and outputs a command to drive the buffer motor 55 to the servo amplifier 45 .
- the servo amplifier 45 receives this command and drives the buffer motor 55 .
- the buffer motor 55 also incorporates a position/velocity detector, and feeds back a position/velocity feedback signal from this position/velocity detector to the axis control circuit 35 to perform position/velocity feedback control.
- the servo amplifiers 40 and 45 are supplied with power from the common power supply 9 via the power supply path 8 .
- FIG. 2 is a schematic block diagram showing the functions of the control device 1 according to the first embodiment of the present invention. Each function provided in the control device 1 according to the present embodiment is realized by the CPU 11 provided in the control device 1 shown in FIG.
- the control device 1 of the present embodiment includes a command generation unit 100, a control unit 110, a power consumption calculation unit 120, a power supply calculation unit 130, a buffer motor command generation unit 140, a buffer motor control unit 150, a motor speed identification unit 155, an emergency stop detection unit 160, a command speed maintenance unit 170, a base speed attainment determination unit 180, and a torque limit command unit 190.
- a control program 200 for controlling the operation of the industrial machine 2 is stored in advance in the RAM 13 to the nonvolatile memory 14 of the control device 1, and a setting storage section 210, which is an area for storing settings related to control of the buffer motor 55, is prepared in advance.
- the command generation unit 100 analyzes the blocks of the control program 200 and generates commands for controlling each part of the industrial machine 2 based on the analysis results. For example, when a block of the control program 200 commands to drive each axis of the industrial machine 2, the command generated by the command generation unit 100 generates a movement command for commanding movement of the servomotor 50 according to the command of the block. Further, for example, when a block of the control program 200 commands to control a peripheral device of the industrial machine 2, a command to operate the peripheral device is generated. A command generated by the command generation unit 100 is output to the control unit 110 .
- the command generating unit 100 temporarily stops generating commands related to the control of the industrial machine 2 when receiving notification of detection of an emergency stop from the emergency stop detecting unit 160 . Further, when receiving a notification of the detection of emergency stop cancellation from the emergency stop detection unit 160, it restarts the generation of the command related to the control of the industrial machine 2 that has been temporarily stopped.
- the control unit 110 is realized by executing a system program read from the ROM 12 by the CPU 11 of the control device 1 shown in FIG.
- the control unit 110 controls each part of the industrial machine 2 based on commands input from the command generation unit 100 .
- the control unit 110 when the command input from the command generation unit 100 commands movement of the servomotor 50 of the industrial machine 2, the control unit 110 generates movement command data according to the command and outputs it to the servomotor 50.
- the command input from the command generation unit 100 is a command to operate a peripheral device attached to the industrial machine 2, the control unit 110 generates a predetermined signal for operating the peripheral device and outputs it to the PLC 16.
- the control unit 110 acquires position feedback, speed feedback, and torque feedback of the servomotor 50 and data detected by peripheral devices such as a temperature sensor and a humidity sensor, and uses them for controlling the industrial machine 2 .
- the power consumption calculator 120 calculates the power consumed in driving the servomotor 50 that drives the industrial machine 2 based on the operating state and control details of the servomotor 50 that drives the industrial machine 2 by the controller 110 .
- the power consumed in driving the servo motor 50 can be calculated, for example, based on the output V d ⁇ T d of the servo motor 50 calculated based on the rotation speed V d and the torque T d of the servo motor 50, the loss L d generated in the servo motor 50, the servo amplifier 40, and the like.
- the loss Ld generated by the servomotor 50 and the servo amplifier 40 is sufficiently small compared to the output (absolute value) of the servomotor 50, so the power consumption may be calculated based on the output of the servomotor 50.
- the power consumption calculator 120 may calculate the power consumed in driving the servomotor 50 at the present point in time, for example, using speed feedback and torque feedback fed back from the servomotor 50 .
- a method for calculating power consumption is already known in, for example, Japanese Patent Application Laid-Open No. 2019-075864 and Japanese Patent Application Laid-Open No. 2019-092239, and therefore detailed description thereof will be omitted in this specification.
- the power supply calculator 130 calculates the amount of regenerative power to be supplied from the buffer motor 55 based on the amount of power consumed in driving the servo motor 50 calculated by the power consumption calculator 120 .
- the power supply calculation unit 130 calculates, for example, a value obtained by subtracting the power consumption calculated by the power consumption calculation unit 120 from the preset maximum available power of the common power supply 9 . If the calculated value falls below a predetermined threshold value Th d that has been set in advance, the amount of the lower value is calculated as the amount of regenerative electric power to be supplied from the buffer motor 55 .
- the threshold Th d may be set as a positive value with a predetermined margin for safety.
- the buffer motor command generation unit 140 When the buffer motor command generation unit 140 receives notification from the emergency stop detection unit 160 that the emergency stop has been canceled, it generates a command to control the speed of the buffer motor 55 so that it accelerates to the base speed Vb at the acceleration Ab. The command generated by the buffer motor command generator 140 is output to the buffer motor controller 150 .
- the buffer motor control unit 150 controls the buffer motor 55 .
- the buffer motor control unit 150 controls the buffer motor 55 so that the speed of the buffer motor 55 becomes the base speed Vb based on the base speed Vb of the buffer motor 55 and the acceleration Ab when accelerating the buffer motor to the base speed Vb, which are stored in advance in the setting storage unit 210.
- the buffer motor control unit 150 controls the buffer motor 55 to decelerate so that regenerative power corresponding to the amount of regenerative power to be supplied from the buffer motor 55 is generated. Conversely, when the amount of regenerative power to be supplied from the buffer motor 55 input from the supply power calculation unit 130 takes a negative value, the buffer motor control unit 150 controls acceleration of the buffer motor 55 so that power consumption corresponding to the amount of regenerative power to be supplied from the buffer motor 55 is generated.
- the buffer motor control unit 150 controls the buffer motor 55 based on the command generated by the buffer motor command generation unit 140 .
- the buffer motor control unit 150 may control the torque of the buffer motor 55 to be equal to or less than a predetermined threshold value Tth when the buffer motor 55 is accelerated when the emergency stop is cancelled.
- the predetermined threshold value T th is a torque value that does not consume a large amount of electric power when accelerating the buffer motor to the base speed Vb with the acceleration Ab.
- the predetermined threshold value T th may be obtained in advance by performing experiments or the like for each type of buffer motor. Further, when instructed to maintain the command speed from the command speed maintaining unit 170, the buffer motor control unit 150 corrects the command speed from the buffer motor command generation unit 140 in accordance with the maintenance command.
- the buffer motor control unit 150 limits the speed of the buffer motor 55 so that the torque value of the buffer motor 55 does not exceed the value commanded by the torque limit command.
- the buffer motor control unit 150 may monitor the torque value of the buffer motor and perform feedback control to reduce the speed when the torque value exceeds the value commanded by the torque limit command.
- the torque Ta generated during acceleration or deceleration may be calculated using the following formula (1), and the speed may be controlled so that the torque Ta can be suppressed to a value specified by the torque limit command or less.
- Equation 1 J0 is the moment of inertia of the rotor, JL is the moment of inertia of the full load, i is the speed reduction ratio, and a is the acceleration/deceleration.
- the motor speed identification unit 155 identifies the speed of the buffer motor 55 and outputs the identified speed of the buffer motor 55 to the buffer motor command generation unit 140 .
- the motor speed identification unit 155 may identify the speed of the buffer motor 55 based on an input from a sensor (not shown) that detects the speed of the buffer motor 55 .
- the speed of the buffer motor 55 it may be predicted from the past speed of the buffer motor 55 detected by a sensor. Similarly, the history of sensor detection of the speed of the buffer motor 55 may be stored, and the current speed of the buffer motor 55 may be predicted from the stored speed history. A certain amount of delay occurs between the detection of the speed of the motor by the sensor and the acquisition of the detected speed by the motor speed identification unit 155 .
- FIG. 3 is an example in which the speed of the buffer motor 55 and the speed of the buffer motor 55 detected by the sensor of the motor speed specifying unit 155 are shown on the same graph. In FIG. 3, the solid line represents the buffer motor 55 at that time. Also, the dotted line represents the speed of the buffer motor 55 acquired by the motor speed identification unit 155 at that time.
- the speed of the buffer motor 55 acquired by the motor speed identification unit 155 is a larger value than the actual speed of the buffer motor 55 at the same time. Therefore, if the speed of the buffer motor 55 acquired by the motor speed specifying unit 155 is used as the current speed of the buffer motor 55 when the emergency stop is canceled, sudden acceleration occurs immediately after the start of control, increasing power consumption. In order to avoid this, the motor speed specifying unit 155 calculates the past speed transition of the buffer motor 55 during the emergency stop of the buffer motor 55 acquired and the trend of change from the speed history, and predicts what value the speed of the buffer motor 55 will be after the delay time measured in advance by experiments or the like. Then, the predicted speed is output as the current speed of the buffer motor 55 .
- the current speed of the buffer motor 55 may be predicted based on the speed of the buffer motor 55 at the time when the emergency stop was applied and the time taken from the emergency stop to the present.
- the rate at which the motor slows down while it is coasting depends on parameters such as inertia and friction. Therefore, an experiment is performed in advance using the buffer motor 55, and the change in speed with respect to time after the emergency stop is plotted. Then, by performing regression analysis on the plotted data to create a regression equation, and using the created regression equation, the current speed of the buffer motor 55 may be predicted from the speed of the buffer motor 55 at the time when the emergency stop is applied and the time taken from the emergency stop to the present.
- the explanatory variables of the regression equation should be the speed of the buffer motor 55 at the start of the emergency stop and the time taken from the start of the emergency stop to the present time, and the current time should be used as the objective variable.
- machine learning using a neural network or the like as a model may be performed based on the plotted data, and the current speed of the buffer motor 55 may be predicted using the created model.
- the speed of the buffer motor 55 at the start of the emergency stop and the time taken from the start of the emergency stop to the present time should be used as the input data of the machine learning device, and the current time should be used as the objective variable for the output data (label data).
- Parameters such as inertia and friction of the buffer motor 55 may be used as explanatory variables of the regression equation and input data of the machine learning device.
- data such as temperature and humidity may be added. This is because temperature and humidity affect parameters such as friction.
- the emergency stop detection unit 160 detects an emergency stop and cancellation of the emergency stop of the industrial machine 2, and outputs the detection results to the command generation unit 100, the buffer motor command generation unit 140, the command speed maintenance unit 170, and the torque limit command unit 190.
- the emergency stop detection unit 160 may detect an emergency stop and cancellation of the emergency stop by detecting ON/OFF of the excitation state of the servo amplifiers 40 and 45, for example. Further, emergency stop and cancellation of emergency stop may be detected by detecting, for example, a change in the state of an emergency stop signal input from the outside or an operation state of an emergency stop button or an emergency stop release button by an operator.
- the command speed maintaining unit 170 acquires the speed of the buffer motor 55 at that time from the motor speed specifying unit 155 at the timing of the emergency stop. Then, during the period from when the emergency stop detection notification is input from the emergency stop detection part 160 until the speed of the buffer motor 55 returns to the base speed, the buffer motor control part 150 is commanded to maintain the command speed for the buffer motor 55 within the range from the emergency stop speed to the base speed.
- the command speed maintaining unit 170 may simply command to maintain the command speed at the base speed Vb.
- the base speed attainment determination unit 180 determines whether the buffer motor has reached the base speed Vb. Then, when it is determined that the base speed Vb has been reached, the torque limit command section 190 is notified to that effect.
- the torque limit command unit 190 commands the buffer motor control unit 150 to limit the torque of the buffer motor 55 based on the torque limit information stored in the setting storage unit 210 .
- the setting storage unit 210 stores in advance, for example, a torque limit value during the return of the buffer motor 55 to the base speed.
- the torque limit command unit 190 commands the buffer motor control unit 150 to limit the torque of the buffer motor 55 to the torque limit value during the period after the emergency stop detection unit 160 notifies that the emergency stop has been canceled until the base speed attainment determination unit 180 notifies that the buffer motor 55 has reached the base speed Vb.
- the torque limit value Tb during the return to the base speed can be calculated by the following equation (2) if the influence of iron loss and the like is ignored.
- Vb is the base speed of the buffer motor 55
- Wb is the allowable power consumption of the buffer motor 55.
- This allowable power consumption Wb may be, for example, a value obtained by subtracting the allowable power value of the servomotor 50 from the allowable power value allowed in the industrial machine 2, or may be a value obtained by subtracting the instantaneous value of the power generated by the servomotor 50 from the allowable power value allowed in the industrial machine 2.
- FIG. 4 is a graph illustrating changes in speed, power consumption, command speed, and torque limit value of the buffer motor 55 when the controller 1 according to the present embodiment controls the buffer motor 55 when the emergency stop is cancelled.
- an emergency stop occurs at time t1, the cause of the emergency stop is resolved, the emergency stop is canceled at time t2, and the buffer motor 55 returns to the base speed Vb at time t3.
- the buffer motor is driven to maintain a predetermined base speed Vb.
- the buffer motor is in a coasting state from the time t1 when the emergency stop is applied to the time t2 when the emergency stop is released.
- the command speed maintaining unit 170 maintains the command speed for the buffer motor 55 (symbol A).
- the control device 1 starts controlling the buffer motor 55 . Since the commanded speed is maintained, the commanded speed is maintained at the base speed Vb. Therefore, sudden deceleration does not occur (symbol B). Also, although the speed of the buffer motor 55 has decreased to some extent, since the torque is limited by the torque limit command section 190, the acceleration is limited and rapid acceleration is not performed (symbol B). As a result, neither large regenerative power nor large peak power is generated in the buffer motor 55 (symbol C).
- the control device 1 having the above configuration can cancel the emergency stop without suddenly stopping the coasting buffer motor 55, so that the buffer motor 55 does not generate a large amount of regenerative power or peak power, and the operation of the industrial machine can be restarted in a short time.
- the torque limit command unit 190 may limit the torque of the buffer motor 55 by commanding the buffer motor control unit 150 to limit the acceleration of the buffer motor 55 instead of the torque limit value.
- the acceleration limit value ⁇ b may be calculated from the torque limit value Tb using Equation 3 below.
- the acceleration limit value ⁇ b may be calculated from the allowable power consumption Wb using the following equation (4). Note that J in Equations 3 and 4 is the moment of inertia.
- Control Device 2 4 Industrial Machine 5 Network 6 Fog Computer 7 Cloud Server 8 Power Supply Path 9 Common Power Source 11
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本開示による制御装置は、非常停止の状態を検出する非常停止検出部と、電力を供給する際の基準となる回転速度であるベース速度に復帰する指令を出力するバッファ用モータ指令生成部と、非常停止からバッファ用モータの速度がベース速度に復帰するまでの間、バッファ用モータに対する指令速度を非常停止時の速度からベース速度までの範囲内に収めるように指令する指令速度維持部と、バッファ用モータがベース速度に到達したかを判定するベース速度到達判定部と、非常停止が検出されてからバッファ用モータがベース速度に復帰するまでの間、バッファ用モータのトルクリミットを指令するトルクリミット指令部と、バッファ用モータ指令生成部が生成した指令及びトルクリミット指令部による指令に基づいて前記バッファ用モータを制御するバッファ用モータ制御部と、 を備える。
Description
本発明は、制御装置に関する。
工場等の製造現場に設置された工作機械、射出成形機、ロボット等の複数の産業機械は、該産業機械を制御する制御装置からの指令に基づいて稼働している。これら複数の産業機械は、所定の電源設備に接続されている。そして、電源設備から供給される電力を消費して稼働する(例えば、特許文献1)。この時、電力を多く消費するような指令、例えば産業機械の可動部を駆動する駆動用モータを急加速する指令が実行されると、産業機械で大きな電力が消費される。
このような場合に消費電力量を低減させる仕組みとして、モータの回生電力を利用するものがある。例えば図5に示されるように、産業機械の駆動用モータとは異なる他のモータを予め所定の速度(以下、ベース速度とする)で駆動しておく。そして、産業機械で電力が消費されるタイミングに合わせて他のモータを減速させる。すると、他のモータから回生電力が発生し、これを利用することで電力の消費を抑える事ができる。このような目的で設置される他のモータを、本明細書ではバッファ用モータと呼ぶ。バッファ用モータは、駆動用モータの動作に応じて、ピーク電力を低減できるようにベース速度を基準とした加速・減速を行っている。
ところで、緊急時に産業機械を停止するために非常停止ボタンを操作すると、商用電源からの電力供給路が遮断される。ここで、図5に例示するように、駆動用モータとバッファ用モータとで共通の電源を使用している場合、産業機械を駆動する駆動用モータに非常停止をかけると、バッファ用モータにも非常停止がかかる。
非常停止時にモータの回転を減速させる仕組みとしてダイナミックブレーキモジュール(以下、DBMとする)がある。DBMは、抵抗器を介してサーボモータの端子間を短絡することで、回転エネルギーを熱消費させる仕組みである。DBMを組み込むことで、非常停止時にモータを惰走させずに速やかに停止させることができる。しかしながら、高い頻度で非常停止をかけるとDBMが高温になり使用できなくなるという問題がある。そのため、非常時に回転を速やかに停止させなくても大きな危険が無いバッファ用モータは、DBMを組み込まずに使用する場合がある。
DBMが組み込まれていない場合に非常停止をかけると、速度制御が行われなくなり、バッファ用モータは長時間惰走することになる。例えば、あるモータを毎分3000回転している状態から惰走させると、回転が停止するまで約6分掛かる。そのため、DBMを組み込んでいないバッファ用モータを非常停止させた場合に、その回転が停止するのを待って運転を再開するようにした場合、非常停止が起きるたびに待ち時間が発生するため産業機械の運転効率が大幅に低下するという問題がある。
このような問題を解決するために、非常停止の原因を解決し次第、バッファ用モータが惰走している間であっても非常停止を解除して産業機械の運転を再開するという方法が考えられる。図6は、バッファ用モータの惰走中に非常停止を解除した場合のバッファ用モータの速度、消費電力及び指令速度の推移を例示するグラフである。図6の例では、時刻t1の時点で非常停止がかかり、その後、非常停止の原因が解決されて時刻t2の時点で非常停止が解除されている。産業機械の運転時、バッファ用モータは所定のベース速度Vbを維持するように駆動している。そして、非常停止が掛かった時刻t1から非常停止が解除される時刻t2までの間はバッファ用モータに対する指令は行われず、この区間では無制御の状態になる。この無制御区間では、バッファ用モータは惰走状態となり、その速度は時間が経つにつれて減少していく。その後、時刻t2において非常停止が解除されると、制御装置がバッファ用モータの制御を開始する。この時、制御装置はモータの初速度が0であるものとし(符号A)、その後ベース速度Vbまで速度を加速するように速度制御を行う。そのため、バッファ用モータが惰走している最中に非常停止を解除すると、バッファ用モータが惰走している速度から急減速する(符号B)。この時、バッファ用モータで大きな回生電力が発生する(符号C)。また、加速時には大きなピーク消費電力が発生する(符号D)。このような大きな回生電力やピーク消費電力の発生は避けたいという要望がある。
そのため、バッファ用モータで大きな回生電力やピーク消費電力を発生させることなく速やかに産業機械の運転を再開できる仕組みが求められている。
そのため、バッファ用モータで大きな回生電力やピーク消費電力を発生させることなく速やかに産業機械の運転を再開できる仕組みが求められている。
本開示による制御装置は、非常停止解除時からベース速度に復帰するまで、バッファ用モータに対し、許容される消費電力に収まるようなトルクリミット値を適用することで、上記課題を解決する。
そして、本開示の一態様は、産業機械を駆動する駆動用のモータと共通の電源から電力が供給されているバッファ用モータを制御する制御装置であって、非常停止の状態を検出する非常停止検出部と、電力を供給する際の基準となる回転速度であるベース速度に復帰する指令を出力するバッファ用モータ指令生成部と、非常停止から前記バッファ用モータの速度がベース速度に復帰するまでの間、前記バッファ用モータに対する指令速度を非常停止時の速度からベース速度までの範囲内に収めるように前記バッファ用モータ指令生成部に指令する指令速度維持部と、前記バッファ用モータがベース速度に到達したかを判定するベース速度到達判定部と、前記非常停止検出部により前記非常停止が検出されてから、前記ベース速度到達判定部により前記バッファ用モータがベース速度に到達したと判定されるまでの間、前記ベース速度への復帰中における前記バッファ用モータのトルクリミットを指令するトルクリミット指令部と、前記バッファ用モータ指令生成部が生成した指令及び前記トルクリミット指令部による指令に基づいて前記バッファ用モータを制御するバッファ用モータ制御部と、を備え、非常停止解除後にベース速度へ復帰する際、前記バッファ用モータでのトルクを制限する、制御装置である。
本開示の一態様により、バッファ用モータで大量の電力を消費することなく産業機械の運転を短時間で再開することが可能となる。
以下、本発明の実施形態を図面と共に説明する。
図1は本発明の第1実施形態による制御装置の要部を示す概略的なハードウェア構成図である。本発明の制御装置1は、例えば制御用プログラムに基づいて工作機械やロボットなどの産業機械を制御する制御装置として実装することができる。
図1は本発明の第1実施形態による制御装置の要部を示す概略的なハードウェア構成図である。本発明の制御装置1は、例えば制御用プログラムに基づいて工作機械やロボットなどの産業機械を制御する制御装置として実装することができる。
本実施形態による制御装置1が備えるCPU11は、制御装置1を全体的に制御するプロセッサである。CPU11は、バス22を介してROM12に格納されたシステム・プログラムを読み出し、該システム・プログラムに従って制御装置1全体を制御する。RAM13には一時的な計算データや表示データ、及び外部から入力された各種データ等が一時的に格納される。
不揮発性メモリ14は、例えば図示しないバッテリでバックアップされたメモリやSSD(Solid State Drive)等で構成され、制御装置1の電源がオフされても記憶状態が保持される。不揮発性メモリ14には、産業機械2から取得されたデータ、インタフェース15を介して外部機器72から読み込まれた制御用プログラムやデータ、入力装置71を介して入力された制御用プログラムやデータ、ネットワーク5を介して他の装置から取得された制御用プログラムやデータ等が記憶される。不揮発性メモリ14に記憶された制御用プログラムやデータは、実行時/利用時にはRAM13に展開されても良い。また、ROM12には、公知の解析プログラムなどの各種システム・プログラムがあらかじめ書き込まれている。
インタフェース15は、制御装置1のCPU11とUSB装置等の外部機器72と接続するためのインタフェースである。外部機器72側からは、例えば産業機械2の制御に用いられる制御用プログラムや設定データ等が読み込まれる。また、制御装置1内で編集した制御用プログラムや設定データ等は、外部機器72を介して外部記憶手段に記憶させることができる。PLC(プログラマブル・ロジック・コントローラ)16は、ラダープログラムを実行して産業機械2及び産業機械2の周辺装置(例えば、工具交換装置や、ロボット等のアクチュエータ、産業機械2に取付けられている温度センサや湿度センサ等の複数のセンサ3)にI/Oユニット19を介して信号を出力し制御する。また、産業機械2の本体に配備された操作盤の各種スイッチや周辺装置等の信号を受け、必要な信号処理をした後、CPU11に渡す。
インタフェース20は、制御装置1のCPUと有線乃至無線のネットワーク5とを接続するためのインタフェースである。ネットワーク5には、工作機械や放電加工機などの他の産業機械4やフォグコンピュータ6、クラウドサーバ7等が接続され、制御装置1との間で相互にデータのやり取りを行っている。
表示装置70には、メモリ上に読み込まれた各データ、プログラム等が実行された結果として得られたデータ等がインタフェース17を介して出力されて表示される。また、キーボードやポインティングデバイス等から構成される入力装置71は、オペレータによる操作に基づく指令,データ等をインタフェース18を介してCPU11に渡す。
産業機械2が備える軸を制御するための軸制御回路30はCPU11からの軸の移動指令量を受けて、軸の指令をサーボアンプ40に出力する。サーボアンプ40はこの指令を受けて、工作機械が備える軸を移動させるサーボモータ50を駆動する。軸のサーボモータ50は位置・速度検出器を内蔵し、この位置・速度検出器からの位置・速度フィードバック信号を軸制御回路30にフィードバックし、位置・速度のフィードバック制御を行う。なお、図1のハードウェア構成図では軸制御回路30、サーボアンプ40、サーボモータ50は1つずつしか示されていないが、実際には制御対象となる産業機械2に備えられた軸の数だけ用意される。
また、バッファ用モータ55を制御するための軸制御回路35はCPU11からのバッファ用モータ55の回転指令量を受けて、バッファ用モータ55を駆動する指令をサーボアンプ45に出力する。サーボアンプ45はこの指令を受けて、バッファ用モータ55を駆動する。バッファ用モータ55もまた位置・速度検出器を内蔵し、この位置・速度検出器からの位置・速度フィードバック信号を軸制御回路35にフィードバックし、位置・速度のフィードバック制御を行う。なお、サーボアンプ40及びサーボアンプ45は、電力供給路8を介して共通電源9から電力の供給を受けている。
図2は、本発明の第1実施形態による制御装置1が備える機能を概略的なブロック図として示したものである。本実施形態による制御装置1が備える各機能は、図1に示した制御装置1が備えるCPU11がシステム・プログラムを実行し、制御装置1の各部の動作を制御することにより実現される。
本実施形態の制御装置1は、指令生成部100、制御部110、消費電力計算部120、供給電力計算部130、バッファ用モータ指令生成部140、バッファ用モータ制御部150、モータ速度特定部155、非常停止検出部160、指令速度維持部170、ベース速度到達判定部180、トルクリミット指令部190を備える。また、制御装置1のRAM13乃至不揮発性メモリ14には、予め産業機械2の運転を制御するための制御用プログラム200が記憶されており、更に、バッファ用モータ55の制御に係る設定を記憶するための領域である設定記憶部210が予め用意されている。
指令生成部100は、制御用プログラム200のブロックを解析し、その解析結果に基づいて産業機械2の各部を制御する指令を生成する。指令生成部100が生成する指令は、例えば制御用プログラム200のブロックが産業機械2の各軸を駆動させるように指令している場合には、そのブロックによる指令に従ってサーボモータ50の移動を指令する移動指令を生成する。また、例えば制御用プログラム200のブロックが産業機械2の周辺装置を制御するように指令している場合には、該周辺装置を動作させる指令を生成する。指令生成部100が生成する指令は、制御部110に出力される。指令生成部100は、非常停止検出部160からの非常停止の検出の通知を受けた場合、産業機械2の制御に係る指令の生成を一時停止する。また、非常停止検出部160からの非常停止解除の検出の通知を受けた場合、一時停止していた産業機械2の制御に係る指令の生成を再開する。
制御部110は、図1に示した制御装置1が備えるCPU11がROM12から読み出したシステム・プログラムを実行し、主としてCPU11によるRAM13、不揮発性メモリ14を用いた演算処理と、軸制御回路30、PLC16を用いた産業機械2の各部の制御処理、インタフェース18を介した入出力処理が行われることで実現される。制御部110は、指令生成部100から入力された指令に基づいて、産業機械2の各部を制御する。制御部110は、例えば指令生成部100から入力された指令が産業機械2のサーボモータ50の移動を指令している場合には、該指令に従って移動指令データを生成してサーボモータ50に対して出力する。また、制御部110は、例えば指令生成部100から入力された指令が産業機械2に取り付けられた周辺装置を動作させるように指令である場合には、該周辺装置を動作させる所定の信号を生成してPLC16に出力する。一方で、制御部110は、サーボモータ50の位置フィードバック、速度フィードバック、トルクフィードバックや、温度センサや湿度センサ等の周辺装置が検出したデータを取得し、産業機械2の制御に用いる。
消費電力計算部120は、制御部110による産業機械2を駆動するサーボモータ50の動作状態や制御内容に基づいて、産業機械2を駆動するサーボモータ50の駆動において消費される電力を計算する。サーボモータ50の駆動において消費される電力は、例えばてサーボモータ50の回転速度VdとトルクTdに基づいて算出されるサーボモータ50の出力Vd×Td、サーボモータ50やサーボアンプ40などで発生する損失Ldなどに基づいて算出することができる。通常、サーボモータ50やサーボアンプ40などで発生する損失Ldはサーボモータ50の出力(の絶対値)と比較して十分に小さいので、サーボモータ50の出力に基づいて消費電力として計算するようにしてよい。消費電力計算部120は、例えばサーボモータ50からフィードバックされる速度フィードバック、トルクフィードバックを用いて現時点におけるサーボモータ50の駆動において消費される電力を計算するようにしてよい。消費電力の計算方法については、例えば特開2019-075864号公報、特開2019-092239号公報などで既に公知となっているため、本明細書における詳細な説明は省略する。
供給電力計算部130は、消費電力計算部120が計算したサーボモータ50の駆動において消費される電力量に基づいて、バッファ用モータ55から供給するべき回生電力の量を計算する。供給電力計算部130は、例えば予め設定されている共通電源9による最大有能電力から、消費電力計算部120が計算した消費電力量を減算した値を計算する。そして、計算した値が予め設定されている所定の閾値Thdを下回る場合、その下回った分の値をバッファ用モータ55から供給するべき回生電力の量として計算する。閾値Thdを0に設定した場合、共通電源9の最大有能電力からサーボモータ50の消費電力を減算した値が閾値Thd(=0)を下回った値は、サーボモータ50の駆動に足りない電力を示す。そのため、この下回った値をバッファ用モータ55から供給するべき回生電力の量とすることができる。閾値Thdは、安全のために所定のマージンを取った正の値として設定してもよい。
バッファ用モータ指令生成部140は、非常停止検出部160からの非常停止解除の検出の通知を受けた場合、ベース速度Vbまで加速度Abで加速するようにバッファ用モータ55の速度を制御する指令を生成する。バッファ用モータ指令生成部140が生成した指令は、バッファ用モータ制御部150に出力される。
バッファ用モータ制御部150は、バッファ用モータ55を制御する。産業機械2が通常運転されている時であって、供給電力計算部130から入力されたバッファ用モータ55から供給するべき回生電力量が0である場合、バッファ用モータ制御部150は、設定記憶部210に予め記憶されているバッファ用モータ55のベース速度Vb及び該ベース速度Vbまでバッファ用モータを加速する際の加速度Abに基づいて、バッファ用モータ55の速度がベース速度Vbとなるようにバッファ用モータ55を制御する。また、産業機械2が通常運転されている時であって、供給電力計算部130から入力されたバッファ用モータ55から供給するべき回生電力量が正の値を取る場合、バッファ用モータ制御部150は、該バッファ用モータ55から供給するべき回生電力量に相当する回生電力が発生するようにバッファ用モータ55を減速する制御をする。反対に、供給電力計算部130から入力されたバッファ用モータ55から供給するべき回生電力量が負の値を取る場合、バッファ用モータ制御部150は、該バッファ用モータ55から供給するべき回生電力量に相当する消費電力が発生するようにバッファ用モータ55を加速する制御をする。
一方、バッファ用モータ制御部150は、バッファ用モータ指令生成部140から指令が入力される際には、バッファ用モータ指令生成部140が生成した指令に基づいてバッファ用モータ55を制御する。バッファ用モータ制御部150は、非常停止解除時のバッファ用モータ55の加速を行う際に、バッファ用モータ55のトルクが予め定めた所定の閾値Tth以下になるように制御してもよい。所定の閾値Tthは、バッファ用モータをベース速度Vbまで加速度Abで加速する際に大きな電力を消費しないトルク値である。所定の閾値Tthは、バッファ用モータの種類ごとに予め実験等を行い求めておくとよい。また、バッファ用モータ制御部150は、指令速度維持部170から指令速度を維持するように指令されている場合、バッファ用モータ指令生成部140からの指令速度を維持指令に合わせて修正する。
また、バッファ用モータ制御部150は、トルクリミット指令部190からのトルクリミット指令がされている場合、バッファ用モータ55のトルク値がトルクリミット指令で指令される値を超えないようにバッファ用モータ55の速度を制限する。バッファ用モータ制御部150は、バッファ用モータのトルク値を監視して、トルク値がトルクリミット指令で指令される値を超える場合に速度を落とすフィードバック制御を行うようにしてもよい。また、例えば以下の数1式などを用いて加減速時に発生するトルクTaを計算し、トルクTaをトルクリミット指令で指令される値以下に抑えることができるように速度を制御するようにしてもよい。なお、数1式において、J0はロータ慣性モーメント、JLは全負荷慣性モーメント、iは減速比、aは加減速度である。
モータ速度特定部155は、バッファ用モータ55の速度を特定し、特定したバッファ用モータ55の速度をバッファ用モータ指令生成部140に出力する。モータ速度特定部155は、最もシンプルに構成するのであれば、バッファ用モータ55の速度を検出する図示しないセンサからの入力に基づいてバッファ用モータ55の速度を特定してもよい。
バッファ用モータ55の速度を特定する他の例としては、センサで検出した過去のバッファ用モータ55の速度から予測するようにしてもよい。同様に、バッファ用モータ55の速度をセンサで検出した履歴を記憶しておき、記憶した速度の履歴からバッファ用モータ55の現在の速度を予測するようにしてもよい。センサでモータの速度を検出してから、検出した速度をモータ速度特定部155が取得するまでには、ある程度の遅れが生じる。図3は、バッファ用モータ55の速度と、モータ速度特定部155がセンサで検出したバッファ用モータ55の速度とを、同一のグラフ上に示した例である。図3において、実線はその時刻におけるバッファ用モータ55を表している。また、点線はその時刻においてモータ速度特定部155が取得したバッファ用モータ55の速度を表している。図3に示すように、非常停止中に惰走している区間では、モータ速度特定部155が取得したバッファ用モータ55の速度は、同時刻における実際のバッファ用モータ55の速度よりも大きな値となっている。そのため、モータ速度特定部155が取得したバッファ用モータ55の速度をそのまま非常停止解除時のバッファ用モータ55の現在の速度とした場合、制御開始直後に急な加速が発生し消費電力が増加する。これを避けるため、モータ速度特定部155は、取得していたバッファ用モータ55の非常停止中におけるバッファ用モータ55の過去の速度推移や、速度の履歴からその変化傾向を計算し、予め実験などで測定していた遅れ時間後にバッファ用モータ55の速度がどのような値になっているかを予測する。そして、その予測した速度を現在のバッファ用モータ55の速度として出力する。
バッファ用モータ55の速度を特定する他の例としては、非常停止を掛けた時刻におけるバッファ用モータ55の速度と、非常停止から現在までに掛かった時間とに基づいてバッファ用モータ55の現在の速度を予測するようにしてもよい。一般に、モータが惰走している間に該モータの速度が減速していく割合はイナーシャや摩擦などのパラメータに依存する。そこで、予めバッファ用モータ55を用いた実験を行い、非常停止をしてからの時間に対する速度の変化をプロットしておく。そして、そのプロットしたデータに対する回帰分析を行うことで回帰式を作成し、作成した回帰式を用いることで、非常停止を掛けた時刻におけるバッファ用モータ55の速度と、非常停止から現在までに掛かった時間とから、バッファ用モータ55の現在の速度を予測してもよい。この時、回帰式の説明変数には、非常停止開始時のバッファ用モータ55の速度及び非常停止開始から現在までに掛かった時間を用い、目的変数に現在の時間を用いるとよい。同様に、プロットしたデータに基づいて、ニューラルネットワークなどをモデルとした機械学習を行い、作成したモデルを用いてバッファ用モータ55の現在の速度を予測してもよい。この時、機械学習器の入力データには非常停止開始時のバッファ用モータ55の速度及び非常停止開始から現在までに掛かった時間を用い、出力データ(ラベルデータ)には目的変数に現在の時間を用いるとよい。回帰式の説明変数や機械学習器の入力データには、バッファ用モータ55のイナーシャや摩擦などのパラメータを用いるようにしてもよい。また、温度や湿度などのデータを追加してもよい。これは、温度や湿度が摩擦などのパラメータに影響を与えるためである。
非常停止検出部160は、産業機械2の非常停止及び非常停止解除を検出し、その検出結果を指令生成部100、バッファ用モータ指令生成部140、指令速度維持部170、及びトルクリミット指令部190に出力する。非常停止検出部160は、例えばサーボアンプ40、サーボアンプ45の励磁状態のオン/オフを検出することで、非常停止及び非常停止解除を検出するようにしてもよい。また、例えば外部から入力される非常停止信号の状態の変化や、オペレータによる非常停止ボタンや非常停止解除ボタンなどの操作状態を検出することで、非常停止及び非常停止解除を検出するようにしてもよい。
指令速度維持部170は、非常停止が為されたタイミングで、その時点におけるバッファ用モータ55の速度をモータ速度特定部155から取得する。そして、非常停止検出部160にから非常停止の検出の通知が入力されてからバッファ用モータ55の速度がベース速度に復帰するまでの間、バッファ用モータ55に対する指令速度を、非常停止時の速度からベース速度までの範囲内に維持するようにバッファ用モータ制御部150に指令する。指令速度維持部170は、単純に指令速度をベース速度Vbに維持するように指令してもよい。
ベース速度到達判定部180は、バッファ用モータがベース速度Vbに到達したかを判定する。そして、ベース速度Vbに到達したと判定した場合、その旨をトルクリミット指令部190に通知する。
トルクリミット指令部190は、設定記憶部210に記憶されるトルクリミットに係る情報に基づいて、バッファ用モータ55のトルクを制限するようにバッファ用モータ制御部150に指令する。設定記憶部210には、例えば予めバッファ用モータ55のベース速度復帰中におけるトルクリミット値が記憶されている。トルクリミット指令部190は、非常停止検出部160から非常停止解除の検出が通知されてから、ベース速度到達判定部180からバッファ用モータ55がベース速度Vbに到達した旨が通知されるまでのあいだ、このトルクリミット値にバッファ用モータ55のトルクを制限するようにバッファ用モータ制御部150に指令する。ベース速度復帰中におけるトルクリミット値Tbは、例えば鉄損等の影響を無視すれば以下の数2式で計算することができる。なお、数2式において、Vbはバッファ用モータ55のベース速度、Wbはバッファ用モータ55で許容される消費電力である。この許容される消費電力Wbは、例えば産業機械2で許容される許容電力値から、サーボモータ50の許容電力値を引いた値としてもよいし、産業機械2で許容される許容電力値から、サーボモータ50で発生する電力の瞬時値を引いた値としてもよい。
図4は、非常停止を解除時に本実施形態による制御装置1でバッファ用モータ55を制御した場合におけるバッファ用モータ55の速度、消費電力、指令速度及びトルクリミット値の推移を例示するグラフである。図4の例では、時刻t1の時点で非常停止がかかり、その後、非常停止の原因が解決されて時刻t2の時点で非常停止が解除され、時刻t3の時点でバッファ用モータ55がベース速度Vbに復帰している。産業機械の運転時、バッファ用モータは所定のベース速度Vbを維持するように駆動している。そして、非常停止が掛かった時刻t1から非常停止が解除される時刻t2までの間はバッファ用モータは惰走状態になる。しかしながら、指令速度維持部170により、バッファ用モータ55に対する指令速度は維持される(符号A)。その後、時刻t2において非常停止が解除されると、制御装置1がバッファ用モータ55の制御を開始する。指令速度は維持されているため、指令速度はそのままベース速度Vbが維持される。そのため、急な減速は発生しない(符号B)。また、バッファ用モータ55の速度はある程度下がってはいるが、トルクリミット指令部190によりトルクリミットが掛かっているため、加速に制限が掛かり急加速は行われない(符号B)。これにより、バッファ用モータ55で大きな回生電力も、大きなピーク電力も発生することはない(符号C)。
上記構成を備えた制御装置1は、惰走しているバッファ用モータ55を急停止させることなく非常停止を解除することができるので、バッファ用モータ55で大量の回生電力もピーク電力も発生せず、産業機械の運転を短時間で再開することが可能となる。
本実施形態による制御装置1の一変形例として、トルクリミット指令部190は、トルクリミット値に代えて、バッファ用モータ55の加速度の制限値をバッファ用モータ制御部150に指令することで、バッファ用モータ55のトルクを制限するようにしてもよい。この場合、以下の数3式などを用いて、トルクリミット値Tbから加速度リミット値αbを計算してもよい。また、以下の数4式などを用いて、許容消費電力Wbから加速度リミット値αbを計算してもよい。なお、数3式、数4式において、Jは慣性モーメントである。
以上、本発明の実施形態について説明したが、本発明は上述した実施の形態の例のみに限定されることなく、適宜の変更を加えることにより様々な態様で実施することができる。
1 制御装置
2,4 産業機械
5 ネットワーク
6 フォグコンピュータ
7 クラウドサーバ
8 電力供給路
9 共通電源
11 CPU
12 ROM
13 RAM
14 不揮発性メモリ
15,17,18,20,21 インタフェース
16 PLC
19 I/Oユニット
22 バス
30,35 軸制御回路
40,45 サーボアンプ
50 サーボモータ
55 バッファ用モータ
70 表示装置
71 入力装置
72 外部機器
100 指令生成部
110 制御部
120 消費電力計算部
130 供給電力計算部
140 バッファ用モータ指令生成部
150 バッファ用モータ制御部
155 モータ速度特定部
160 非常停止検出部
170 指令速度維持部
180 ベース速度到達判定部
190 トルクリミット指令部
200 制御用プログラム
210 設定記憶部
2,4 産業機械
5 ネットワーク
6 フォグコンピュータ
7 クラウドサーバ
8 電力供給路
9 共通電源
11 CPU
12 ROM
13 RAM
14 不揮発性メモリ
15,17,18,20,21 インタフェース
16 PLC
19 I/Oユニット
22 バス
30,35 軸制御回路
40,45 サーボアンプ
50 サーボモータ
55 バッファ用モータ
70 表示装置
71 入力装置
72 外部機器
100 指令生成部
110 制御部
120 消費電力計算部
130 供給電力計算部
140 バッファ用モータ指令生成部
150 バッファ用モータ制御部
155 モータ速度特定部
160 非常停止検出部
170 指令速度維持部
180 ベース速度到達判定部
190 トルクリミット指令部
200 制御用プログラム
210 設定記憶部
Claims (7)
- 産業機械を駆動する駆動用のモータと共通の電源から電力が供給されているバッファ用モータを制御する制御装置であって、
非常停止の状態を検出する非常停止検出部と、
電力を供給する際の基準となる回転速度であるベース速度に復帰する指令を出力するバッファ用モータ指令生成部と、
前記バッファ用モータがベース速度に到達したかを判定するベース速度到達判定部と、
前記非常停止検出部により前記非常停止が検出されてから、前記ベース速度到達判定部により前記バッファ用モータの速度がベース速度に到達したと判定されるまでの間、前記バッファ用モータに対する指令速度を非常停止時の速度からベース速度までの範囲内に収めるように前記バッファ用モータ指令生成部に指令する指令速度維持部と、
前記非常停止検出部により前記非常停止が検出されてから、前記ベース速度到達判定部により前記バッファ用モータがベース速度に到達したと判定されるまでの間、前記ベース速度への復帰中における前記バッファ用モータのトルクリミットを指令するトルクリミット指令部と、
前記バッファ用モータ指令生成部が生成した指令及び前記トルクリミット指令部による指令に基づいて前記バッファ用モータを制御するバッファ用モータ制御部と、
を備え、
非常停止解除後にベース速度へ復帰する際、前記バッファ用モータでのトルクを制限する、
制御装置。 - 前記指令速度維持部は、前記バッファ用モータに対する指令速度をベース速度に維持する、
請求項1に記載の制御装置。 - 前記トルクリミット指令部は、前記バッファ用モータのトルクが予め定められた所定のトルクリミット値以下となるように前記バッファ用モータ制御部に指令する、
請求項1または2に記載の制御装置。 - 前記トルクリミット値は、前記バッファ用モータの許容電力値に基づいて定められたものである、
請求項3に記載の制御装置。 - 前記許容電力値は、前記産業機械の許容電力値から前記駆動用のモータの許容電力値を引いた値である、
請求項4に記載の制御装置。 - 前記許容電力値は、前記産業機械の許容電力値から前記駆動用のモータの電力の瞬時値を引いた値である、
請求項4に記載の制御装置。 - 前記トルクリミット指令部は、前記バッファ用モータの角加速度が予め定められた所定の制限値以下となるように前記バッファ用モータ制御部に指令する、
請求項1または2に記載の制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2022/002257 WO2023139763A1 (ja) | 2022-01-21 | 2022-01-21 | 制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2022/002257 WO2023139763A1 (ja) | 2022-01-21 | 2022-01-21 | 制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2023139763A1 true WO2023139763A1 (ja) | 2023-07-27 |
Family
ID=87348468
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/002257 WO2023139763A1 (ja) | 2022-01-21 | 2022-01-21 | 制御装置 |
Country Status (1)
Country | Link |
---|---|
WO (1) | WO2023139763A1 (ja) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009525877A (ja) * | 2006-02-06 | 2009-07-16 | エー ビー ビー リサーチ リミテッド | 機械プレス機駆動システム及び方法 |
JP2017005913A (ja) * | 2015-06-12 | 2017-01-05 | ファナック株式会社 | 非常停止時にサーボモータを制御して停止させるサーボモータ停止制御装置 |
JP2019075864A (ja) * | 2017-10-13 | 2019-05-16 | ファナック株式会社 | 蓄電装置を有するモータ駆動システム |
-
2022
- 2022-01-21 WO PCT/JP2022/002257 patent/WO2023139763A1/ja unknown
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009525877A (ja) * | 2006-02-06 | 2009-07-16 | エー ビー ビー リサーチ リミテッド | 機械プレス機駆動システム及び方法 |
JP2017005913A (ja) * | 2015-06-12 | 2017-01-05 | ファナック株式会社 | 非常停止時にサーボモータを制御して停止させるサーボモータ停止制御装置 |
JP2019075864A (ja) * | 2017-10-13 | 2019-05-16 | ファナック株式会社 | 蓄電装置を有するモータ駆動システム |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10442085B2 (en) | Production system for performing cooperative work by operator and robot | |
US9409295B2 (en) | Method for controlling a robot | |
JP4226632B2 (ja) | 異常時モータ減速停止制御手段を有する数値制御装置 | |
US9102058B2 (en) | Method and apparatus for implementing a manipulator process | |
JP2012039847A (ja) | モータ制御装置およびモータ制御方法 | |
US6741057B2 (en) | Servo controller for preventing downward displacement in gravitating axis | |
US10016895B2 (en) | Method and system for operating and/or monitoring a multi-axis machine | |
US6704875B1 (en) | Method of operation controller having processor for controlling industrial machine | |
JP5778891B2 (ja) | ロボット制御装置 | |
JPH10263973A (ja) | 停電落下防止制御装置 | |
WO2023139763A1 (ja) | 制御装置 | |
WO2023139764A1 (ja) | 制御装置 | |
WO2023053343A1 (ja) | 制御装置 | |
JP6457778B2 (ja) | 数値制御装置 | |
JP5030628B2 (ja) | 干渉チェックシステム | |
CN111706462A (zh) | 基于状态机的变桨***控制方法、变桨***以及状态机 | |
CN115913900A (zh) | 设备停机方法、装置、终端设备以及存储介质 | |
CN114928294A (zh) | 机器人的安全控制***、安全控制方法及机器人 | |
JPH06246674A (ja) | 産業用ロボットのブレーキ異常検出方法 | |
US9811069B2 (en) | Servomotor control apparatus | |
JPH10277887A (ja) | 位置検出器異常時の電動機制御方法 | |
CN108462426B (zh) | 电机控制装置和电机控制方法 | |
JP2001202134A (ja) | 制御装置、制御方法、および、制御装置の警報出力方法 | |
US10924039B2 (en) | Motor control device and control method for motor control device | |
CN112327762A (zh) | 伺服电动机的控制装置 |
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: 22921920 Country of ref document: EP Kind code of ref document: A1 |