WO2024181451A1 - Control device, crane, and control method - Google Patents
Control device, crane, and control method Download PDFInfo
- Publication number
- WO2024181451A1 WO2024181451A1 PCT/JP2024/007126 JP2024007126W WO2024181451A1 WO 2024181451 A1 WO2024181451 A1 WO 2024181451A1 JP 2024007126 W JP2024007126 W JP 2024007126W WO 2024181451 A1 WO2024181451 A1 WO 2024181451A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- acceleration
- time
- speed
- waveform
- target speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
- B66C13/22—Control systems or devices for electric drives
Definitions
- the present invention relates to a control device and a control method for suppressing vibrations of a transported object suspended by a rope or the like, and to a control technology for suppressing long-period vibrations, such as pendulum vibrations, that occur in a transported object suspended by a crane or the like.
- Patent Document 1 proposes a vibration control method that uses advanced control techniques such as equations of motion and Laplace transforms to perform vibration control.
- the vibration control method described in Patent Document 1 performs vibration control by making full use of advanced control such as equations of motion and Laplace transforms, which results in a complex control device and requires a lot of time for vibration control.
- the present invention was made in consideration of these problems, and aims to reduce the shaking of the transported object more easily, and to automatically accelerate and decelerate at the optimal timing, thereby reducing the vibration of the transported object and suppressing the vibration of the transported object regardless of the skill of the operator.
- a control device is a control device that controls the speed of a drive device that moves a horizontal movement device from which a load is suspended in a horizontal direction based on an acceleration command signal, and is characterized by having a target speed update unit that detects a target speed change command to change the target speed of the drive device and updates the target speed, an acceleration waveform determination unit that determines three acceleration waveforms, a first acceleration waveform, a second acceleration waveform, and a third acceleration waveform, for generating an acceleration command signal from the speed difference between the target speed updated by the target speed update unit and the current speed of the drive device, a timing determination unit that determines the start timing of the three acceleration waveforms so that the phases of the vibration waveform of the load generated when the drive device is driven by each of the three acceleration waveforms are shifted by 1/3, an acceleration command signal generation unit that generates an acceleration command signal indicating that the acceleration of the three acceleration waveforms will start at the timing determined by the timing determination unit, and a drive control unit that generates
- the acceleration command signal generation unit can generate an acceleration command signal by adding up the three acceleration waveforms for each time.
- the timing determination unit determines the first time t1, which is the start timing of the first acceleration waveform, to be the time corresponding to the timing when the target speed update unit detects a command to change the target speed, the second time t2, which is the start timing of the second acceleration waveform, to be the time when 1/6 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the first acceleration waveform has elapsed from the first time t1, and the third time t3, which is the start timing of the third acceleration waveform, to be the time when 1/6 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the first acceleration waveform has elapsed from the second time t2;
- the acceleration waveform determination unit includes:
- the first to third acceleration waveforms are set as uniform acceleration waveforms with a predetermined acceleration A0, an acceleration time Ta is determined from a target speed, the first acceleration waveform is generated from a time function f1(t), the second acceleration waveform is generated from a time
- f3(t) ⁇ A0 square wave.
- the timing determination unit is The first time t1, which is the start timing of the first acceleration waveform, is set to the time corresponding to the timing when the target speed update unit detects a command to change the target speed, the second time t2, which is the start timing of the second acceleration waveform, is set to the time when 1/3 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the first acceleration waveform has elapsed from the first time t1, and the third time t3, which is the start timing of the third acceleration waveform, is set to the time when 1/3 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the second acceleration waveform has elapsed from the second time t2.
- the target speed update unit is able to not update the target speed if it detects a command to change the target speed of the drive unit before acceleration by the third acceleration waveform is completed.
- the target speed update unit can stop not updating the target speed and update the target speed under certain conditions.
- the acceleration waveform determination unit includes: determining a corrective acceleration time Tas for stopping from the current speed of the drive; For t ⁇ t
- the drive device drives the motor using the power conversion device, and the drive control unit can provide the generated drive command signal to the power conversion device to drive the drive device.
- the acceleration waveform can be a square waveform or a trapezoidal waveform.
- the crane can have a control device.
- a control method is a control method for a control device that controls the speed of a drive device that moves a horizontal movement device from which a load is suspended in a horizontal direction based on an acceleration command signal, and is characterized by having a target speed update step of detecting a target speed change command that changes the target speed of the drive device and updating the target speed, an acceleration waveform determination step of determining three acceleration waveforms, a first acceleration waveform, a second acceleration waveform, and a third acceleration waveform, for generating an acceleration command signal from the speed difference between the target speed updated in the target speed update step and the current speed of the drive device, a timing determination step of determining the start timing of the three acceleration waveforms so that the phases of the vibration waveform of the load generated when the drive device is driven by each of the three acceleration waveforms determined in the acceleration waveform determination step are shifted by 1/3, an acceleration command signal generation step of generating an acceleration command signal indicating that the acceleration of the three acceleration waveforms will start at the timing determined in the timing
- the control method of another aspect of the present invention is a control method for controlling the speed of a controlled object, which generates three acceleration command signals that generate three vibrations that are shifted from each other by 1/3 of the period of the natural vibration generated in the controlled object due to the controlled speed, and reduces the natural vibration by executing speed control of the controlled object.
- the natural vibration can be a pendulum vibration.
- the acceleration command signal can be a constant acceleration command signal.
- the drive device is driven at a predetermined timing, making it possible to suppress vibrations in the transported object or the controlled object.
- FIG. 1 is a diagram showing a schematic external configuration of a crane.
- FIG. 2 is a functional block diagram showing the configuration of the control device in the crane according to this embodiment.
- FIG. 3 is a diagram for explaining the principle of the speed change process.
- FIG. 4 is another diagram for explaining the principle of the speed change process.
- FIG. 5 is another diagram for explaining the principle of the speed change process.
- FIG. 6 is a flowchart showing the flow of the speed change process.
- FIG. 7 is a diagram for explaining the rope length L.
- FIG. 8 is a diagram showing an example of an acceleration waveform signal, a drive command signal, and a speed transition.
- FIG. 9 is a diagram showing other examples of acceleration waveform signals, drive command signals, and speed transitions.
- FIG. 8 is a diagram showing an example of an acceleration waveform signal, a drive command signal, and a speed transitions.
- FIG. 9 is a diagram showing other examples of acceleration waveform signals, drive command signals, and speed transitions.
- FIG. 10 is a diagram showing other examples of acceleration waveform signals, drive command signals, and speed transitions.
- FIG. 11 is a diagram showing other examples of acceleration waveform signals, drive command signals, and speed transitions.
- FIG. 12 is a diagram showing an example of speed transition in low-pass filter processing.
- FIG. 13 is a diagram showing other examples of acceleration waveform signals, drive command signals, and speed transitions.
- FIG. 14 is a flow chart showing the flow of the multi-speed speed change process.
- FIG. 15 is a diagram showing an example of an acceleration waveform signal, a drive command signal, and a speed transition in the case of multiple speeds.
- a crane 1 according to an embodiment of the present invention will be described below with reference to the drawings. Note that the crane 1 will be described as an overhead crane that transports a suspended load in a horizontal direction.
- the crane 1 will be described as an overhead crane that transports a suspended load in a horizontal direction.
- Each of the embodiments described below shows a preferred specific example of the present invention.
- the numerical values, components, the arrangement and connection order of the components, the processing order in the flow chart, and the like shown in the following embodiment are merely examples and are not intended to limit the present invention. Also, each figure is not necessarily a precise illustration.
- ⁇ Equipment configuration> 1 is a diagram showing an example of the schematic external configuration of a crane 1.
- the crane 1 is configured to include traveling rails 2, 2 laid in a predetermined direction (e.g., east-west direction) in a horizontal plane of a building ceiling, a girder 4 arranged in a direction perpendicular to the traveling rails 2, 2 (e.g., north-south direction) and supported at both ends by traveling carriages 3, 3 moving on the traveling rails 2, 2, a trolley 5 moving on a lateral rail provided along the girder 4, and an electric hoist 7 arranged on the trolley 5.
- the traveling carriages 3, 3 are provided with traveling motors 3a, 3a, the trolley 5 is provided with a lateral motor 5a, and the electric hoist 7 is provided with a lifting motor 6.
- the electric hoist 7 is connected to an operating unit 8 by a cable 9 or the like.
- the operating unit 8 is equipped with push button switches for "east”, “west”, “south”, “north”, "up” and “down”, for example.
- the electric hoist 7 moves (travels) in the east-west direction along the running rails 2, 2 by the running carriages 3, 3, and moves (transverses) in the north-south direction along the transverse rail of the girder 4 by the trolley 5.
- FIG. 1A is a diagram showing an example of the overall schematic configuration of the crane 1
- FIG. 1B is an enlarged view of the operating unit 8. The horizontal and up/down pushbutton switches will continue to operate if pressed and held down, and will stop operating if released and the switch is no longer pressed.
- FIG. 2 is a block diagram showing the overall configuration of the control system for the crane 1 in this embodiment.
- the crane 1 has an operation control unit 21 and a movement control unit 22.
- the operation control unit 21 controls the crane 1, and generates control signals for the travel motor 3a, the traverse motor 5a, and the lifting motor 6 of the electric hoist 7 based on operation input from the operation unit 8.
- the operation control unit 21 is located in a control box (not shown) of the crane 1.
- the operation control unit 21 has a control unit 31 and a memory unit 32.
- the control unit 31 is composed of a CPU (Central Processing Unit), a memory section (ROM (Read Only Memory), RAM (Random Access Memory), non-volatile memory, etc.), and other elements including hardware.
- the control unit 31 executes a control program stored in the memory unit 32 to control the entire crane 1 and to execute a speed change process, which will be described later.
- the control unit 31 functions as a detection unit 41, an acceleration waveform determination unit 42, a timing determination unit 43, an acceleration command signal generation unit 44, and a drive control unit 45.
- the operations of the detection unit 41 to the drive control unit 45 will be described later.
- the memory unit 32 is composed of memory parts (ROM, RAM, non-volatile memory, etc.) and stores the above-mentioned control application programs and various data required for their execution.
- the movement control unit 22 of the horizontal movement device is configured with a travel inverter 52 that outputs drive power for the travel motor 3a and a traverse inverter 53 that outputs drive power for the traverse motor 5a based on the control signal of the operation control unit 21, and the electric hoist 7 is configured with a lift inverter 54 that outputs drive power for the lift motor 6 and a lift control unit 51 that outputs a motor drive signal to the lift inverter 54.
- the motor is not limited to an electric motor, but may be a pneumatic motor, a hydraulic motor or any other type of prime mover, and may be any power device with a variable speed function that can be controlled by an acceleration command or a speed command.
- the travel inverter 52 and the traverse inverter 53 are devices that convert power from an AC or DC power source based on the control signal (speed command) of the operation control unit 21 and supply power to drive the travel motor 3a and traverse motor 5a, which are three-phase induction motors, and correspond to power conversion devices.
- the traveling inverter 52 outputs driving power for the traveling motor 3a based on a driving command signal from the operation control unit 21.
- the traveling carts 3, 3 move, for example, in the east-west direction together with the girder 4, the trolley 5, and the electric hoist 7.
- the traverse inverter 53 outputs driving power for the traverse motor 5a based on a driving command signal from the operation control unit 21.
- the trolley 5 moves, for example, in the east-west direction together with the electric hoist 7.
- the lifting control unit 51 is mounted on the electric hoist 7 and outputs a driving command signal to the lifting inverter 54 based on a control signal from the operation unit 8 and/or the operation control unit 21, and the lifting inverter 54 outputs driving power for the lifting motor 6 to drive the electric hoist 7.
- the electric hoist 7 suspends a load with a rope 11, and can raise and lower the load by winding up the rope 11 when driven by the lifting motor 6.
- the lifting motor 6 is equipped with an encoder 71 that can detect the rotation of the lifting motor 6 in order to detect the length of the rope 11.
- ⁇ Principle of vibration suppression for suspended loads> 3 shows, for example, an acceleration waveform P1 consisting of an acceleration A0 in one direction of the traveling direction (in this example, the acceleration in the "east" direction) and an acceleration time Ta applied to the traveling cart 3, and a vibration waveform n1 of the suspended load generated when the traveling motor 3a of the traveling cart 3 is driven by the acceleration waveform P1.
- the acceleration waveform P1 is a rectangular waveform (constant acceleration waveform) that is generally used in the speed control of overhead cranes, and can be expressed by an acceleration A0 and an acceleration time Ta.
- Figure 4 also shows vibration waveforms n2 and n3 that are 120 degrees out of phase with respect to the vibration waveform n1 (1/3 of the vibration period), and the acceleration waveforms P2 and P3 that generate the vibration waveforms n2 and n3.
- the sine waveform portion of the vibration waveform n2 is a waveform that is 120 degrees out of phase with respect to the sine waveform portion of the vibration waveform n1
- the sine waveform portion of the vibration waveform n3 is a waveform that is 120 degrees out of phase with respect to the sine waveform portion of the vibration waveform n1.
- the second acceleration waveform P2 is an acceleration waveform consisting of a negative acceleration A0 (acceleration in the "west” direction in this example) and the same acceleration time Ta as the vibration waveform n1, with the acceleration start timing being time t2, which is 1/6 of the period Tf of the vibration waveform n1 from the acceleration start time t1 of the acceleration waveform P1.
- the third acceleration waveform P3 is an acceleration waveform consisting of a positive acceleration A0 (acceleration in the "east” direction in this example) and acceleration time Ta, with the acceleration start timing being time t3, which is 1/6 of the period Tf of the vibration waveform n1 from the acceleration start time t2 of the acceleration waveform P2.
- acceleration waveforms P1, P2, and P3 have different acceleration directions, the magnitude and time of acceleration are the same (they have the same acceleration waveforms), so the amplitude of the vibration (pendulum vibration of the suspended load) induced by each of them is the same.
- the sine waveform portions of the vibration waveforms n1 to n3 shown in Figure 4 have the same period and amplitude, but are shifted in phase by 120 degrees each, so the waveform W obtained by adding them together has an amplitude of zero when acceleration by the third acceleration waveform P3 ends (time t3 + Ta), as shown in Figure 5.
- acceleration A0 x acceleration time Ta is the acceleration output by the traveling cart 3 (traveling motor 3a) and acceleration time Ta is calculated by dividing the speed difference between the current speed of the traveling cart 3 and the target speed by acceleration A0 (i.e. the time it takes to reach the target speed at acceleration A0), acceleration A0 x acceleration time Ta becomes the target speed, so when the acceleration of acceleration waveform P3 ends, the traveling cart 3 reaches the target speed and enters a constant speed movement state in one direction.
- the traveling cart 3 has been used as an example, but when the trolley 5 moves "south” or “north,” pendulum vibration occurs in the load suspended from the electric hoist 7, which moves horizontally together with the trolley 5.
- the target speed can be achieved while suppressing the vibration of the load.
- the traveling cart 3 and trolley 5, which are driven horizontally are not distinguished from one another, they will be referred to as the horizontal movement device H.
- determining start timings of the three acceleration waveforms so that the phases of the vibration waveforms of the suspended load generated when the horizontal moving device H is driven by each of the three acceleration waveforms are shifted by 1/3; generating an acceleration command signal indicating that the acceleration of the three acceleration waveforms is to start at the determined start timing;
- acceleration waveform P1 is composed of positive acceleration A0 and acceleration time Ta
- acceleration waveform P2 is composed of negative acceleration A0 and acceleration time Ta
- acceleration waveform P3 is composed of positive acceleration A0 and acceleration time Ta.
- acceleration waveform P1 is composed of negative acceleration A0 and acceleration time Ta
- acceleration waveform P2 is composed of positive acceleration A0 and acceleration time Ta
- acceleration waveform P3 is composed of negative acceleration A0 and acceleration time Ta.
- step S12 the lift control unit 51 receives the "up” or “down” operation command from the operation unit 8 and/or various commands and signals from the operation control unit 21, and executes drive control of the electric hoist 7.
- step S13 the control unit 31 starts a pendulum period update process.
- the period Tf is calculated from the rope length L based on the formula (1) and stored in the storage unit 32.
- g is the gravitational acceleration.
- FIG. 7 is a diagram showing rope length L.
- rope length L is calculated by subtracting center of gravity correction value w, which indicates the distance from the bottom of the load to the center of gravity position, from the sum of length k1 of rope 11 obtained from motor rotation speed information acquired by encoder 71, length k2 of the hook of electric hoist 7, which is an accessory, and length k3 from the hook to the load.
- the position of the center of gravity of a suspended load changes depending on the shape of the load. If the load is uniform and predetermined, the center of gravity correction value w can be set as a specified value by default. Also, the operator can input the center of gravity correction value w by visually estimating the distance from the hook to the center of gravity of the load based on the shape of the load, and correct the center of gravity position.
- step S14 when the detection unit 41 detects a change in the target speed command (signal) from the operation unit 8, it stores the time t0 at which the change in the target speed command was detected in the memory unit 32 and updates the target speed stored in the memory unit 32. Specifically, when the detection unit 41 inputs a target speed command from the operation unit 8, it determines whether the target speed indicated therein matches the target speed stored in the memory unit 32, and if they do not match, it stores the target speed indicated by the input target speed command in place of the target speed stored in the memory unit 32.
- the target speed indicated in the target speed command input from the operation unit 8 is a predetermined speed Vm for moving the horizontal movement device H at a constant speed.
- the speed of zero when stopping the horizontal movement device H is stored in the memory unit 32 as the target speed, so it is determined that the two do not match, and the target speed stored in the memory unit 32 is updated to the speed Vm.
- the target speed indicated in the target speed command input from the operation unit 8 is zero.
- the speed Vm is stored in the memory unit 32 as the target speed, so it is determined that the two do not match, and the target speed stored in the memory unit 32 is updated to zero.
- Step S14 corresponds to the target speed update step.
- the acceleration waveform determination unit (acceleration time determination unit) 42 calculates the acceleration time Ta of the three acceleration waveforms P1 to P3 based on the formula (2).
- the acceleration waveform determination unit 42 corresponds to the acceleration time determination unit. In the case of uniform acceleration control, the acceleration waveform can be determined by determining the magnitude of acceleration and the acceleration time.
- the acceleration A0 is the acceleration output by the horizontal movement device H, and is stored in the storage unit 32 as a parameter.
- Acceleration time Ta
- the first acceleration waveform P1 and the third acceleration waveform P3 are waveforms with an acceleration time Ta at an acceleration A0
- the second acceleration waveform P2 is an acceleration waveform obtained by inverting the first acceleration waveform P1 and the third acceleration waveform P3.
- Step S15 corresponds to an acceleration waveform determination step.
- step S16 the timing determination unit 43 determines times t1 to t3, which are the acceleration start timings of the three acceleration waveforms P1 to P3, based on equation (3). These timings are the timings at which the vibration waveform of the pendulum vibration of the suspended load, which is generated when the horizontal movement device H is driven by each of the three acceleration waveforms P1 to P3, is shifted by 1/3 period (120 degrees) of the vibration period Tf.
- t0 is the time when the target speed is updated (step S14).
- t1 is the time indicating the acceleration start timing of the first acceleration waveform P1 (FIG.
- Tf is the period of pendulum oscillation of the suspended load calculated based on equation (1).
- t2 is a time indicating the acceleration start timing of the second acceleration waveform P2, and is a time 1 ⁇ 6 of the period Tf of the vibration waveform n1 that has elapsed from time t1.
- t3 is a time indicating the acceleration start timing of the third acceleration waveform P3, and is a time 1 ⁇ 6 of the period Tf of the vibration waveform n1 that has elapsed from time t2.
- the second acceleration waveform P2 is an inverted acceleration waveform with respect to the first acceleration waveform P1 and the third acceleration waveform P3, and therefore generates an inverted vibration waveform (a vibration waveform shifted by 1/2 period) with respect to the vibration waveform generated by the non-inverted acceleration waveform.
- the vibration waveform n2 generated by the second acceleration waveform P2 is a vibration waveform shifted by 1/3 of the period Tf from the vibration waveforms n1 and n3 (FIG. 4).
- the acceleration start timing of the second acceleration waveform P2 is shifted by a period Tf/6 from the first acceleration waveform P1 and the third acceleration waveform P3.
- Step S16 corresponds to a timing determination step.
- step S17 the first to third acceleration waveforms P1 to P3 are arranged at the acceleration start timing determined in step S16 in an acceleration direction according to the magnitude of the current speed and target speed of the horizontal movement device H to generate an acceleration command signal. If the target speed is faster than the current speed of the horizontal movement device H (target speed > current speed of the horizontal movement device H), the first acceleration waveform P1 is acceleration in the positive direction, the second acceleration waveform P2 is acceleration in the negative direction, and the third acceleration waveform P3 is acceleration in the positive direction.
- the first acceleration waveform P1 is acceleration in the negative direction
- the second acceleration waveform P2 is acceleration in the positive direction
- the third acceleration waveform P3 is acceleration in the negative direction.
- the acceleration waveform can be composed of three time functions f1(t), f2(t), and f3(t) shown below.
- the acceleration command signal generating unit 44 When the acceleration waveform is generated as a function of time in this way, the acceleration command signal generating unit 44 generates an acceleration command signal by adding up the acceleration waveforms P1 to P3 for each time in step S17, and generates a speed command signal, which is a drive command signal, from the acceleration command signal in step S18. In step S19, this is supplied to the travel inverter 52 and the traverse inverter 53.
- the travel inverter 52 and the traverse inverter 53 of the movement control unit 22 output drive power to the travel motor 3a and the traverse motor 5a based on the speed command signal, which is a drive command signal, from the operation control unit 21.
- the horizontal movement device H equipped with the electric hoist 7 is driven in the horizontal direction.
- the acceleration command signal can also be used as a drive command signal, and can be output to the travel inverter 52 and the traverse inverter 53 to control the speed.
- Step S17 corresponds to the acceleration command signal generating step
- steps S18 and S19 correspond to the drive control step.
- step S20 the control unit 31 determines whether or not an emergency stop command has been issued, and if it is determined that an emergency stop command has not been issued, the process returns to step S12 and repeats the same process. If it is determined in step S20 that an emergency stop command has been issued, the control unit 31 executes a process to emergency stop the operation of the crane 1 in step S21, and the drive control of the crane system ends.
- the pendulum period Tf can be calculated in accordance with the fluctuation of the rope length and the acceleration start times t1 to t3 of the acceleration waveforms P1 to 3 can be changed each time. In that case, when the process of changing the movement speed of the horizontal movement device H is completed, the acceleration time may fluctuate, potentially resulting in an error with the target speed, so it is preferable to correct the error.
- an acceleration time Ta is calculated based on equation (2) to determine an acceleration waveform from the speed difference between the current speed (zero speed) of the horizontal movement device H and the target speed Vm (step S15).
- Acceleration start timings t1 to t3 of three acceleration waveforms P1 to P3 are determined based on equation (3) from the timing at which the target speed was updated (step S14) and the period Tf of the pendulum oscillation (step S13) (step S16). Then, as shown on the left side of FIG.
- an acceleration waveform P1 consisting of a positive acceleration A0 (acceleration in the direction in which the horizontal moving device H moves (the "east” direction)) and an acceleration time Ta
- an acceleration waveform P2 consisting of a negative acceleration A0 (acceleration in the direction opposite to the direction in which the horizontal moving device H moves (the "west” direction)) and an acceleration time Ta
- an acceleration waveform P3 consisting of a positive acceleration A0 and an acceleration time Ta are arranged at times t1 to t3, respectively, and the acceleration waveforms P1 to P3 are added together for each time, and an acceleration command signal shown on the left side of FIG. 8B is generated (step S17).
- a speed command signal which is a drive command signal
- the speed command signal (drive command signal) is output to the travel inverter 52 to drive the travel motor 3a, causing the travel carriage 3 (horizontal movement device H) to move horizontally (step S19).
- the stopped traveling cart 3 (horizontal movement device H) is accelerated in the "east” direction and begins to move, reaching a speed of Vm. At time t2, it is accelerated in the "west” direction, decelerating and reaching zero. At time t3, it is accelerated again in the "east” direction, after which the vibration of the suspended load is suppressed and the load moves at a constant speed of a predetermined speed. In addition to suppressing the vibration of the suspended load, the speed of the traveling cart 3 (horizontal movement device H) goes up and down along the way but does not move in reverse, making this speed control ideal for cranes, etc.
- the acceleration time Ta for determining the acceleration waveform is calculated based on equation (2) from the speed difference between the current speed (speed Vm) and the target speed (speed zero) of the horizontal movement device H (step S15).
- the acceleration start timings t1 to t3 of the three acceleration waveforms P1 to P3 are determined based on equation (3) from the timing when the target speed was updated (step S14) and the period Tf of the pendulum oscillation (step S12) (step S16).
- an acceleration waveform P11 consisting of a negative acceleration A0 (acceleration in the "west” direction opposite to the "east” direction in which the horizontal movement device H is moving) and an acceleration time Ta
- an acceleration waveform P12 consisting of a positive acceleration A0 (acceleration in the "east” direction in which the horizontal movement device H is moving) and an acceleration time Ta
- an acceleration waveform P13 consisting of a negative acceleration A0 and an acceleration time Ta are arranged at times t1 to t3, respectively, and the acceleration waveforms P11 to P13 are added together at each time to generate the acceleration command signal shown on the left side of FIG. 8B (step S17).
- a speed command signal which is a drive command signal, is generated from the acceleration command signal (step S18), and the speed command signal (drive command signal) is output to the travel inverter 52 to drive the travel motor 3a, and the travel carriage 3 (horizontal movement device H) stops (step S19).
- the traveling cart 3 moving in the "east” direction is accelerated in the "west” direction, decelerating and reaching a speed of zero.
- acceleration is applied in the "east” direction, increasing the speed and reaching speed Vm.
- acceleration is applied again in the "west” direction, after which the vibration of the suspended load is suppressed and the cart comes to a halt.
- the speed of the traveling cart 3 goes up and down along the way, but it does not run in reverse.
- the acceleration time Ta Since the acceleration time Ta has a relationship based on the equation (2) with the speed difference between the current speed and the target speed of the horizontal movement device H and the acceleration A0, the acceleration time Ta becomes longer as the speed difference between the current speed and the target speed of the horizontal movement device H becomes larger. Also, as described above, the period Tf of the pendulum oscillation generated in the load by the drive of the horizontal movement device H by the first to third acceleration waveforms P1 to P3 is determined by the rope length L based on the equation (1), so the period Tf becomes shorter as the rope length L becomes shorter. Therefore, depending on these conditions, the first to third acceleration waveforms P1 to P3 may overlap each other, as shown in Figures 9 and 10.
- the start time t2 of the second acceleration waveform P2 is a time before the acceleration end time (t1+Ta) of the first acceleration waveform P1.
- the acceleration waveform signals of the first to third acceleration waveforms P1, P2, and P3 shown in Figure 9A which are arranged at their respective start times t1 to t3, are added together for each time to generate the acceleration command signal shown in Figure 9B, and the speed command signal shown in Figure 9C, which is a drive command signal, is generated based on the acceleration command signal.
- the start time t2 of the second acceleration waveform P2 and the start time t3 of the third acceleration waveform P3 are before the acceleration end time (t1+Ta) of the first acceleration waveform P1.
- an acceleration command signal shown in FIG. 10B is generated, and a speed command signal, which is a drive command signal, shown in FIG. 10C is generated based on the acceleration command signal.
- a stopped horizontal movement device H is moved at a constant speed, apparent acceleration in one direction is performed three times at a predetermined timing, and deceleration, which is acceleration in the opposite direction, is not performed (left side of FIG. 10C).
- apparent deceleration is performed three times at a predetermined timing, and no acceleration is performed (right side of FIG. 10C).
- the acceleration waveforms in the examples of Figures 8 to 10 have been described as rectangular waves indicating a constant acceleration command, but the acceleration waveform is not limited to a rectangular wave.
- Figure 11 shows an example other than a rectangular wave.
- the example shown on the left side of Figure 11 shows an example of an acceleration waveform that is trapezoidal (constant jerk), and the example shown on the right side of Figure 11 shows an example of an acceleration waveform that is split.
- the acceleration waveform may also be a curved waveform (not shown).
- a low-pass filter or the like can be used as a filter to remove minute vibrations.
- the low-pass filter may perform low-pass filtering on the drive command signal that the drive control unit 45 gives to the traveling inverter 52 and the traverse inverter 53, or may perform low-pass filtering before adding up the acceleration waveforms.
- the speed command before this low-pass filtering is shown in FIG. 12A, and the speed command after the low-pass filtering is shown in FIG. 12B.
- Such low-pass filtering can also be added to further improve the vibration suppression effect.
- the second acceleration waveform P2 starts accelerating at time t2, which is 1/3 of the period Tf of the vibration waveform n1 from the acceleration start time t1 of the first acceleration waveform P1.
- the third acceleration waveform P3 starts accelerating at time t3, which is 1/3 of the period Tf of the vibration waveform n1 from the acceleration start time t2 of the second acceleration waveform P2.
- the first to third acceleration waveforms P1, P2, and P3 shown in FIG. 13 are all acceleration waveforms in the same direction, so each acceleration time is set to 1/3 of Ta so that the speed of the horizontal movement device H at the end of the acceleration of the third acceleration waveform P3 becomes the target speed Vm.
- the vibration waveforms n1 to n3 shown in FIG. 13 are also shifted in phase by 120 degrees, so the amplitude of the combined waveform becomes zero when acceleration by the third acceleration waveform P3 ends.
- FIG. 13B shows an acceleration command signal obtained by adding up the acceleration waveforms P1 to P3 in FIG. 13A for each time
- FIG. 13C shows a speed command signal (drive command signal) generated based on the acceleration command signal.
- the first acceleration waveform P1 is composed of a positive acceleration A0 and an acceleration time Ta/3
- the second acceleration waveform P2 is composed of a positive acceleration A0 and an acceleration time Ta/3
- the third acceleration waveform P3 is composed of a positive acceleration A0 and an acceleration time Ta/3.
- the first acceleration waveform P1 is composed of negative acceleration A0 and acceleration time Ta/3
- the second acceleration waveform P2 is composed of negative acceleration A0 and acceleration time Ta/3
- the third acceleration waveform P3 is composed of negative acceleration A0 and acceleration time Ta/3.
- Steps S50 to S53 and steps S55 to S62 are similar to steps S11 to S13 and steps S14 to S21 in FIG. 7, so their explanation will be omitted.
- the operator presses the first stage of the horizontal push button switch and the up/down push button switch on the operation unit 8 to enter the low speed state, and then presses the second stage to change from low speed to high speed.
- FIG. 15 shows an example in which the horizontal movement device H is controlled at two speed stages, "low speed” and "high speed".
- the leftmost part of FIG. 15 shows a signal when the horizontal movement device H in a stopped state is moved at a constant speed of "low speed”.
- the center part of FIG. 15 shows a signal when the horizontal movement device H, which is moving at a constant speed at "low speed”, is moved at a constant speed of "high speed”.
- the first to third acceleration waveforms P11, P21, and P31 of Ta1 which have short acceleration times, are placed at the respective start times t11 (t1), t21 (t2), and t31 (t3), and are added up for each time to generate the acceleration command signal shown in FIG. 15B, and the speed command signal (drive command signal) shown in FIG. 15C is generated.
- the first to third acceleration waveforms P12, P22, and P32 of Ta2 which have a long acceleration time, are arranged at the start times t12 (t1), t22 (t2), and t32 (t3), respectively, and are summed up at each time to generate the acceleration command signal shown in FIG. 15B, and the speed command signal (drive command signal) shown in FIG. 15C is generated. Even in such a case, the target speed can be obtained with the vibration of the suspended load suppressed.
- the right end of FIG. 15 shows an acceleration waveform signal when stopping the horizontal moving device H during a "high speed" constant speed movement.
- the acceleration time Ta3 represents the acceleration (deceleration) time required for the horizontal moving device H to move from "high speed” to "stop” (zero speed) with a negative acceleration A0.
- the first to third acceleration waveforms P13, P23, and P33, whose acceleration time is Ta3, are placed at their respective start times t13 (t1), t23 (t2), and t33 (t3), and are added up at each time to generate the acceleration command signal shown in FIG. 15B, and the speed command signal (drive command signal) shown in FIG. 15C.
- start times of the acceleration waveforms are set based on the time when the speed change command is detected, so start times t11, t12, and t13 correspond to start time t1, start times t21, t22, and t23 correspond to start time t2, and start times t31, t32, and t33 correspond to start time t3.
- step S54 the detection unit 41 determines whether or not a speed change process is in progress. Specifically, at the timing when the detection unit 41 detects a change in the target speed command, the detection unit 41 determines whether the acceleration by the third acceleration waveform P3 in the ongoing speed change process to the pre-change target speed has not ended (speed change process in progress) or has ended (speed change process ended). That is, in step S54, if the current time is greater than the time (t3+Ta) at which acceleration by the third acceleration waveform P3 ends, the detection unit 41 determines NO, and proceeds to step S55 to execute the same process as that from step S14 onward in FIG. 7, which updates the update time t0.
- step S63 target speed changes are not performed during speed change processing, but are permitted as an exception from step S63 onwards. Specifically, if it is determined in step S54 that speed change processing is in progress (YES), that is, if it is determined that the time (t1) at which acceleration by the first acceleration waveform P1 starts ⁇ current time ⁇ time at which acceleration by the third acceleration waveform P3 ends (t3 + Ta), the process proceeds to step S63, where the detection unit 41 determines whether the target speed change is to "stop” during speed change processing from “stop” to "low speed”, the target speed change is to "stop” during speed change processing from "stop” to "high speed”, or the target speed change is to "stop” during speed change processing from "low speed” to “high speed”.
- step S63 the process proceeds to step S66, where the detection unit 41 determines whether the target speed is changed to "low speed” during the speed change process from "high speed” to "stop", or whether the target speed is changed to "high speed” during the speed change process from "stop” to “low speed”. If the answer is YES in step S66, the detection unit 41 determines in step S67 whether the current time is before the acceleration end time (t1+Ta) of the first acceleration waveform P1 and before the acceleration start time t2 of the second acceleration waveform P2 in the speed change process being executed.
- step S66 the process proceeds to step S69, where the detection unit 41 determines whether the target speed is being changed to "low speed” during the speed change process from "high speed” to "stop". If the answer is YES in step S69, the process proceeds to step S70, where the acceleration time (corrected acceleration time Tas) required to change the speed from "high speed” to "low speed” is calculated, and the process proceeds to step S71.
- step S71 the detection unit 41 determines whether the current time is before the start time t2 of the second acceleration waveform P2 and before the acceleration end time (t1+Tas) of the changed first acceleration waveform P1. If the answer is YES in step S71, the process proceeds to step S68 and the same process as described above is executed.
- step S59 even if the speed command (signal) from the operation unit 8 is changed, vibration suppression control continues based on the command (signal) before the change until the time (t3+Ta) when execution of the third acceleration waveform P3 ends.
- Examples of use other than as a crane The above embodiment has been described as an example of suppressing and controlling the vibration of a load suspended from a crane 1, using an overhead crane as an example, but the present invention is not limited to vibration control of a load suspended from an overhead crane.
- the present invention can be applied to vibration control of a moving object that generates simple harmonic motion, such as an XY table of a processing machine, which is equipped with perpendicular running rails and traverse rails and can move to any position on the XY plane.
- the present invention can be applied to vibration control of a transport cart that runs while suspending a load, or to vibration control of a device that is not limited to a suspended load and that induces a natural vibration with a long period compared to the acceleration time when driven.
- the operation control unit 21 controls the speed of the drive device that moves the horizontal movement device from which the load is suspended in the horizontal direction based on the acceleration command signal.
- a detection unit 41 which is a target speed update unit that detects a target speed change command for changing a target speed of the horizontal moving device H and updates the target speed
- an acceleration waveform determination unit 42 that determines first to third acceleration waveforms for generating an acceleration command signal based on a speed difference between the target speed updated by the detection unit 41 and the current speed of the horizontal movement device H
- a timing determination unit 43 that determines the start timings of three acceleration waveforms so that the phases of the vibration waveforms of the suspended load generated when the horizontal movement device H is driven by each of the three acceleration waveforms determined by the acceleration waveform determination unit 42 are shifted by 1/3
- an acceleration command signal generating unit 44 that generates an acceleration waveform signal indicating that the acceleration of the three acceleration waveforms starts at the timing determined by the timing determining unit
- a drive control unit 45 for controlling the speed of the drive device
- the control unit 31 is configured to generate a drive command signal for driving the horizontal movement device H at each of the above-mentioned timings, and by driving the horizontal movement device H with that drive command signal, it is possible to move the horizontal movement device H and the suspended load at the target speed while reliably suppressing the vibration of the suspended load.
- the drive control unit 45 can add up the acceleration waveform signals at each time to generate an acceleration command signal ( Figure 8B) and drive the horizontal movement device H based on the acceleration command signal.
- the timing determination unit 43 determines that the time t1, which is the start timing of the first acceleration waveform, corresponds to the time when the detection unit 41 detects a change in the target speed,
- the time t2, which is the start timing of the second acceleration waveform is set to the time when 1/6 of the period of the vibration waveform of the suspended load generated when the horizontal movement device H is driven by the first acceleration waveform has elapsed from the time t1
- the time t3, which is the start timing of the third acceleration waveform is set to the time when 1/6 of the period of the vibration waveform of the suspended load generated when the horizontal movement device H is driven by the first acceleration waveform has elapsed from the time t2
- the acceleration waveform determination unit 42 determines the first to third acceleration waveforms as uniform acceleration waveforms and an acceleration time from the target speed, generates the first acceleration waveform from a time function f1(t), generates the second acceleration waveform from a time function f2(t), and generates the third acceleration waveform from a
- f3(t) ⁇ A0 square wave.
- the timing determination unit 43 The first time t1, which is the start timing of the first acceleration waveform, is set to the time t1 corresponding to the timing when the detection unit 41 detects a change in the target speed, the second time t2, which is the start timing of the second acceleration waveform, is set to the time when 1/3 of the period of the vibration waveform of the suspended load generated when the horizontal movement device H is driven by the first acceleration waveform has elapsed from time t1, and the third time t3, which is the start timing of the third acceleration waveform, is set to the time when 1/3 of the period of the vibration waveform of the suspended load generated when the horizontal movement device H is driven by the first acceleration waveform has elapsed from time t2.
- the composite acceleration and composite speed will never exceed the maximum acceleration of the device's reference acceleration pattern, will never exceed the target speed, and will never reverse direction (a speed negative to the target speed).
- Two target speeds, high and low, are provided, and if the detection unit 41 detects a change in the target speed of the horizontal movement device H before the acceleration by the third acceleration waveform is completed, the detection unit 41 is able to not update the target speed.
- Two target speeds, high and low, are provided, and the detection unit 41 can stop not updating the target speed and update the target speed under certain conditions.
- Two target speeds, a high speed and a low speed are provided,
- a command to change the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a low speed is completed
- a command to change the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a high speed is completed
- a command to change the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from a low speed to a high speed
- the detection unit 41 stores a stop command time ts corresponding to the time when the target speed change command to set the target speed to zero was detected, and updates the target speed.
- the horizontal movement device H is a horizontal movement device H that drives the traveling motor 3a and the traverse motor 5a using a traveling inverter 52 and a traverse inverter 53,
- the control unit 31 supplies the generated drive command signal to the traveling inverter 52 and the traverse inverter 53 to drive the horizontal movement device H.
- This configuration allows the drive control of the horizontal movement device H, which is driven by the travel inverter 52 and the traverse inverter 53.
- the acceleration waveform is a rectangular waveform or a trapezoidal waveform ( Figures 8 to 12).
- This configuration makes it possible to suppress the swaying of the suspended load based on a wide variety of waveforms.
- the crane 1 can have an operation control unit 21. In this way, the swaying of the load suspended by the crane 1 can be suppressed.
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
Description
本発明は、ロープなどで吊り下げられた搬送物の振動を抑制する制御装置および制御方法に関する。クレーンなどに、吊り下げられた搬送物に生ずる振り子振動などの長周期の振動を抑制する制御技術に関する。 The present invention relates to a control device and a control method for suppressing vibrations of a transported object suspended by a rope or the like, and to a control technology for suppressing long-period vibrations, such as pendulum vibrations, that occur in a transported object suspended by a crane or the like.
クレーンの吊荷は振り子振動することが知られており、搬送の障害となっていて、振り子振動を抑制する各種制振制御方法が提案されている。振動を抑制するには、振動の発生を抑えるためのS字カーブやローパスフィルタを用いた速度曲線など、滑らかに動作させる方法の他に、振れ角を検出またはシミュレートするなどして把握し、逆位相の振動を加えるようにする方法や、ノッチフィルタ方式による制振制御方法などが提案されている。 It is known that the load suspended by a crane will oscillate in a pendulum motion, which is an obstacle to transportation, and various vibration control methods have been proposed to suppress the pendulum motion. In addition to methods for smoothing the operation, such as an S-curve to suppress the generation of vibration or a speed curve using a low-pass filter, methods that have been proposed for suppressing the vibration include a method of detecting or simulating the swing angle and applying vibration of the opposite phase, and a vibration control method using a notch filter.
例えば、特許文献1は、運動方程式やラプラス変換等、高度な制御を駆使して制振制御を行う制振制御方法を提案している。
For example,
上記特許文献1に記載の制振制御方法は、運動方程式やラプラス変換等、高度な制御を駆使して制振制御を行っており、その結果、制御装置が複雑になり、しかも制振制御に時間を要している。
The vibration control method described in
本発明は、かかる問題に鑑みてなされたものであり、より容易に搬送物の揺れを小さくして、かつ自動的に最適なタイミングで、加速減速を行うことで、搬送物の振動を小さくし、また、操作者の技量によらず、搬送物の振動を抑制しようとするものである。 The present invention was made in consideration of these problems, and aims to reduce the shaking of the transported object more easily, and to automatically accelerate and decelerate at the optimal timing, thereby reducing the vibration of the transported object and suppressing the vibration of the transported object regardless of the skill of the operator.
本発明の一側面の制御装置は、吊荷が吊り下げられた水平移動装置を水平方向に移動する駆動装置を、加速指令信号に基づいて速度制御する制御装置において、駆動装置の目標速度を変更する目標速度変更指令を検出して目標速度を更新する目標速度更新部と、目標速度更新部により更新された目標速度と駆動装置の現在の速度との速度差から、加速指令信号を生成するための第1加速波形と第2加速波形と第3加速波形の3個の加速波形を決定する加速波形決定部と、3個の加速波形のそれぞれにより駆動装置が駆動した場合に発生する吊荷の振動波形の位相が1/3ずつずれるように、3個の加速波形の開始タイミングを決定するタイミング決定部と、3個の加速波形の加速が、タイミング決定部により決定されたタイミングで開始することを示す加速指令信号を生成する加速指令信号生成部と、加速指令信号に基づいて駆動指令信号を生成し駆動装置を駆動する駆動制御部とを有することを特徴とする。 A control device according to one aspect of the present invention is a control device that controls the speed of a drive device that moves a horizontal movement device from which a load is suspended in a horizontal direction based on an acceleration command signal, and is characterized by having a target speed update unit that detects a target speed change command to change the target speed of the drive device and updates the target speed, an acceleration waveform determination unit that determines three acceleration waveforms, a first acceleration waveform, a second acceleration waveform, and a third acceleration waveform, for generating an acceleration command signal from the speed difference between the target speed updated by the target speed update unit and the current speed of the drive device, a timing determination unit that determines the start timing of the three acceleration waveforms so that the phases of the vibration waveform of the load generated when the drive device is driven by each of the three acceleration waveforms are shifted by 1/3, an acceleration command signal generation unit that generates an acceleration command signal indicating that the acceleration of the three acceleration waveforms will start at the timing determined by the timing determination unit, and a drive control unit that generates a drive command signal based on the acceleration command signal to drive the drive device.
加速指令信号生成部は、3個の加速波形を時刻ごとに合算して加速指令信号を生成することができる。 The acceleration command signal generation unit can generate an acceleration command signal by adding up the three acceleration waveforms for each time.
タイミング決定部は、第1加速波形の開始タイミングである第1の時刻t1を、目標速度更新部が目標速度の変更指令を検出したタイミングに対応する時刻とし、第2加速波形の開始タイミングである第2の時刻t2を、第1の時刻t1から、第1加速波形により駆動装置が駆動した場合に発生する吊荷の振動波形の周期の1/6の時間が経過した時刻とし、第3加速波形の開始タイミングである第3の時刻t3を、第2の時刻t2から、第1加速波形により駆動装置が駆動した場合に発生する吊荷の振動波形の周期の1/6の時間が経過した時刻とし、
加速波形決定部は、
第1~3加速波形を所定の加速度A0とする等加速度波形とし、目標速度から加速時間Taを決定し、第1加速波形を時間関数f1(t)から生成し、第2加速波形を時間関数f2(t)から生成し、第3加速波形を時間関数f3(t)から加速波形信号を生成し、
目標速度が現在の速度より速い場合、
時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=-A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=A0の矩形波であり、
目標速度が現在の速度より遅い場合、
時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=-A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=-A0の矩形波であることができる。
the timing determination unit determines the first time t1, which is the start timing of the first acceleration waveform, to be the time corresponding to the timing when the target speed update unit detects a command to change the target speed, the second time t2, which is the start timing of the second acceleration waveform, to be the time when 1/6 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the first acceleration waveform has elapsed from the first time t1, and the third time t3, which is the start timing of the third acceleration waveform, to be the time when 1/6 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the first acceleration waveform has elapsed from the second time t2;
The acceleration waveform determination unit includes:
The first to third acceleration waveforms are set as uniform acceleration waveforms with a predetermined acceleration A0, an acceleration time Ta is determined from a target speed, the first acceleration waveform is generated from a time function f1(t), the second acceleration waveform is generated from a time function f2(t), and the third acceleration waveform is generated from a time function f3(t),
If the target speed is faster than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
For t1≦t≦t1+Ta, f1(t)=A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
For t2≦t≦t2+Ta, f2(t)=-A0, which is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
For t3≦t≦t3+Ta, f3(t)=A0 is a square wave.
If the target speed is slower than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
For t1≦t≦t1+Ta, f1(t)=-A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
For t2≦t≦t2+Ta, f2(t)=A0 is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
For t3≦t≦t3+Ta, f3(t)=−A0 square wave.
タイミング決定部は、
第1加速波形の開始タイミングである第1の時刻t1を、目標速度更新部が目標速度の変更指令を検出したタイミングに対応する時刻とし、第2加速波形の開始タイミングである第2の時刻t2を、第1の時刻t1から、第1加速波形により駆動装置が駆動した場合に発生する吊荷の振動波形の周期の1/3の時間が経過した時刻とし、第3加速波形の開始タイミングである第3の時刻t3を、第2の時刻t2から、第2加速波形により駆動装置が駆動した場合に発生する吊荷の振動波形の周期の1/3の時間が経過した時刻とし、
加速波形決定部は、
第1~3加速波形を所定の加速度A0とする等加速度波形とし、目標速度から加速時間Taを決定し、
第1加速波形を時間関数f1(t)から生成し、第2加速波形を時間関数f2(t)から生成し、第3加速波形を時間関数f3(t)から加速波形を生成し、
目標速度が現在の速度より速い場合、
時間関数f1(t)は、
t<t1、t>t1+Ta/3では、f1(t)=0、
t1≦t≦t1+Ta/3では、f1(t)=A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Ta/3では、f2(t)=0、
t2≦t≦t2+Ta/3では、f2(t)=A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Ta/3では、f3(t)=0、
t3≦t≦t3+Ta/3では、f3(t)=A0の矩形波であり、
目標速度が現在の速度より遅い場合、
時間関数f1(t)は、
t<t1、t>t1+Ta/3では、f1(t)=0、
t1≦t≦t1+Ta/3では、f1(t)=-A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Ta/3では、f2(t)=0、
t2≦t≦t2+Ta/3では、f2(t)=-A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Ta/3では、f3(t)=0、
t3≦t≦t3+Ta/3では、f3(t)=-A0の矩形波であることができる。
The timing determination unit is
The first time t1, which is the start timing of the first acceleration waveform, is set to the time corresponding to the timing when the target speed update unit detects a command to change the target speed, the second time t2, which is the start timing of the second acceleration waveform, is set to the time when 1/3 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the first acceleration waveform has elapsed from the first time t1, and the third time t3, which is the start timing of the third acceleration waveform, is set to the time when 1/3 of the period of the vibration waveform of the suspended load generated when the drive device is driven by the second acceleration waveform has elapsed from the second time t2.
The acceleration waveform determination unit includes:
The first to third acceleration waveforms are set to a constant acceleration waveform with a predetermined acceleration A0, and an acceleration time Ta is determined from a target speed;
A first acceleration waveform is generated from a time function f1(t), a second acceleration waveform is generated from a time function f2(t), and a third acceleration waveform is generated from a time function f3(t);
If the target speed is faster than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta/3, f1(t)=0,
When t1≦t≦t1+Ta/3, f1(t)=A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta/3, f2(t)=0.
When t2≦t≦t2+Ta/3, f2(t)=A0 is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta/3, f3(t)=0.
For t3≦t≦t3+Ta/3, f3(t)=A0 is a square wave.
If the target speed is slower than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta/3, f1(t)=0,
When t1≦t≦t1+Ta/3, f1(t)=-A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta/3, f2(t)=0.
When t2≦t≦t2+Ta/3, f2(t)=−A0, which is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta/3, f3(t)=0.
For t3≦t≦t3+Ta/3, f3(t)=−A0 square wave.
また、高速と低速の2段の目標速度が設けられており、目標速度更新部は、第3加速波形による加速が完了するまでの間に、駆動装置の目標速度変更指令を検出した場合、目標速度を更新しないことができる。 In addition, two target speeds, high and low, are provided, and the target speed update unit is able to not update the target speed if it detects a command to change the target speed of the drive unit before acceleration by the third acceleration waveform is completed.
目標速度更新部は、所定の条件の下では、目標速度を更新しないことを中断し、目標速度を更新することができる。 The target speed update unit can stop not updating the target speed and update the target speed under certain conditions.
高速と低速の2段の前記目標速度が設けられており、
目標速度をゼロから低速に変更するための第3加速波形による加速が完了するまでの間に、目標速度をゼロとする目標速度変更指令を検出した場合、
目標速度をゼロから高速に変更するための第3加速波形による加速が完了するまでの間に、目標速度をゼロとする目標速度変更指令を検出した場合、
または目標速度を低速から高速に変更するための第3加速波形による加速が完了するまでの間に、目標速度をゼロとする目標速度変更指令を検出した場合、
目標速度更新部は、目標速度をゼロとする目標速度変更指令を検出した時刻が第3の時刻t3から加速時間Taを経過していない時刻である場合、目標速度をゼロとする目標速度変更指令を検出した時刻に対応する停止指令時刻tsを記憶し、目標速度をゼロに更新し、
加速波形決定部は、
駆動装置の現在の速度から停止用の修正加速時間Tasを決定し、
t≦ts+Tasではfs(t)=-A0、
t>ts+Tasではfs(t)=0の矩形波となる停止用の修正時間関数fs(t)を生成した後、
時間関数f1(t)を時間関数fs(t)に置き換え、
時間関数f2(t)=0
時間関数f3(t)=0とする
ことができる。
Two target speeds, a high speed and a low speed, are provided,
When a target speed change command for changing the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a low speed is completed,
When a target speed change command for changing the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a high speed is completed,
Or, when a target speed change command for setting the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from a low speed to a high speed is completed,
the target speed update unit, when the time at which the target speed change command for setting the target speed to zero is detected is a time within the acceleration time Ta from the third time t3, stores a stop command time ts corresponding to the time at which the target speed change command for setting the target speed to zero is detected, and updates the target speed to zero;
The acceleration waveform determination unit includes:
determining a corrective acceleration time Tas for stopping from the current speed of the drive;
For t≦ts+Tas, fs(t)=−A0,
After generating a correction time function fs(t) for stopping, which is a square wave with fs(t)=0 when t>ts+Tas,
Replace the time function f(t) with the time function f(t),
Time function f2(t)=0
The time function f3(t) can be set to 0.
駆動装置は、電力変換装置によってモータを駆動し、駆動制御部は、生成した駆動指令信号を、電力変換装置に与えて、駆動装置を駆動させることができる。 The drive device drives the motor using the power conversion device, and the drive control unit can provide the generated drive command signal to the power conversion device to drive the drive device.
加速波形は、矩形波形、または台形波形である、ことができる。 The acceleration waveform can be a square waveform or a trapezoidal waveform.
本発明は、制御装置をクレーンが有することができる。 In the present invention, the crane can have a control device.
本発明の一側面の制御方法は、吊荷が吊り下げられた水平移動装置を水平方向に移動する駆動装置を、加速指令信号に基づいて速度制御する制御装置の制御方法において、駆動装置の目標速度を変更する目標速度変更指令を検出して目標速度を更新する目標速度更新ステップと、目標速度更新ステップにより更新された目標速度と駆動装置の現在の速度との速度差から、加速指令信号を生成するための第1加速波形と第2加速波形と第3加速波形の3個の加速波形を決定する加速波形決定ステップと、加速波形決定ステップで決定された3個の加速波形のそれぞれにより駆動装置が駆動した場合に発生する吊荷の振動波形の位相が1/3ずつずれるように、3個の加速波形の開始タイミングを決定するタイミング決定ステップと、3個の加速波形の加速が、タイミング決定ステップで決定されたタイミングで開始することを示す加速指令信号を生成する加速指令信号生成ステップと、加速指令信号に基づいて駆動指令信号を生成し駆動装置を駆動する駆動制御ステップとを有することを特徴とする。 A control method according to one aspect of the present invention is a control method for a control device that controls the speed of a drive device that moves a horizontal movement device from which a load is suspended in a horizontal direction based on an acceleration command signal, and is characterized by having a target speed update step of detecting a target speed change command that changes the target speed of the drive device and updating the target speed, an acceleration waveform determination step of determining three acceleration waveforms, a first acceleration waveform, a second acceleration waveform, and a third acceleration waveform, for generating an acceleration command signal from the speed difference between the target speed updated in the target speed update step and the current speed of the drive device, a timing determination step of determining the start timing of the three acceleration waveforms so that the phases of the vibration waveform of the load generated when the drive device is driven by each of the three acceleration waveforms determined in the acceleration waveform determination step are shifted by 1/3, an acceleration command signal generation step of generating an acceleration command signal indicating that the acceleration of the three acceleration waveforms will start at the timing determined in the timing determination step, and a drive control step of generating a drive command signal based on the acceleration command signal to drive the drive device.
本発明の他の側面の制御方法は、制御対象の速度を制御する制御方法であって、制御された速度によって制御対象に生じる固有振動の周期の1/3周期ずつ互いにずれた3個の振動を生成する3個の加速指令信号を生成し、制御対象の速度制御を実行することで固有振動を低減することができる。 The control method of another aspect of the present invention is a control method for controlling the speed of a controlled object, which generates three acceleration command signals that generate three vibrations that are shifted from each other by 1/3 of the period of the natural vibration generated in the controlled object due to the controlled speed, and reduces the natural vibration by executing speed control of the controlled object.
固有振動は振り子振動とすることができる。 The natural vibration can be a pendulum vibration.
加速指令信号は等加速度の加速指令信号とすることができる。 The acceleration command signal can be a constant acceleration command signal.
本発明によれば、所定のタイミングで駆動装置を駆動することで、搬送物または制御対象の振動を抑制することができる。 According to the present invention, the drive device is driven at a predetermined timing, making it possible to suppress vibrations in the transported object or the controlled object.
[一実施の形態]
以下に、本発明の一実施の形態に係るクレーン1について、図面を参照しながら説明する。なお、このクレーン1は、水平方向に吊荷を搬送する天井クレーンを例として説明する。以下で説明する実施の形態は、いずれも本発明の好ましい一具体例を示すものである。以下の実施の形態で示される数値、構成要素、構成要素の配置位置および接続形態の順序、フローチャートにおける処理の順序等は、一例であり、本発明を限定する主旨ではない。また、各図は、必ずしも厳密に図示されたものではない。
[One embodiment]
A
<機器構成>
図1は、クレーン1の外観概略構成例を示す図である。クレーン1は、建物天井の水平面内の所定方向(例えば、東西方向)に敷設された走行レール2,2と、走行レール2,2に直交する方向(例えば、南北方向)に配置され、該走行レール2,2上を移動する走行台車3,3に両端を支持されるガーダ4と、ガーダ4に沿って備えられた横行レール上を移動するトロリ5と、トロリ5に配置された電動巻上機7を備えて構成されている。走行台車3,3には走行モータ3a,3aが備えられ、トロリ5には横行モータ5aが備えられ、電動巻上機7には昇降モータ6が備えられている。
<Equipment configuration>
1 is a diagram showing an example of the schematic external configuration of a
クレーン1において、電動巻上機7にはケーブル9等により操作部8が接続されている。この操作部8には、例えば「東」、「西」、「南」、「北」、「上」、「下」の各押釦スイッチが取り付けられている。この「東」、「西」、「南」、「北」の押釦スイッチ(以下、個々に区別する必要がない場合、水平方向押釦スイッチと称する)を操作することにより、電動巻上機7は、走行台車3,3によって走行レール2,2に沿って東西方向に移動(走行)し、トロリ5によってガーダ4の横行レールに沿って南北方向に移動(横行)するようになっている。また、「上」、「下」の押釦スイッチ(以下、個々に区別する必要がない場合、上下方向押釦スイッチと称する)の操作により、ロープ11に取り付けられた荷吊下用フック10に吊り下げられた荷(図示せず)が昇降(巻上下げ)する。なお、図1Aはクレーン1の全体概略構成例を示す図であり、図1Bは操作部8部分の拡大図である。水平方向押釦スイッチおよび上下方向押釦スイッチは押し続ければ動作が継続され、手を放し、スイッチが押されない状態になれば動作が停止するようになっている。
In the
図2は、本実施の形態のクレーン1の制御システムの全体構成を示すブロック図である。クレーン1は、操作制御部21、および移動制御部22を有する。操作制御部21は、クレーン1の制御を行うものであり、操作部8からの操作入力に基づいて、走行モータ3a、横行モータ5a、電動巻上機7の昇降モータ6の制御信号を生成する。操作制御部21は、クレーン1の図示しない制御箱内に配置されている。
FIG. 2 is a block diagram showing the overall configuration of the control system for the
操作制御部21は、制御部31および記憶部32を有している。制御部31は、図示は省略するが、CPU(Central Processing Unit)、記憶部位(ROM(Read Only Memory)、RAM(Random Access Memory)、不揮発メモリ等)、ハードウェアを含む、その他の要素から構成される。
The
制御部31は、記憶部32に記憶された制御用プログラムを実行することで、クレーン1全体を制御するとともに、後述する速度変更処理を実行する。速度変更処理を実行する際、制御部31は、検出部41、加速波形決定部42、タイミング決定部43、加速指令信号生成部44、および駆動制御部45として機能する。検出部41~駆動制御部45の動作については後述する。
The
記憶部32は、記憶部位(ROM、RAM、不揮発メモリ等)から構成され、上述した制御用アプリケーションプログラムと、その実行のために必要な各種データを記憶する。
The
水平移動装置の移動制御部22は、操作制御部21の制御信号に基づいて、走行モータ3aの駆動電力を出力する走行インバータ52、横行モータ5aの駆動電力を出力する横行インバータ53を備えて構成され、電動巻上機7は、昇降モータ6の駆動電力を出力する昇降インバータ54と昇降インバータ54にモータ駆動信号を出力する昇降制御部51を備えて構成されている。モータは、電気モータに限らず、空圧モータ、油圧モータあるいは各種原動機であっても良く、加速指令または速度指令などで制御可能な可変速機能を有した動力装置であればよい。走行インバータ52、及び横行インバータ53は、三相誘導モータの走行モータ3a、横行モータ5aを駆動する電力を、操作制御部21の制御信号(速度指令)に基づいて、交流電源または直流電源から電力を変換して供給する装置で、電力変換装置に対応する。
The
走行インバータ52は、操作制御部21からの駆動指令信号に基づいて、走行モータ3aの駆動電力を出力する。それによって、走行台車3,3は、ガーダ4とトロリ5と電動巻上機7と共に、例えば東西方向に移動する。横行インバータ53は、操作制御部21からの駆動指令信号に基づいて、横行モータ5aの駆動電力を出力する。それによって、トロリ5は、電動巻上機7と共に、例えば東西方向に移動する。昇降制御部51は、電動巻上機7に搭載配置され、操作部8および/または操作制御部21からの制御信号に基づき、昇降インバータ54に駆動指令信号を出力し、昇降インバータ54は、昇降モータ6の駆動電力を出力して電動巻上機7を駆動する。
The traveling
電動巻上機7は、ロープ11で吊荷を吊り下げるもので、昇降モータ6の駆動によりロープ11を巻き上げ、吊荷を昇降することができる。昇降モータ6は、ロープ11のロープ長を検出するために昇降モータ6の回転を検出できるエンコーダ71を備えている。
The electric hoist 7 suspends a load with a
<吊荷の振動抑制の原理>
図3は、例えば、走行台車3に加えられる、走行方向の一方方向の加速度A0(この例の場合、「東」方向の加速度とする)と加速時間Taからなる加速波形P1と、その加速波形P1により走行台車3の走行モータ3aを駆動した際に生じる吊荷の振動波形n1を示している。すなわち加速波形P1により走行台車3の速度が加速すると、走行台車3と共に水平移動する電動巻上機7にロープ11により吊下げられた吊荷が揺れ始め、加速波形P1による加速終了のタイミング(時刻t1+Ta)後から正弦波で表す(近似する)ことができる周期Tfの振動波形n1の振動(以下、適宜、振り子振動と称する)が継続する。周期Tfは、電動巻上機7のロープ支持部から、吊荷の重心までの長さ(以下、適宜、ロープ長Lと称する)で決まる。なお、加速波形P1は、天井クレーンの速度制御で一般的に用いられている矩形の波形(等加速度波形)で、加速度A0と加速時間Taで表すことができる。
<Principle of vibration suppression for suspended loads>
3 shows, for example, an acceleration waveform P1 consisting of an acceleration A0 in one direction of the traveling direction (in this example, the acceleration in the "east" direction) and an acceleration time Ta applied to the traveling
図4には、図3に示した加速波形P1と振動波形n1とともに、振動波形n1に対して、位相が120度(振動周期の1/3)ずれた振動波形n2,n3、およびその振動波形n2,n3を発生させる加速波形P2,P3が示されている。振動波形n2の正弦波形部分は、振動波形n1の正弦波形部分に対して位相が120度進んだ波形であり、振動波形n3の正弦波形部分は、振動波形n1の正弦波形部分に対して位相が120度遅れた波形である。 In addition to the acceleration waveform P1 and vibration waveform n1 shown in Figure 3, Figure 4 also shows vibration waveforms n2 and n3 that are 120 degrees out of phase with respect to the vibration waveform n1 (1/3 of the vibration period), and the acceleration waveforms P2 and P3 that generate the vibration waveforms n2 and n3. The sine waveform portion of the vibration waveform n2 is a waveform that is 120 degrees out of phase with respect to the sine waveform portion of the vibration waveform n1, and the sine waveform portion of the vibration waveform n3 is a waveform that is 120 degrees out of phase with respect to the sine waveform portion of the vibration waveform n1.
第2加速波形P2は、加速波形P1の加速開始時刻t1から、振動波形n1の周期Tfの1/6だけ経過した時刻t2を加速の開始タイミングとする、マイナスの加速度A0(この例の場合、「西」方向の加速度)と振動波形n1と同じ加速時間Taからなる加速波形である。第3加速波形P3は、加速波形P2の加速開始時刻t2から、振動波形n1の周期Tfの1/6だけ経過した時刻t3を加速の開始タイミングとする、プラスの加速度A0(この例の場合、「東」方向の加速度)と加速時間Taからなる加速波形である。加速波形P1、P2、P3は、加速の向きは異なっていても、加速の大きさと時間が同じ(加速波形が同じ)なので、それぞれが誘起する振動(吊荷の振り子振動)の振幅は同じとなる。 The second acceleration waveform P2 is an acceleration waveform consisting of a negative acceleration A0 (acceleration in the "west" direction in this example) and the same acceleration time Ta as the vibration waveform n1, with the acceleration start timing being time t2, which is 1/6 of the period Tf of the vibration waveform n1 from the acceleration start time t1 of the acceleration waveform P1. The third acceleration waveform P3 is an acceleration waveform consisting of a positive acceleration A0 (acceleration in the "east" direction in this example) and acceleration time Ta, with the acceleration start timing being time t3, which is 1/6 of the period Tf of the vibration waveform n1 from the acceleration start time t2 of the acceleration waveform P2. Although the acceleration waveforms P1, P2, and P3 have different acceleration directions, the magnitude and time of acceleration are the same (they have the same acceleration waveforms), so the amplitude of the vibration (pendulum vibration of the suspended load) induced by each of them is the same.
図4に示した振動波形n1~n3の正弦波形部分は、周期と振幅が同じで位相がそれぞれ120度ずつずれているので、それらを合算した波形Wは、図5に示すように、第3加速波形P3による加速が終了したタイミング(時刻t3+Ta)で振幅がゼロになる。 The sine waveform portions of the vibration waveforms n1 to n3 shown in Figure 4 have the same period and amplitude, but are shifted in phase by 120 degrees each, so the waveform W obtained by adding them together has an amplitude of zero when acceleration by the third acceleration waveform P3 ends (time t3 + Ta), as shown in Figure 5.
また図4に示した加速波形P1のプラスの加速度A0と加速時間Taを乗算し、加速波形P2のマイナスの加速度A0と加速時間Taを乗算し、そして加速波形P3のプラスの加速度A0と加速時間Taを乗算し、それらを合算すると、加速度A0×加速時間Taとなる。すなわち加速度A0を走行台車3(走行モータ3a)が出力する加速度とし、加速時間Taを、走行台車3の現在の速度から目標速度の速度差を加速度A0で除算して求めると(すなわち加速度A0で目標速度に達するまでの時間とすると)、加速度A0×加速時間Taは目標速度となることから、加速波形P3の加速が終了するタイミングで、走行台車3は目標速度に達して、一方方向の定速移動状態となる。
In addition, multiplying the positive acceleration A0 of acceleration waveform P1 shown in Figure 4 by the acceleration time Ta, multiplying the negative acceleration A0 of acceleration waveform P2 by the acceleration time Ta, and multiplying the positive acceleration A0 of acceleration waveform P3 by the acceleration time Ta, and adding them together, gives acceleration A0 x acceleration time Ta. In other words, if acceleration A0 is the acceleration output by the traveling cart 3 (traveling
ここでは、走行台車3を例として説明したが、トロリ5が「南」、「北」に移動すれば、同様に、トロリ5と共に水平移動する電動巻上機7に吊下げられた吊荷に振り子振動が発生する。トロリ5に対しても同様に加速制御することにより、吊荷の振動が抑制された状態で、目標速度を達成することができる。以下、水平方向に駆動する走行台車3およびトロリ5を、個々に区別しない場合、水平移動装置Hと称する。
Here, the traveling
本実施の形態では、
3個の加速波形のそれぞれにより水平移動装置Hを駆動した場合に発生する吊荷の振動波形の位相が1/3ずれるように、3個の加速波形の開始タイミングを決定し、
3個の加速波形の加速が、決定した開始タイミングで開始することを示す加速指令信号を生成し、
その加速指令信号に基づいて水平移動装置Hを駆動することで、水平移動装置Hと共に移動する吊荷の振動が抑制された状態で、水平移動装置Hが目標速度を達成することができる。
In this embodiment,
determining start timings of the three acceleration waveforms so that the phases of the vibration waveforms of the suspended load generated when the horizontal moving device H is driven by each of the three acceleration waveforms are shifted by 1/3;
generating an acceleration command signal indicating that the acceleration of the three acceleration waveforms is to start at the determined start timing;
By driving the horizontal movement device H based on the acceleration command signal, the horizontal movement device H can achieve the target speed while suppressing vibration of the suspended load moving together with the horizontal movement device H.
なお目標速度が現在の速度より速い場合(目標速度>現在の速度)、図4に示したように、加速波形P1をプラスの加速度A0と加速時間Taで構成し、加速波形P2をマイナスの加速度A0と加速時間Taで構成し、加速波形P3をプラスの加速度A0と加速時間Taで構成する。それらのプラス又はマイナスの加速度A0と加速時間Taを乗算して合算した結果が、加速度A0×加速時間Ta(プラスの速度)とすることで、現在の速度よりその分速い目標速度に達成することができる。 If the target speed is faster than the current speed (target speed > current speed), as shown in Figure 4, acceleration waveform P1 is composed of positive acceleration A0 and acceleration time Ta, acceleration waveform P2 is composed of negative acceleration A0 and acceleration time Ta, and acceleration waveform P3 is composed of positive acceleration A0 and acceleration time Ta. By multiplying and adding up these positive or negative acceleration A0 and acceleration time Ta, the result is acceleration A0 x acceleration time Ta (positive speed), making it possible to achieve a target speed that is faster than the current speed.
一方、目標速度が現在の速度より遅い場合(目標速度<現在の速度)、図4の例とは逆に、加速波形P1をマイナスの加速度A0と加速時間Taで構成し、加速波形P2をプラスの加速度A0と加速時間Taで構成し、加速波形P3をマイナスの加速度A0と加速時間Taで構成する。それらのマイナスまたはプラスの加速度A0と加速時間Taを乗算して合算した結果が、マイナスの加速度A0×加速時間Ta(マイナスの速度)とすることで、現在の速度よりその分遅い目標速度に達成することができる。 On the other hand, if the target speed is slower than the current speed (target speed < current speed), then, contrary to the example in Figure 4, acceleration waveform P1 is composed of negative acceleration A0 and acceleration time Ta, acceleration waveform P2 is composed of positive acceleration A0 and acceleration time Ta, and acceleration waveform P3 is composed of negative acceleration A0 and acceleration time Ta. By multiplying and adding up these negative or positive acceleration A0 and acceleration time Ta, the result is negative acceleration A0 x acceleration time Ta (negative speed), making it possible to achieve a target speed that is slower than the current speed.
<速度変更処理>
次に、上述した原理に基づく速度変更処理を説明する。この例の場合、水平移動装置Hは、1段の速度で等加速度の速度制御により定速移動するものとする。
<Speed change process>
Next, a speed change process based on the above-mentioned principle will be described. In this example, the horizontal moving device H moves at a constant speed by speed control with a constant acceleration at one speed step.
(速度変更処理)
図6のフローチャートを参照して、水平移動装置Hの速度変更処理を説明する。ステップS10において、制御部31は、装置の電源オンを検出すると、ステップS11において、クレーンシステムの起動処理を実行する。
(Speed change process)
The speed change process of the horizontal movement device H will be described with reference to the flow chart of Fig. 6. When the
次に、ステップS12において、昇降制御部51は、操作部8からの「上」、「下」の操作指令および/または操作制御部21からの各種指令・信号を受け、電動巻上機7の駆動制御を実行する。
Next, in step S12, the
次に、ステップS13において、制御部31は、振り子周期更新処理を開始する。ここでは、式(1)に基づいて、ロープ長さLから、周期Tfを算出し、記憶部32に記憶する。gは重力加速度である。
図7は、ロープ長さLを示す図である。図7の例では、ロープ長Lは、エンコーダ71が取得するモータ回転数情報から得られるロープ11の長さk1、付属品である電動巻上機7のフックの長さk2、およびフックから吊荷の長さk3の合計から、吊荷の底部から重心位置までの距離を示す重心補正値wを差し引くことで求められる。
FIG. 7 is a diagram showing rope length L. In the example of FIG. 7, rope length L is calculated by subtracting center of gravity correction value w, which indicates the distance from the bottom of the load to the center of gravity position, from the sum of length k1 of
吊荷の重心位置は、吊荷の形状によって変化する。吊荷が均一で既定である場合は、デフォルトとして、重心補正値wを規定値とすることができる。また、操作者が吊荷の形状から、フックから吊荷の重心までの距離を目測によって、重心補正値wを入力して重心位置を補正するようにすることができる。 The position of the center of gravity of a suspended load changes depending on the shape of the load. If the load is uniform and predetermined, the center of gravity correction value w can be set as a specified value by default. Also, the operator can input the center of gravity correction value w by visually estimating the distance from the hook to the center of gravity of the load based on the shape of the load, and correct the center of gravity position.
ロープ11の巻き上げ、巻き下げ等によりロープ11の長さk1が変わるなど、ロープ長さLが変わる動作がなされると、ロープ長さLが算出され、ステップS13において周期Tfが更新される。
When an action that changes the rope length L is performed, such as winding up or down the
次に、ステップS14において、検出部41は、操作部8からの目標速度指令(信号)の変更を検知した場合、目標速度指令の変更を検出した時刻t0を記憶部32に記憶するとともに、記憶部32に記憶されている目標速度を更新する。具体的には、検出部41は、操作部8から目標速度指令を入力すると、それに示されている目標速度と、記憶部32に記憶されている目標速度が一致するか否かを判定し、一致しない場合、入力した目標速度指令が示す目標速度を、記憶部32に記憶されている目標速度に代えて記憶する。例えば水平移動装置Hが停止している状態で、水平方向押釦スイッチが押された場合、操作部8から入力される目標速度指令に示される目標速度は、水平移動装置Hを定速移動させるための所定の速度Vmである。このタイミングにおいては、記憶部32には、水平移動装置Hを停止させる際の速度ゼロが目標速度として記憶されているので、両者は一致しないと判定され、記憶部32に記憶される目標速度が速度Vmに更新される。また水平方向押釦スイッチが押されて水平移動装置Hが定速移動している状態で、水平方向押釦スイッチから手が離れ、水平方向押釦スイッチが押されてない状態になると、操作部8から入力される目標速度指令に示される目標速度は速度ゼロである。このタイミングにおいては、記憶部32には、速度Vmが目標速度として記憶部32に記憶されているので、両者は一致しないと判定され、記憶部32に記憶される目標速度が速度ゼロに更新される。ステップS14は、目標速度更新ステップに対応する。
Next, in step S14, when the
次に、ステップS15において、加速波形決定部(加速時間決定部)42は、式(2)に基づいて、3個の加速波形P1~P3の加速時間Taを算出する。加速波形決定部42は、加速時間決定部に対応する。等加速度制御の場合、加速の大きさと加速時間を決定することで加速波形を決定することができる。加速度A0は、水平移動装置Hが出力する加速度であり、パラメータとして記憶部32に記憶されている。
加速時間Ta=|水平移動装置Hの現在速度-目標速度|/加速度A0・・・(2)
第1加速波形P1と第3加速波形P3は、加速度A0で加速時間Taの波形となり、第2加速波形P2は、加速度マイナスA0で加速時間Taとなり、第2加速波形P2は、第1加速波形P1と第3加速波形P3を反転した加速波形となっている。ステップS15は、加速波形決定ステップに対応する。
Next, in step S15, the acceleration waveform determination unit (acceleration time determination unit) 42 calculates the acceleration time Ta of the three acceleration waveforms P1 to P3 based on the formula (2). The acceleration
Acceleration time Ta=|Current speed of horizontal moving device H−Target speed|/Acceleration A0 (2)
The first acceleration waveform P1 and the third acceleration waveform P3 are waveforms with an acceleration time Ta at an acceleration A0, and the second acceleration waveform P2 is an acceleration waveform obtained by inverting the first acceleration waveform P1 and the third acceleration waveform P3. Step S15 corresponds to an acceleration waveform determination step.
次にステップS16において、タイミング決定部43は、式(3)に基づいて、3個の加速波形P1~P3の加速開始タイミングである時刻t1~t3を決定する。このタイミングは、3個の加速波形P1~P3のそれぞれにより水平移動装置Hが駆動した場合に発生する吊荷の振り子振動の振動波形が振動周期Tfの1/3周期(120度)ずれるタイミングである。
t1=t0+c
t2=t1+Tf/6
t3=t2+Tf/6
・・・(3)
t0は、目標速度を更新した時刻である(ステップS14)。
t1は、第1加速波形P1の加速開始タイミングを示す時刻であり(図4)、cは、後述するステップS19で水平移動装置Hが駆動されるまでに要する遅れ時間である。ただしこの遅れ時間は吊荷の周期Tfに対し無視できるほど短時間なので以下の説明では無視し、時刻t1は時刻t0と同時刻とする。
Tfは、式(1)に基づいて算出される吊荷の振り子振動の周期である。
t2は、第2加速波形P2の加速開始タイミングを示す時刻であり、時刻t1から振動波形n1の周期Tfの1/6だけ経過した時刻である。
t3は、第3加速波形P3の加速開始タイミングを示す時刻であり、時刻t2から振動波形n1の周期Tfの1/6だけ経過した時刻である。
第2加速波形P2は、第1加速波形P1と第3加速波形P3に対し、反転した加速波形なので、反転しない加速波形により生じる振動波形に対して反転した振動波形(1/2周期ずれた振動波形)が生じる。その結果、第2加速波形P2によって生じる振動波形n2は、振動波形n1、n3とそれぞれ周期Tfの1/3ずれた振動波形となっている(図4)。第2加速波形P2の加速開始タイミングは、第1加速波形P1と第3加速波形P3から周期Tf/6のずれとなっている。ステップS16は、タイミング決定ステップに対応する。
Next, in step S16, the
t1=t0+c
t2=t1+Tf/6
t3=t2+Tf/6
...(3)
t0 is the time when the target speed is updated (step S14).
t1 is the time indicating the acceleration start timing of the first acceleration waveform P1 (FIG. 4), and c is the delay time required until the horizontal movement device H is driven in step S19 described later. However, since this delay time is negligibly short compared to the period Tf of the suspended load, it will be ignored in the following explanation, and time t1 is regarded as the same time as time t0.
Tf is the period of pendulum oscillation of the suspended load calculated based on equation (1).
t2 is a time indicating the acceleration start timing of the second acceleration waveform P2, and is a time ⅙ of the period Tf of the vibration waveform n1 that has elapsed from time t1.
t3 is a time indicating the acceleration start timing of the third acceleration waveform P3, and is a time ⅙ of the period Tf of the vibration waveform n1 that has elapsed from time t2.
The second acceleration waveform P2 is an inverted acceleration waveform with respect to the first acceleration waveform P1 and the third acceleration waveform P3, and therefore generates an inverted vibration waveform (a vibration waveform shifted by 1/2 period) with respect to the vibration waveform generated by the non-inverted acceleration waveform. As a result, the vibration waveform n2 generated by the second acceleration waveform P2 is a vibration waveform shifted by 1/3 of the period Tf from the vibration waveforms n1 and n3 (FIG. 4). The acceleration start timing of the second acceleration waveform P2 is shifted by a period Tf/6 from the first acceleration waveform P1 and the third acceleration waveform P3. Step S16 corresponds to a timing determination step.
ステップS17において、水平移動装置Hの現在速度と目標速度の大小に応じた加速方向に、第1~3加速波形P1~P3を、ステップS16で決定した加速開始タイミングに配置して、加速指令信号を生成する。目標速度が水平移動装置Hの現在速度より速い場合(目標速度>水平移動装置Hの現在速度)、第1加速波形P1はプラス方向の加速、第2加速波形P2はマイナスの方向の加速、第3加速波形P3はプラスの方向の加速となる。目標速度が水平移動装置Hの現在速度より遅い場合(目標速度<水平移動装置Hの現在速度)、第1加速波形P1はマイナスの方向の加速、第2加速波形P2はプラスの方向の加速、第3加速波形P3はマイナスの方向の加速となる。 In step S17, the first to third acceleration waveforms P1 to P3 are arranged at the acceleration start timing determined in step S16 in an acceleration direction according to the magnitude of the current speed and target speed of the horizontal movement device H to generate an acceleration command signal. If the target speed is faster than the current speed of the horizontal movement device H (target speed > current speed of the horizontal movement device H), the first acceleration waveform P1 is acceleration in the positive direction, the second acceleration waveform P2 is acceleration in the negative direction, and the third acceleration waveform P3 is acceleration in the positive direction. If the target speed is slower than the current speed of the horizontal movement device H (target speed < current speed of the horizontal movement device H), the first acceleration waveform P1 is acceleration in the negative direction, the second acceleration waveform P2 is acceleration in the positive direction, and the third acceleration waveform P3 is acceleration in the negative direction.
加速波形は、以下に示す3個の時間関数f1(t)、時間関数f2(t)、および時間関数f3(t)から構成することができる。 The acceleration waveform can be composed of three time functions f1(t), f2(t), and f3(t) shown below.
目標速度が水平移動装置Hの現在速度より速い場合、
時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=A0となる矩形波の第1加速波形P1であり、
時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=-A0となる矩形波の第2加速波形P2であり、
時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=A0となる矩形波の第3加速波形P3である。
If the target speed is faster than the current speed of the horizontal moving device H,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
In the range of t1≦t≦t1+Ta, the first acceleration waveform P1 is a rectangular wave where f1(t)=A0.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
In the range of t2≦t≦t2+Ta, the second acceleration waveform P2 is a square wave where f2(t)=−A0,
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
In the range of t3≦t≦t3+Ta, the third acceleration waveform P3 is a square wave where f3(t)=A0.
目標速度が水平移動装置Hの現在速度より遅い場合、
時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=-A0となる矩形波第1加速波形P1であり、
時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=A0となる矩形波の第2加速波形P2であり、
時間関数f3(t)は、
t<t3、t>t3+Taの区間では、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=-A0となる矩形波第3加速波形P3である。
If the target speed is slower than the current speed of the horizontal moving device H,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
In the range of t1≦t≦t1+Ta, the first acceleration waveform P1 is a rectangular wave where f1(t)=−A0.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
In the range of t2≦t≦t2+Ta, the second acceleration waveform P2 is a square wave where f2(t)=A0.
The time function f3(t) is
In the intervals t<t3 and t>t3+Ta, f3(t)=0.
When t3≦t≦t3+Ta, the third acceleration waveform P3 is a rectangular wave where f3(t)=−A0.
このように加速波形を時間関数で生成すると、加速指令信号生成部44は、ステップS17において、加速波形P1~P3を時刻ごとに合算して加速指令信号を生成し、ステップS18において、加速指令信号から駆動指令信号である速度指令信号を生成し、ステップS19において、走行インバータ52,横行インバータ53に供給する。移動制御部22の走行インバータ52、横行インバータ53は、操作制御部21からの駆動指令信号である速度指令信号に基づいて、走行モータ3a、横行モータ5aに駆動電力を出力する。その結果、電動巻上機7を搭載した水平移動装置Hを水平方向に駆動する。なお、加速指令信号を駆動指令信号とすることもでき、走行インバータ52,横行インバータ53に出力して速度制御することも可能である。ステップS17は、加速指令信号生成ステップに対応し、ステップS18、S19は、駆動制御ステップに対応する。
When the acceleration waveform is generated as a function of time in this way, the acceleration command
次に、ステップS20において、制御部31は、非常停止の指令があったか否かを判定し、非常停止の指令がないと判定した場合、ステップS12に戻り、同様の処理を繰り返し実行する。ステップS20で、非常停止の指令があったと判定した場合、制御部31は、ステップS21は、クレーン1の動作を非常停止する処理を実行し、クレーンシステムの駆動制御は終了する。
Next, in step S20, the
なお、水平移動装置Hの移動速度を変更する処理中に、電動巻上機が駆動され、ロープ長さLが変動し振り子周期Tfが変動する場合の説明を省略した。クレーンに採用される電動巻上機の速度は遅いので、水平移動装置Hの移動速度を変更する処理中に変動するロープ長さは、振り子周期Tfの変動に与える影響は少ないので無視しても良い。あるいは、同様の理由でロープ長さの変動に合わせ、振り子周期Tfを算出し、加速波形P1~3の加速開始時刻t1~t3を都度変更するようにしても良い。その場合、水平移動装置Hの移動速度を変更する処理が終了したときに、加速時間が変動し、目標速度との誤差が生じる可能性があるので、誤差を修正するようにすることが好ましい。 Note that we have omitted the explanation of the case where the electric hoist is driven during the process of changing the movement speed of the horizontal movement device H, causing the rope length L to fluctuate and the pendulum period Tf to fluctuate. Because the speed of the electric hoist used in the crane is slow, the rope length that fluctuates during the process of changing the movement speed of the horizontal movement device H has little effect on the fluctuation of the pendulum period Tf and can be ignored. Alternatively, for the same reason, the pendulum period Tf can be calculated in accordance with the fluctuation of the rope length and the acceleration start times t1 to t3 of the acceleration waveforms P1 to 3 can be changed each time. In that case, when the process of changing the movement speed of the horizontal movement device H is completed, the acceleration time may fluctuate, potentially resulting in an error with the target speed, so it is preferable to correct the error.
(具体例)
上述した速度制御処理を具体例に基づいて説明する。
停止している状態から、例えば、「東」の押釦スイッチが押されると、水平移動装置Hの現在速度(速度ゼロ)と目標速度である速度Vmの速度差から、加速波形を決定するために式(2)に基づいて、加速時間Taが算出される(ステップS15)。目標速度を更新したタイミング(ステップS14)と振り子振動の周期Tf(ステップS13)から、式(3)に基づいて、3個の加速波形P1~P3の加速開始タイミング時刻t1~t3が決定される(ステップS16)。そして図8Aの左側に示すように、プラスの加速度A0(水平移動装置Hが移動する方向(「東」の方向)の加速度)と加速時間Taからなる加速波形P1、マイナスの加速度A0(水平移動装置Hが移動する方向と反対方向(「西」の方向)の加速度)と加速時間Taからなる加速波形P2、そしてプラスの加速度A0と加速時間Taからなる加速波形P3が、時刻t1~t3に、それぞれ配置されて加速波形P1~P3が時刻ごとに合算され、図8Bの左側に示す加速指令信号が生成される(ステップS17)。
(Specific example)
The above-mentioned speed control process will now be described based on a specific example.
When, for example, the "East" push button switch is pressed from a stopped state, an acceleration time Ta is calculated based on equation (2) to determine an acceleration waveform from the speed difference between the current speed (zero speed) of the horizontal movement device H and the target speed Vm (step S15). Acceleration start timings t1 to t3 of three acceleration waveforms P1 to P3 are determined based on equation (3) from the timing at which the target speed was updated (step S14) and the period Tf of the pendulum oscillation (step S13) (step S16). Then, as shown on the left side of FIG. 8A, an acceleration waveform P1 consisting of a positive acceleration A0 (acceleration in the direction in which the horizontal moving device H moves (the "east" direction)) and an acceleration time Ta, an acceleration waveform P2 consisting of a negative acceleration A0 (acceleration in the direction opposite to the direction in which the horizontal moving device H moves (the "west" direction)) and an acceleration time Ta, and an acceleration waveform P3 consisting of a positive acceleration A0 and an acceleration time Ta are arranged at times t1 to t3, respectively, and the acceleration waveforms P1 to P3 are added together for each time, and an acceleration command signal shown on the left side of FIG. 8B is generated (step S17).
そして、図8Cの左側に示すように、加速指令信号から駆動指令信号である速度指令信号が生成され(ステップS18)、その速度指令信号(駆動指令信号)を走行インバータ52に出力して走行モータ3aを駆動し、走行台車3(水平移動装置H)が水平移動するステップS19)。
Then, as shown on the left side of Figure 8C, a speed command signal, which is a drive command signal, is generated from the acceleration command signal (step S18), and the speed command signal (drive command signal) is output to the
すなわち、はじめに、停止している走行台車3(水平移動装置H)に対して、「東」方向に加速がかけられて動き始め、速度がVmに到達する。時刻t2で、「西」方向に加速がかけられて速度が減速し、速度がゼロに到達する。時刻t3で再度「東」方向に加速がかけられた後、吊荷の振動が抑制されて、所定の速度の定速移動状態となる。吊荷の振動が抑制されることの他、走行台車3(水平移動装置H)の速度は途中上下するが逆走しないのでクレーン等には最適な速度制御である。 In other words, first, the stopped traveling cart 3 (horizontal movement device H) is accelerated in the "east" direction and begins to move, reaching a speed of Vm. At time t2, it is accelerated in the "west" direction, decelerating and reaching zero. At time t3, it is accelerated again in the "east" direction, after which the vibration of the suspended load is suppressed and the load moves at a constant speed of a predetermined speed. In addition to suppressing the vibration of the suspended load, the speed of the traveling cart 3 (horizontal movement device H) goes up and down along the way but does not move in reverse, making this speed control ideal for cranes, etc.
また「東」の押釦スイッチが押され続けて水平移動装置Hが「東」方向に速度Vmで定速移動している状態で、「東」の押釦スイッチから手が離れ、「東」の押釦スイッチが押されてない状態になると、水平移動装置Hの現在速度(速度Vm)と目標速度(速度ゼロ)の速度差から、式(2)に基づいて、加速波形決定のための加速時間Taが算出される(ステップS15)。目標速度を更新したタイミング(ステップS14)と振り子振動の周期Tf(ステップS12)から、式(3)に基づいて、3個の加速波形P1~P3の加速開始タイミング時刻t1~t3が決定される(ステップS16)。そして図8Aの右側に示すように、マイナスの加速度A0(水平移動装置Hが移動している「東」方向と反対の「西」方向の加速度)と加速時間Taからなる加速波形P11、プラスの加速度A0(水平移動装置Hが移動している「東」方向の加速度)と加速時間Taからなる加速波形P12、そしてマイナスの加速度A0と加速時間Taからなる加速波形P13が、時刻t1~t3に、それぞれ配置されて、加速波形P11~P13が時刻ごとに合算され、図8Bの左側に示す加速指令信号が生成される(ステップS17)。 In addition, when the "East" push button switch continues to be pressed and the horizontal movement device H is moving in the "East" direction at a constant speed Vm, if the hand is released from the "East" push button switch and the "East" push button switch is no longer pressed, the acceleration time Ta for determining the acceleration waveform is calculated based on equation (2) from the speed difference between the current speed (speed Vm) and the target speed (speed zero) of the horizontal movement device H (step S15).The acceleration start timings t1 to t3 of the three acceleration waveforms P1 to P3 are determined based on equation (3) from the timing when the target speed was updated (step S14) and the period Tf of the pendulum oscillation (step S12) (step S16). Then, as shown on the right side of FIG. 8A, an acceleration waveform P11 consisting of a negative acceleration A0 (acceleration in the "west" direction opposite to the "east" direction in which the horizontal movement device H is moving) and an acceleration time Ta, an acceleration waveform P12 consisting of a positive acceleration A0 (acceleration in the "east" direction in which the horizontal movement device H is moving) and an acceleration time Ta, and an acceleration waveform P13 consisting of a negative acceleration A0 and an acceleration time Ta are arranged at times t1 to t3, respectively, and the acceleration waveforms P11 to P13 are added together at each time to generate the acceleration command signal shown on the left side of FIG. 8B (step S17).
そして図8Cの右側に示すように、加速指令信号から駆動指令信号である速度指令信号が生成され(ステップS18)、その速度指令信号(駆動指令信号)を走行インバータ52に出力して走行モータ3aを駆動し、走行台車3(水平移動装置H)が停止する(ステップS19)。
Then, as shown on the right side of Figure 8C, a speed command signal, which is a drive command signal, is generated from the acceleration command signal (step S18), and the speed command signal (drive command signal) is output to the
すなわち、はじめに、「東」方向に移動している走行台車3に対して、「西」方向に加速がかけられて減速し、速度ゼロに到達する。時刻t2で、「東」方向に加速がかけられて速度が増加し、速度が速度Vmに到達する。時刻t3で再度「西」方向に加速がかけられた後、吊荷の振動が抑制されて、停止状態となる。この場合も、走行台車3(水平移動装置H)の速度は途中上下するが、逆走しない。
In other words, first, the traveling
(加速波形信号の例)
加速時間Taは、水平移動装置Hの現在速度と目標速度の速度差および加速度A0と、式(2)に基づく関係があるため、水平移動装置Hの現在速度と目標速度の速度差が大きくなると加速時間Taは長くなる。また上述したように、第1~3加速波形P1~P3による水平移動装置Hの駆動で吊荷に発生する振り子振動の周期Tfは、式(1)に基づいてロープ長Lで決まるため、ロープ長Lが短くなると周期Tfも短くなる。そのためこれらの条件によっては、図9および図10に示すように、第1~3加速波形P1~P3が重なり合う場合も生じる。
(Example of acceleration waveform signal)
Since the acceleration time Ta has a relationship based on the equation (2) with the speed difference between the current speed and the target speed of the horizontal movement device H and the acceleration A0, the acceleration time Ta becomes longer as the speed difference between the current speed and the target speed of the horizontal movement device H becomes larger. Also, as described above, the period Tf of the pendulum oscillation generated in the load by the drive of the horizontal movement device H by the first to third acceleration waveforms P1 to P3 is determined by the rope length L based on the equation (1), so the period Tf becomes shorter as the rope length L becomes shorter. Therefore, depending on these conditions, the first to third acceleration waveforms P1 to P3 may overlap each other, as shown in Figures 9 and 10.
図9Aの例では、第2加速波形P2の開始時刻t2が、第1加速波形P1の加速終了時刻(t1+Ta)前の時刻になる。この図9Aに示す第1~3加速波形P1、P2、P3をそれぞれの開始時刻t1~t3に配置した加速波形信号を時刻ごとに合算し、図9Bに示す加速指令信号を生成し、加速指令信号に基づき駆動指令信号である図9Cに示す速度指令信号が生成される。 In the example of Figure 9A, the start time t2 of the second acceleration waveform P2 is a time before the acceleration end time (t1+Ta) of the first acceleration waveform P1. The acceleration waveform signals of the first to third acceleration waveforms P1, P2, and P3 shown in Figure 9A, which are arranged at their respective start times t1 to t3, are added together for each time to generate the acceleration command signal shown in Figure 9B, and the speed command signal shown in Figure 9C, which is a drive command signal, is generated based on the acceleration command signal.
図10Aの例では、第2加速波形P2の開始時刻t2および第3加速波形P3の開始時刻t3が、第1加速波形P1の加速終了時刻(t1+Ta)前の時刻になる。この図10Aに示す加速波形信号が時刻ごとに合算されると、図10Bに示す加速指令信号が生成され、加速指令信号に基づき図10Cに示す駆動指令信号である速度指令信号が生成される。この例では、停止状態の水平移動装置Hを定速移動させる場合、所定のタイミングで見かけ上の一方向への加速が3回行われ、反対方向への加速である減速は行われない(図10Cの左側)。同様に、定速移動中の水平移動装置Hを停止させる場合、所定のタイミングで見かけ上の減速が3回行われ、加速は行われない(図10Cの右側)。 In the example of FIG. 10A, the start time t2 of the second acceleration waveform P2 and the start time t3 of the third acceleration waveform P3 are before the acceleration end time (t1+Ta) of the first acceleration waveform P1. When the acceleration waveform signals shown in FIG. 10A are added up at each time, an acceleration command signal shown in FIG. 10B is generated, and a speed command signal, which is a drive command signal, shown in FIG. 10C is generated based on the acceleration command signal. In this example, when a stopped horizontal movement device H is moved at a constant speed, apparent acceleration in one direction is performed three times at a predetermined timing, and deceleration, which is acceleration in the opposite direction, is not performed (left side of FIG. 10C). Similarly, when a horizontal movement device H is stopped during constant speed movement, apparent deceleration is performed three times at a predetermined timing, and no acceleration is performed (right side of FIG. 10C).
図8から図10の例の加速波形は、等加速度指令を示す矩形波の例で説明したが、加速波形は、矩形波に限られない。図11は、矩形波以外の例である。図11の左側に示す例では、加速波形が台形(等加加速度)の例を示しており、図11の右側に示す例では、加速波形が分裂した波形の例を示している。また、加速波形は、図示しない曲線波形であってもよい。 The acceleration waveforms in the examples of Figures 8 to 10 have been described as rectangular waves indicating a constant acceleration command, but the acceleration waveform is not limited to a rectangular wave. Figure 11 shows an example other than a rectangular wave. The example shown on the left side of Figure 11 shows an example of an acceleration waveform that is trapezoidal (constant jerk), and the example shown on the right side of Figure 11 shows an example of an acceleration waveform that is split. The acceleration waveform may also be a curved waveform (not shown).
また、フィルタとして、ローパスフィルタなどを用いて、微細な振動を除去することができる。そのローパスフィルタは、駆動制御部45が走行インバータ52、横行インバータ53に与える駆動指令信号についてローパスフィルタ処理を行ってもよいし、また、加速波形を合算する前にローパスフィルタ処理を行ってもよい。このローパスフィルタ処理を行う前の速度指令を図12Aに、ローパスフィルタ処理を行った後の速度指令を図12Bに示す。このようなローパスフィルタ処理を追加することもでき、制振効果をより高めることができる。
Furthermore, a low-pass filter or the like can be used as a filter to remove minute vibrations. The low-pass filter may perform low-pass filtering on the drive command signal that the
<加速開始タイミングの他の例>
振動波形n1~n3の位相が、それぞれ120度ずれる態様は図4に示した以外にも、図13に示す場合もある。図13に示す速度制御も、図3と同様に等加速度A0の速度制御としている。目標速度Vmが決定したら、加速時間Taを算出する。
<Other examples of acceleration start timing>
In addition to the mode shown in Fig. 4, the phases of the vibration waveforms n1 to n3 are shifted by 120 degrees from each other in the case shown in Fig. 13. The speed control shown in Fig. 13 is also a speed control with a constant acceleration A0, like Fig. 3. Once the target speed Vm is determined, the acceleration time Ta is calculated.
第2加速波形P2は、第1加速波形P1の加速開始時刻t1から、振動波形n1の周期Tfの1/3だけ経過した時刻t2を加速の開始タイミングとする。第3加速波形P3は、第2加速波形P2の加速開始時刻t2から、振動波形n1の周期Tfの1/3だけ経過した時刻t3を加速の開始タイミングとする。図13に示す第1~3加速波形P1、P2、P3の波形は、すべて同じ方向の加速波形としているので、第3加速波形P3の加速が終了した時点の水平移動装置Hの速度が目標速度Vmとなるように、各加速時間をTaの1/3としている。 The second acceleration waveform P2 starts accelerating at time t2, which is 1/3 of the period Tf of the vibration waveform n1 from the acceleration start time t1 of the first acceleration waveform P1. The third acceleration waveform P3 starts accelerating at time t3, which is 1/3 of the period Tf of the vibration waveform n1 from the acceleration start time t2 of the second acceleration waveform P2. The first to third acceleration waveforms P1, P2, and P3 shown in FIG. 13 are all acceleration waveforms in the same direction, so each acceleration time is set to 1/3 of Ta so that the speed of the horizontal movement device H at the end of the acceleration of the third acceleration waveform P3 becomes the target speed Vm.
図13に示した振動波形n1~n3も、それぞれ位相が120度ずつずれているので、それらを合算した波形は、第3加速波形P3による加速が終了したタイミングで振幅がゼロになる。 The vibration waveforms n1 to n3 shown in FIG. 13 are also shifted in phase by 120 degrees, so the amplitude of the combined waveform becomes zero when acceleration by the third acceleration waveform P3 ends.
図13Bは、図13Aの加速波形P1~3を時刻ごとに合算された加速指令信号を表し、図13Cは、加速指令信号を基に生成した速度指令信号(駆動指令信号)を表している。 FIG. 13B shows an acceleration command signal obtained by adding up the acceleration waveforms P1 to P3 in FIG. 13A for each time, and FIG. 13C shows a speed command signal (drive command signal) generated based on the acceleration command signal.
なお目標速度が現在の速度より速い場合(目標速度>現在の速度)、図13Bの左側に示したように、第1加速波形P1をプラスの加速度A0と加速時間Ta/3で構成し、第2加速波形P2をプラスの加速度A0と加速時間Ta/3で構成し、第3加速波形P3をプラスの加速度A0と加速時間Ta/3で構成する。それらのプラスの加速度A0と加速時間Ta/3を乗算して合算した結果が、加速度A0×加速時間Ta(プラスの速度)となるようにすることで、現在の速度よりその分速い目標速度に達成することができる。 If the target speed is faster than the current speed (target speed > current speed), as shown on the left side of Figure 13B, the first acceleration waveform P1 is composed of a positive acceleration A0 and an acceleration time Ta/3, the second acceleration waveform P2 is composed of a positive acceleration A0 and an acceleration time Ta/3, and the third acceleration waveform P3 is composed of a positive acceleration A0 and an acceleration time Ta/3. By multiplying and adding up these positive accelerations A0 and acceleration time Ta/3 to give acceleration A0 x acceleration time Ta (positive speed), a target speed that is faster than the current speed can be achieved.
一方、目標速度が現在の速度より遅い場合(目標速度<現在の速度)、図13Bの右側に示すように、第1加速波形P1をマイナスの加速度A0と加速時間Ta/3で構成し、第2加速波形P2をマイナスの加速度A0と加速時間Ta/3で構成し、第3加速波形P3をマイナスの加速度A0と加速時間Ta/3で構成する。それらのマイナスの加速度A0と加速時間Taを乗算して合算した結果が、マイナスの加速度A0×加速時間Ta(マイナスの速度)とすることで、現在の速度よりその分遅い目標速度に達成することができる。 On the other hand, when the target speed is slower than the current speed (target speed < current speed), as shown on the right side of Figure 13B, the first acceleration waveform P1 is composed of negative acceleration A0 and acceleration time Ta/3, the second acceleration waveform P2 is composed of negative acceleration A0 and acceleration time Ta/3, and the third acceleration waveform P3 is composed of negative acceleration A0 and acceleration time Ta/3. By multiplying and adding up these negative accelerations A0 and acceleration time Ta, the result is negative acceleration A0 x acceleration time Ta (negative speed), making it possible to achieve a target speed that is slower than the current speed.
<複数段速度の対応>
以上においては、定速速度が1段の場合を例として説明したが、2段階で速度を設定できるクレーン1も存在する。
<Supports multiple speeds>
Although the above description has been given of an example in which the constant speed is set to one level, there are also
押釦スイッチを一段押すると「低速」の速度Vl、二段押すと「高速」の速度Vhで水平移動装置Hを等加速度で移動させることができる。押釦スイッチが押されていない状態では、「停止」(速度ゼロ)となる。 Pressing the push button once will move the horizontal movement device H at a "low" speed Vl, and pressing it twice will move it at a "high" speed Vh with constant acceleration. When the push button is not pressed, it will be "stopped" (zero speed).
次に、図14のフローチャートを参照して2段階で速度設定可能な等加速度で速度制御するクレーン1における速度変更処理を説明する。
Next, we will explain the speed change process in
ステップS50~ステップS53、およびステップS55~ステップS62は、図7のステップS11~ステップS13、ステップS14~ステップS21と同様の処理が実行されるのでその説明は省略する。この2段階の速度制御の場合、操作者は、操作部8の水平方向押釦スイッチおよび上下方向押釦スイッチの1段目を押して、低速状態にし、さらに2段目を押すことで、低速から高速状態にすることができる。
Steps S50 to S53 and steps S55 to S62 are similar to steps S11 to S13 and steps S14 to S21 in FIG. 7, so their explanation will be omitted. In the case of this two-stage speed control, the operator presses the first stage of the horizontal push button switch and the up/down push button switch on the
図15は、水平移動装置Hが「低速」と「高速」の2段階の速度で制御される場合の例を示す。図15の左端は、停止状態の水平移動装置Hを「低速」で定速移動させる場合の信号を示す。図15の真ん中は、「低速」で定速移動中の水平移動装置Hを「高速」で定速移動させる場合の信号を示す。水平移動装置Hの出力できる加速度A0が一定であると、「停止」から「低速」の定速移動状態にする場合に、加速時間が短いTa1の第1~3加速波形P11、P21、P31がそれぞれの開始時刻t11(t1)、t21(t2)、t31(t3)に配置され、時刻ごとに合算することで図15Bに示す加速指令信号が生成され、図15Cに示す速度指令信号(駆動指令信号)が生成される。「低速」から「高速」の定速状態にする場合に、加速時間が長いTa2の第1~3加速波形P12、P22、P32がそれぞれの開始時刻t12(t1)、t22(t2)、t32(t3)に配置され、時刻ごとに合算することで図15Bに示す加速指令信号が生成され、図15Cに示す速度指令信号(駆動指令信号)が生成される。このような場合でも、吊荷の振動が抑制された状態で、目標速度を得ることができる。図15の右端は、「高速」の定速移動中の水平移動装置Hを停止させる場合の加速波形信号を示す。加速時間Ta3は、マイナスの加速度A0で水平移動装置Hを「高速」から「停止」(速度ゼロ)に要する加速(減速)時間を表す。加速時間がTa3の第1~3加速波形P13、P23、P33がそれぞれの開始時刻t13(t1)、t23(t2)、t33(t3)に配置され、時刻ごとに合算することで、図15Bに示す加速指令信号が生成され、図15Cに示す速度指令信号(駆動指令信号)が生成される。加速波形の開始時刻は、速度変更指令を検知した時刻を基準に設定されるので、開始時刻t11、t12、t13は、開始時刻t1に対応し、開始時刻t21、t22、t23は、開始時刻t2に対応し、開始時刻t31、t32、t33は、開始時刻t3に対応する。 FIG. 15 shows an example in which the horizontal movement device H is controlled at two speed stages, "low speed" and "high speed". The leftmost part of FIG. 15 shows a signal when the horizontal movement device H in a stopped state is moved at a constant speed of "low speed". The center part of FIG. 15 shows a signal when the horizontal movement device H, which is moving at a constant speed at "low speed", is moved at a constant speed of "high speed". If the acceleration A0 that the horizontal movement device H can output is constant, when changing from a "stopped" to a "low speed" constant speed movement state, the first to third acceleration waveforms P11, P21, and P31 of Ta1, which have short acceleration times, are placed at the respective start times t11 (t1), t21 (t2), and t31 (t3), and are added up for each time to generate the acceleration command signal shown in FIG. 15B, and the speed command signal (drive command signal) shown in FIG. 15C is generated. When moving from a "low speed" to a "high speed" constant speed state, the first to third acceleration waveforms P12, P22, and P32 of Ta2, which have a long acceleration time, are arranged at the start times t12 (t1), t22 (t2), and t32 (t3), respectively, and are summed up at each time to generate the acceleration command signal shown in FIG. 15B, and the speed command signal (drive command signal) shown in FIG. 15C is generated. Even in such a case, the target speed can be obtained with the vibration of the suspended load suppressed. The right end of FIG. 15 shows an acceleration waveform signal when stopping the horizontal moving device H during a "high speed" constant speed movement. The acceleration time Ta3 represents the acceleration (deceleration) time required for the horizontal moving device H to move from "high speed" to "stop" (zero speed) with a negative acceleration A0. The first to third acceleration waveforms P13, P23, and P33, whose acceleration time is Ta3, are placed at their respective start times t13 (t1), t23 (t2), and t33 (t3), and are added up at each time to generate the acceleration command signal shown in FIG. 15B, and the speed command signal (drive command signal) shown in FIG. 15C. The start times of the acceleration waveforms are set based on the time when the speed change command is detected, so start times t11, t12, and t13 correspond to start time t1, start times t21, t22, and t23 correspond to start time t2, and start times t31, t32, and t33 correspond to start time t3.
ステップS54において、検出部41は、速度変更処理中であるか否かを判定する。具体的には、検出部41は、目標速度指令の変更を検出したタイミングにおいて、実行中の変更前の目標速度への速度変更処理における第3加速波形P3による加速が終了していない(速度変更処理中)か、終了している(速度変更処理終了)かを判定する。すなわち、検出部41は、ステップS54において現在時刻>第3加速波形P3による加速が終了する時刻(t3+Ta)ではNOと判定し、ステップS55に進み更新時刻t0を更新する図7のステップS14以降と同様の処理を実行する。
In step S54, the
原則、速度変更処理中の目標速度変更は行わないとするが、ステップS63以降にて例外的に許可するものとする。具体的には、ステップS54において速度変更処理中(YES)と判断された場合、すなわち、第1加速波形P1による加速が開始する時刻(t1)≦現在時刻≦第3加速波形P3による加速が終了する時刻(t3+Ta)と判断された場合、ステップS63に進み、検出部41は、「停止」から「低速」への速度変更処理中の「停止」への目標速度変更か、「停止」から「高速」への速度変更処理中の「停止」への目標速度変更か、または「低速」から「高速」への速度変更処理中の「停止」への目標速度変更であるか、否かを判定する。
In principle, target speed changes are not performed during speed change processing, but are permitted as an exception from step S63 onwards. Specifically, if it is determined in step S54 that speed change processing is in progress (YES), that is, if it is determined that the time (t1) at which acceleration by the first acceleration waveform P1 starts ≦ current time ≦ time at which acceleration by the third acceleration waveform P3 ends (t3 + Ta), the process proceeds to step S63, where the
ステップS63で、YESの場合、ステップS64に進み、検出部41は、目標速度変更を許可し、目標速度をゼロに更新する。そして加速波形決定部42は、以下の式に基づいて停止用の修正加速時間Tasを、現在速度Vcと加速度A0から下記の式により算出する。
Tas=Vc/A0
If the answer is YES in step S63, the process proceeds to step S64, where the
Tas = Vc/A
ステップS65で、加速指令信号生成部44は、算出された停止用の修正加速時間Tasに基づいて、以下の停止用の時間関数fs(t)を生成する。
t≦ts+Tasではfs(t)=-A0、
t>ts+Tasでは、fs(t)=0の矩形波
In step S65, the acceleration command
For t≦ts+Tas, fs(t)=−A0,
For t>ts+Tas, fs(t)=0 square wave
そして加速指令信号生成部44は、第1加速波形P1を示す時間関数f1(t)を停止用時間関数fs(t)で置き換える。すなわち時間関数f1(t)は、
t≦ts+Tasでは、f1(t)=-A0、
t>ts+Tasでは、f1(t)=0の矩形波となる。
Then, the acceleration command
For t≦ts+Tas, f1(t)=−A0,
When t>ts+Tas, f1(t)=0 becomes a square wave.
また加速指令信号生成部44は、第2加速波形P2を示す時間関数f2(t)と第3加速波形P3を示す時間関数f3(t)を以下のように書き換え、
f2(t)=f3(t)=0
次のステップS59に進む。
Further, the acceleration command
f2(t)=f3(t)=0
Proceed to the next step S59.
ステップS63で、NOの場合は、ステップS66に進み、検出部41は、「高速」から「停止」への速度変更処理中の「低速」への目標速度の変更であるか、または「停止」から「低速」の速度変更処理中の「高速」への目標速度の変更であるかを判定する。ステップS66で、YESの場合、ステップS67において、検出部41は、現在時刻が実行中の速度変更処理における第1加速波形P1の加速終了時刻(t1+Ta)前で、かつ第2加速波形P2の加速開始時刻t2前か、否かを判定する。
If the answer is NO in step S63, the process proceeds to step S66, where the
ステップS67で、YESの場合、ステップS68において、検出部41は、目標速度の変更を許可し、目標速度の更新を行う。そして加速波形決定部42は、以下の式に基づいて速度変更用の修正加速時間Tasを、高速Vm2と低速Vm1または停止速度0から下記の式により算出する。
Tas=(Vm2-Vm1または0)/加速度A0
加速波形決定部42は、実行中の速度変更処理で生成した加速時間Taの値を修正加速時間Tasの値に変更し、ステップS58に進む。したがって、ステップS57の加速波形の開始タイミングの決定は実行されないので、時刻t1~t3は修正前の時刻t1~t3を用いてステップS58で加速指令信号を生成する。
If the answer is YES in step S67, in step S68, the
Tas = (Vm2 - Vm1 or 0) / acceleration A0
The acceleration
ステップS66で、NOの場合は、ステップS69に進み、検出部41は、「高速」から「停止」への速度変更処理中の「低速」への目標速度の変更であるか、否かを判定する。ステップS69で、YESの場合、ステップS70に進み、「高速」から「低速」に速度変更するのに要する加速時間(修正加速時間Tas)を算出し、ステップS71に進む。
If the answer is NO in step S66, the process proceeds to step S69, where the
ステップS71で、検出部41は、現在時刻が第2加速波形P2の開始時刻t2前でかつ変更後の第1加速波形P1の加速終了時刻(t1+Tas)前であるか、否かを判定する。ステップS71で、YESの場合は、ステップS68へ進み、前述と同様の処理を実行する。
In step S71, the
ステップS67、S69およびS71で、NOの場合、ステップS59に進み、操作部8からの速度指令(信号)が変更されても、第3加速波形P3の実行が終了する時刻(t3+Ta)まで、変更前の指令(信号)に基づき、制振制御が継続される。
If the answer is NO in steps S67, S69, and S71, the process proceeds to step S59, where even if the speed command (signal) from the
<クレーン以外の利用例>
以上の実施の形態は、天井クレーンを例としたクレーン1に吊り下げられた吊荷の振動を抑制して制振する例で説明したが、本発明は、天井クレーンに吊り下げられた吊荷の制振に限定されるものではない。加工機のXYテーブルなど、直交する走行レールと横行レールを備えて、XY平面上の任意の位置に移動できる装置で単振動を生ずる移動対象物の防振に適用することができる。また、例えば荷を吊り下げて走行する搬送台車あるいは、防振対象は吊下げられた荷に限らず、駆動することにより加速時間と比較して長周期の固有振動が誘起される装置の制振駆動制御に適用できる。
<Examples of use other than as a crane>
The above embodiment has been described as an example of suppressing and controlling the vibration of a load suspended from a
上記の実施の形態では、等加速度波形を中心に説明してきたが、加速度波形は、図11に示すように等加速度波形に限定されない。速度変更する際に、加速波形P1~P3を生成するための基準となる加速波形を時間関数f0(t)とし、
第1加速波形P1の加速開始タイミングを示す時刻:t1
第2加速波形P2の加速開始タイミングを示す時刻:t2=t1+Tf/6
第3加速波形P3の加速開始タイミングを示す時刻:t3=t1+Tf/3
固有振動周期:Tf
第1加速波形P1を示す時間関数:f1(t)
第2加速波形P2を示す時間関数:f2(t)
第3加速波形P3を示す時間関数:f3(t)
とすると、
第1加速波形P1は、f1(t)=f0(t-t1)
第2加速波形P2は、f2(t)=-f0(t-t2)=-f0(t-t1-Tf/6)
第3加速波形P3は、f3(t)=f0(t-t3)=f0(t-t1-Tf/3)
と表され、
第1~3加速波形P1~3を合成した加速指令を時間関数fc(t)とすると、
fc(t)=f1(t)+f2(t)+f3(t)=f0(t-t1)-f0(t-t1-Tf/6)+f0(t-t1-Tf/3)
と表すことができる。
In the above embodiment, the explanation has been given mainly on the constant acceleration waveform, but the acceleration waveform is not limited to the constant acceleration waveform as shown in Fig. 11. When changing the speed, the acceleration waveform serving as a reference for generating the acceleration waveforms P1 to P3 is set as a time function f0(t),
Time indicating the acceleration start timing of the first acceleration waveform P1: t1
Time indicating the acceleration start timing of the second acceleration waveform P2: t2=t1+Tf/6
Time indicating the acceleration start timing of the third acceleration waveform P3: t3=t1+Tf/3
Natural vibration period: Tf
Time function representing the first acceleration waveform P1: f1(t)
Time function representing the second acceleration waveform P2: f2(t)
Time function representing the third acceleration waveform P3: f3(t)
Then,
The first acceleration waveform P1 is f1(t)=f0(t-t1).
The second acceleration waveform P2 is f2(t)=-f0(t-t2)=-f0(t-t1-Tf/6).
The third acceleration waveform P3 is f3(t)=f0(t-t3)=f0(t-t1-Tf/3).
It is expressed as
If the acceleration command obtained by combining the first to third acceleration waveforms P1 to P3 is a time function fc(t), then
fc(t)=f1(t)+f2(t)+f3(t)=f0(t-t1)-f0(t-t1-Tf/6)+f0(t-t1-Tf/3)
It can be expressed as:
[効果のまとめ]
(1)上述したように、吊荷が吊り下げられた水平移動装置を水平方向に移動する駆動装置を、加速指令信号に基づいて速度制御する操作制御部21は、
水平移動装置Hの目標速度を変更する目標速度変更指令を検出して目標速度を更新する目標速度更新部である検出部41と、
検出部41により更新された目標速度と水平移動装置Hの現在の速度との速度差から、加速指令信号を生成するための第1~3加速波形を決定する加速波形決定部42と、
加速波形決定部42が決定した3個の加速波形のそれぞれにより水平移動装置Hが駆動した場合に発生する吊荷の振動波形の位相が1/3ずつずれるように、3個の加速波形の開始タイミングを決定するタイミング決定部43と、
3個の加速波形の加速が、タイミング決定部により決定されたタイミングで開始することを示す加速波形信号を生成する加速指令信号生成部44と、
加速波形信号に基づいて水平移動装置Hを駆動する駆動制御部45とを有することを特徴とする。
[Summary of effects]
(1) As described above, the
a
an acceleration
a
an acceleration command
and a
これにより、吊荷の揺れを抑制しながら、水平移動装置Hおよび吊荷を目標速度(速度ゼロを含む)に速度変更させて移動させることができる。水平移動装置Hを上述のそれぞれの加速パターンのタイミングで駆動させることは、操作部8のオンオフスイッチを操作者が操作し、水平移動装置Hの走行をオン、オフすることでも実現可能であるが、常に、そのタイミングで操作部8のオンオフスイッチを操作することは困難である。そこで制御部31が、上述のそれぞれのタイミングで水平移動装置Hを駆動させるための駆動指令信号を生成するようにしたので、その駆動指令信号により水平移動装置Hを駆動することで、吊荷の振動を確実に抑制しながら、水平移動装置Hおよび吊荷を目標速度で移動させることができる。
This allows the horizontal movement device H and the suspended load to be moved at a target speed (including zero speed) while suppressing the swaying of the load. Driving the horizontal movement device H at the timing of each of the above-mentioned acceleration patterns can also be achieved by the operator operating the on/off switch of the
(2)駆動制御部45は、加速波形信号を時刻ごとに合算して加速指令信号(図8B)を生成し、加速指令信号に基づいて水平移動装置Hを駆動することができる。
(2) The
このような構成を有するようにしたので、例えば、水平移動装置Hから吊荷までの距離によって、または水平移動装置Hが出力できる加速度の大きさによって、加速波形信号(図9A,図10A)に、加速波形同士が一部重なるように配置される場合においても、吊荷の揺れを抑制しながら目標速度状態となる駆動指令信号を生成することができる。 With this configuration, for example, depending on the distance from the horizontal movement device H to the suspended load, or the magnitude of acceleration that the horizontal movement device H can output, even when the acceleration waveform signals (FIGS. 9A and 10A) are arranged so that the acceleration waveforms overlap partially, it is possible to generate a drive command signal that achieves the target speed state while suppressing the swaying of the suspended load.
(3)タイミング決定部43は、第1加速波形の開始タイミングである時刻t1を、検出部41が目標速度の変更を検出したタイミングに対応する時刻とし、
第2加速波形の開始タイミングである時刻t2を、時刻t1から、第1加速波形により水平移動装置Hが駆動した場合に発生する吊荷の振動波形の周期の1/6の時間が経過した時刻とし、
第3加速波形の開始タイミングである時刻t3を、時刻t2から、第1加速波形により水平移動装置Hが駆動した場合に発生する吊荷の振動波形の周期の1/6の時間が経過した時刻とし、
加速波形決定部42は、第1~3加速波形を等加速波形と、目標速度から加速時間を決定し、第1加速波形を時間関数f1(t)から生成し、第2加速波形を時間関数f2(t)から生成し、第3加速波形を時間関数f3(t)から生成し、
目標速度が現在の速度より速い場合、
時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=-A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=A0の矩形波であり、
目標速度が現在の速度より遅い場合、
時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=-A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=-A0の矩形波であることができる。
(3) The
The time t2, which is the start timing of the second acceleration waveform, is set to the time when 1/6 of the period of the vibration waveform of the suspended load generated when the horizontal movement device H is driven by the first acceleration waveform has elapsed from the time t1,
The time t3, which is the start timing of the third acceleration waveform, is set to the time when 1/6 of the period of the vibration waveform of the suspended load generated when the horizontal movement device H is driven by the first acceleration waveform has elapsed from the time t2,
The acceleration
If the target speed is faster than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
For t1≦t≦t1+Ta, f1(t)=A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
For t2≦t≦t2+Ta, f2(t)=-A0, which is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
For t3≦t≦t3+Ta, f3(t)=A0 is a square wave.
If the target speed is slower than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
For t1≦t≦t1+Ta, f1(t)=-A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
For t2≦t≦t2+Ta, f2(t)=A0 is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
For t3≦t≦t3+Ta, f3(t)=−A0 square wave.
このような構成を有するようにしたので、第1加速波形が終了してから振動周期の1/3経過後に振動が収束し、短時間で揺れを抑制することができる。加速指令信号を生成するための3個の加速波形を基本加速波形f0(t)から、第1加速波形f1(t)、第2加速波f2(t)、第3波形f3(t)は、f1(t)=f3(t)=f0(t)、f2(t)=-f0(t)と表すことができ、容易に3個の加速波形を生成することを可能としている。 With this configuration, the vibrations converge 1/3 of the vibration period after the first acceleration waveform ends, and the shaking can be suppressed in a short time. The three acceleration waveforms for generating the acceleration command signal can be expressed as f1(t) = f3(t) = f0(t), f2(t) = -f0(t) from the basic acceleration waveform f0(t), i.e., the first acceleration waveform f1(t), the second acceleration waveform f2(t), and the third waveform f3(t), making it possible to easily generate the three acceleration waveforms.
(4)また、タイミング決定部43は、
第1加速波形の開始タイミングである第1の時刻t1を、検出部41が目標速度の変更を検出したタイミングに対応する時刻t1とし、第2加速波形の開始タイミングである第2の時刻t2を、時刻t1から、第1加速波形により水平移動装置Hが駆動した場合に発生する吊荷の振動波形の周期の1/3の時間が経過した時刻とし、第3加速波形の開始タイミングである第3の時刻t3を、時刻t2から、第1加速波形により水平移動装置Hが駆動した場合に発生する吊荷の振動波形の周期の1/3の時間が経過した時刻とし、
加速波形決定部42は、
第1~3加速波形を等加速度波形とし、目標速度から加速時間を決定し、第1加速波形を時間関数f1(t)から生成し、第2加速波形を時間関数f2(t)から生成し、第3加速波形を時間関数f3(t)から生成し、
目標速度が現在の速度より速い場合、
時間関数f1(t)は、
t<t1、t>t1+Ta/3では、f1(t)=0、
t1≦t≦t1+Ta/3では、f1(t)=A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Ta/3では、f2(t)=0、
t2≦t≦t2+Ta/3では、f2(t)=A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Ta/3では、f3(t)=0、
t3≦t≦t3+Ta/3では、f3(t)=A0の矩形波であり、
目標速度が現在の速度より遅い場合、
時間関数f1(t)は、
t<t1、t>t1+Ta/3では、f1(t)=0、
t1≦t≦t1+Ta/3では、f1(t)=-A0となる矩形波であり、
時間関数f2(t)は、
t<t2、t>t2+Ta/3では、f2(t)=0、
t2≦t≦t2+Ta/3では、f2(t)=-A0となる矩形波であり、
時間関数f3(t)は、
t<t3、t>t3+Ta/3では、f3(t)=0、
t3≦t≦t3+Ta/3では、f3(t)=-A0の矩形波であることができる。
(4) In addition, the
The first time t1, which is the start timing of the first acceleration waveform, is set to the time t1 corresponding to the timing when the
The acceleration
The first to third acceleration waveforms are set as uniform acceleration waveforms, an acceleration time is determined from a target speed, the first acceleration waveform is generated from a time function f1(t), the second acceleration waveform is generated from a time function f2(t), and the third acceleration waveform is generated from a time function f3(t);
If the target speed is faster than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta/3, f1(t)=0,
When t1≦t≦t1+Ta/3, f1(t)=A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta/3, f2(t)=0.
When t2≦t≦t2+Ta/3, f2(t)=A0 is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta/3, f3(t)=0.
For t3≦t≦t3+Ta/3, f3(t)=A0 is a square wave.
If the target speed is slower than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta/3, f1(t)=0,
When t1≦t≦t1+Ta/3, f1(t)=-A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta/3, f2(t)=0.
When t2≦t≦t2+Ta/3, f2(t)=−A0, which is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta/3, f3(t)=0.
For t3≦t≦t3+Ta/3, f3(t)=−A0 square wave.
これにより、合成加速度、合成速度が、装置の基準加速度パターンの最大加速を超えることがなく、目標速度を超えることもなく、走行方向も逆走(目標速度に対しマイナスの速度)することがない。クレーン等において、停止する際にこの方法を採用することで、インバータ等の動力変換装置を使用はもちろんのこと、動力変換装置を用いずに、電磁ブレーキをこのタイミングで作動する制御を実行することで、荷の振れを抑制した停止制御を行うことができる。 As a result, the composite acceleration and composite speed will never exceed the maximum acceleration of the device's reference acceleration pattern, will never exceed the target speed, and will never reverse direction (a speed negative to the target speed). By employing this method when stopping a crane or similar device, it is possible to perform stopping control that suppresses load sway by executing control that activates the electromagnetic brake at this timing, not only without using a power conversion device such as an inverter, but also without using a power conversion device.
(5)高速と低速の2段の目標速度が設けられており、検出部41は、第3加速波形による加速が完了するまでの間に、水平移動装置Hの目標速度変更を検出した場合、目標速度を更新しないことができる。
(5) Two target speeds, high and low, are provided, and if the
これにより、操作者が操作部8に速度変更指令を入力し、速度変更処理中に目標速度が変更されて、制振効果を得られない可能性を減少させることができる。
This reduces the possibility that the operator will input a speed change command into the
(6)高速と低速の2段の目標速度が設けられており、検出部41は、所定の条件の下では、目標速度を更新しないことを中断し目標速度を更新することができる。
(6) Two target speeds, high and low, are provided, and the
(7) 高速と低速の2段の前記目標速度が設けられており、
目標速度をゼロから低速に変更するための第3加速波形による加速が完了するまでの間に、目標速度をゼロとする目標速度を変更する指令を検出した場合、
目標速度をゼロから高速に変更するための第3加速波形による加速が完了するまでの間に、目標速度をゼロとする目標速度を変更する指令を検出した場合、
または目標速度を低速から高速に変更するための第3加速波形による加速が完了するまでの間に、目標速度をゼロとする目標速度を変更する指令を検出した場合、
検出部41は、目標速度を変更する指令を検出した時刻が第3の時刻t3から加速時間Taを経過していない時刻である場合、目標速度をゼロとする目標速度変更指令を検出した時刻に対応する停止指令時刻tsを記憶し、目標速度を更新し、
加速波形決定部42は、駆動装置の現在の速度から停止用の修正加速時間Tasを決定し、
t≦ts+Tasではfs(t)=-A0、
t>ts+Tasではfs(t)=0の矩形波となる
停止用の時間関数fs(t)を生成した後、
時間関数f1(t)を時間関数fs(t)で置き換え、
時間関数f2(t)=0
時間関数f3(t)=0
とすることができる。
(7) Two target speeds, a high speed and a low speed, are provided,
When a command to change the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a low speed is completed,
When a command to change the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a high speed is completed,
Or, when a command to change the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from a low speed to a high speed is completed,
When the time when the command to change the target speed is detected is a time when the acceleration time Ta has not elapsed since the third time t3, the
The acceleration
For t≦ts+Tas, fs(t)=−A0,
After generating a stop time function fs(t) that becomes a square wave with fs(t)=0 when t>ts+Tas,
Replace the time function f(t) with the time function f(t),
Time function f2(t)=0
Time function f3(t)=0
It can be said that:
これにより、水平移動装置Hの操作性を悪くすることなく、吊荷の制振を行うことが可能である。 This makes it possible to dampen the vibration of the suspended load without compromising the operability of the horizontal movement device H.
(8)水平移動装置Hは、走行インバータ52,横行インバータ53によって走行モータ3a,横行モータ5aを駆動する水平移動装置Hであり、
制御部31は、生成した駆動指令信号を、走行インバータ52,横行インバータ53に与えて、水平移動装置Hを駆動させる。
(8) The horizontal movement device H is a horizontal movement device H that drives the traveling
The
このような構成を有するようにしたので、走行インバータ52,横行インバータ53によって駆動する水平移動装置Hの駆動制御を行うことができる。
This configuration allows the drive control of the horizontal movement device H, which is driven by the
(9)加速波形は、矩形波形、または台形波形である(図8~図12)。 (9) The acceleration waveform is a rectangular waveform or a trapezoidal waveform (Figures 8 to 12).
このような構成を有するようにしたので、多種多様な波形に基づいて吊荷の揺れを抑制することができる。 This configuration makes it possible to suppress the swaying of the suspended load based on a wide variety of waveforms.
(10)クレーン1が操作制御部21を有することができる。このようにすることで、クレーン1の吊荷の揺れを抑制することができる。
(10) The
1 クレーン
2 走行レール
3 走行台車
3a 走行モータ
4 ガーダ
5 トロリ
5a 横行モータ
6 昇降モータ
7 電動巻上機
8 操作部
9 ケーブル
10 フック
11 ロープ
21 操作制御部
22 移動制御部
31 制御部
32 記憶部
41 検出部
42 加速波形決定部
43 タイミング決定部
44 加速指令信号生成部
45 駆動制御部
51 昇降制御部
52 走行インバータ
53 横行インバータ
54 昇降インバータ
71 エンコーダ
REFERENCE SIGNS
Claims (14)
前記駆動装置の目標速度を変更する目標速度変更指令を検出して目標速度を更新する目標速度更新部と、
前記目標速度更新部により更新された前記目標速度と前記駆動装置の現在の速度との速度差から、前記加速指令信号を生成するための第1加速波形と第2加速波形と第3加速波形の3個の加速波形を決定する加速波形決定部と、
前記3個の加速波形のそれぞれにより前記駆動装置が駆動した場合に発生する前記吊荷の振動波形の位相が1/3ずつずれるように、前記3個の加速波形の開始タイミングを決定するタイミング決定部と、
前記3個の加速波形の加速が、前記タイミング決定部により決定されたタイミングで開始することを示す前記加速指令信号を生成する加速指令信号生成部と、
前記加速指令信号に基づいて駆動指令信号を生成し前記駆動装置を駆動する駆動制御部と
を有することを特徴とする制御装置。 A control device that controls the speed of a drive device that moves a horizontal movement device from which a load is suspended in a horizontal direction based on an acceleration command signal,
a target speed update unit that detects a target speed change command for changing a target speed of the driving device and updates the target speed;
an acceleration waveform determination unit that determines three acceleration waveforms, i.e., a first acceleration waveform, a second acceleration waveform, and a third acceleration waveform, for generating the acceleration command signal, based on a speed difference between the target speed updated by the target speed update unit and a current speed of the drive device;
a timing determination unit that determines start timings of the three acceleration waveforms so that the phases of the vibration waveforms of the suspended load generated when the driving device is driven by each of the three acceleration waveforms are shifted by 1/3;
an acceleration command signal generating unit that generates the acceleration command signal indicating that the acceleration of the three acceleration waveforms starts at the timing determined by the timing determining unit;
a drive control unit that generates a drive command signal based on the acceleration command signal to drive the drive device.
前記加速指令信号生成部は、前記3個の加速波形を時刻ごとに合算して前記加速指令信号を生成する
ことを特徴とする制御装置。 2. The control device according to claim 1,
The control device according to claim 1, wherein the acceleration command signal generating unit generates the acceleration command signal by adding up the three acceleration waveforms for each time.
前記タイミング決定部は、
前記第1加速波形の開始タイミングである第1の時刻t1を、前記目標速度更新部が前記目標速度を変更する指令を検出したタイミングに対応する時刻とし、
前記第2加速波形の開始タイミングである第2の時刻t2を、前記第1の時刻t1から、前記第1加速波形により前記駆動装置が駆動した場合に発生する前記吊荷の振動波形の周期の1/6の時間が経過した時刻とし、
前記第3加速波形の開始タイミングである第3の時刻t3を、前記第2の時刻t2から、前記第1加速波形により前記駆動装置が駆動した場合に発生する前記吊荷の振動波形の周期の1/6の時間が経過した時刻とし、
前記加速波形決定部は、
前記第1~3加速波形を所定の加速度A0とする等加速度波形とし、前記目標速度から加速時間Taを決定し、
前記第1加速波形を時間関数f1(t)から生成し、前記第2加速波形を時間関数f2(t)から生成し、前記第3加速波形を時間関数f3(t)から生成し、
前記目標速度が現在の速度より速い場合、
前記時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=A0となる矩形波であり、
前記時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=-A0となる矩形波であり、
前記時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=A0の矩形波であり、
前記目標速度が現在の速度より遅い場合、
前記時間関数f1(t)は、
t<t1、t>t1+Taでは、f1(t)=0、
t1≦t≦t1+Taでは、f1(t)=-A0となる矩形波であり、
前記時間関数f2(t)は、
t<t2、t>t2+Taでは、f2(t)=0、
t2≦t≦t2+Taでは、f2(t)=A0となる矩形波であり、
前記時間関数f3(t)は、
t<t3、t>t3+Taでは、f3(t)=0、
t3≦t≦t3+Taでは、f3(t)=-A0の矩形波である
ことを特徴とする制御装置。 2. The control device according to claim 1,
The timing determination unit is
a first time t1, which is a start timing of the first acceleration waveform, is set to a time corresponding to a timing at which the target speed update unit detects a command to change the target speed;
A second time t2, which is the start timing of the second acceleration waveform, is set to a time when a time equivalent to 1/6 of the period of the vibration waveform of the suspended load generated when the driving device is driven by the first acceleration waveform has elapsed from the first time t1,
A third time t3, which is the start timing of the third acceleration waveform, is set to a time when 1/6 of the period of the vibration waveform of the suspended load generated when the driving device is driven by the first acceleration waveform has elapsed from the second time t2,
The acceleration waveform determination unit
The first to third acceleration waveforms are set as uniform acceleration waveforms with a predetermined acceleration A0, and an acceleration time Ta is determined from the target speed;
The first acceleration waveform is generated from a time function f1(t), the second acceleration waveform is generated from a time function f2(t), and the third acceleration waveform is generated from a time function f3(t);
If the target speed is greater than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
For t1≦t≦t1+Ta, f1(t)=A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
For t2≦t≦t2+Ta, f2(t)=-A0, which is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
For t3≦t≦t3+Ta, f3(t)=A0 is a square wave.
If the target speed is slower than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta, f1(t)=0,
For t1≦t≦t1+Ta, f1(t)=-A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta, f2(t)=0.
For t2≦t≦t2+Ta, f2(t)=A0 is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta, f3(t)=0.
The control device is characterized in that, for t3≦t≦t3+Ta, f3(t)=-A0 is a square wave.
前記タイミング決定部は、
前記第1加速波形の開始タイミングである第1の時刻t1を、前記目標速度更新部が前記目標速度を変更する指令を検出したタイミングに対応する時刻とし、
前記第2加速波形の開始タイミングである第2の時刻t2を、前記第1の時刻t1から、前記第1加速波形により前記駆動装置が駆動した場合に発生する前記吊荷の振動波形の周期の1/3の時間が経過した時刻とし、
前記第3加速波形の開始タイミングである第3の時刻t3を、前記第2の時刻t2から、前記第1加速波形により前記駆動装置が駆動した場合に発生する前記吊荷の振動波形の周期の1/3の時間が経過した時刻とし、
前記加速波形決定部は、
前記第1~3加速波形を所定の加速度A0とする等加速度波形とし、前記目標速度から加速時間Taを決定し、
前記第1加速波形を時間関数f1(t)から生成し、前記第2加速波形を時間関数f2(t)から生成し、前記第3加速波形を時間関数f3(t)から生成し、
前記目標速度が現在の速度より速い場合、
前記時間関数f1(t)は、
t<t1、t>t1+Ta/3では、f1(t)=0、
t1≦t≦t1+Ta/3では、f1(t)=A0となる矩形波であり、
前記時間関数f2(t)は、
t<t2、t>t2+Ta/3では、f2(t)=0、
t2≦t≦t2+Ta/3では、f2(t)=A0となる矩形波であり、
前記時間関数f3(t)は、
t<t3、t>t3+Ta/3では、f3(t)=0、
t3≦t≦t3+Ta/3では、f3(t)=A0の矩形波であり、
前記目標速度が現在の速度より遅い場合、
前記時間関数f1(t)は、
t<t1、t>t1+Ta/3では、f1(t)=0、
t1≦t≦t1+Ta/3では、f1(t)=-A0となる矩形波であり、
前記時間関数f2(t)は、
t<t2、t>t2+Ta/3では、f2(t)=0、
t2≦t≦t2+Ta/3では、f2(t)=-A0となる矩形波であり、
前記時間関数f3(t)は、
t<t3、t>t3+Ta/3では、f3(t)=0、
t3≦t≦t3+Ta/3では、f3(t)=-A0の矩形波である
ことを特徴とする制御装置。 2. The control device according to claim 1,
The timing determination unit is
a first time t1, which is a start timing of the first acceleration waveform, is set to a time corresponding to a timing at which the target speed update unit detects a command to change the target speed;
A second time t2, which is the start timing of the second acceleration waveform, is set to a time when 1/3 of the period of the vibration waveform of the suspended load generated when the driving device is driven by the first acceleration waveform has elapsed from the first time t1,
A third time t3, which is the start timing of the third acceleration waveform, is set to a time when 1/3 of the period of the vibration waveform of the suspended load generated when the driving device is driven by the first acceleration waveform has elapsed from the second time t2,
The acceleration waveform determination unit
The first to third acceleration waveforms are set as uniform acceleration waveforms with a predetermined acceleration A0, and an acceleration time Ta is determined from the target speed;
The first acceleration waveform is generated from a time function f1(t), the second acceleration waveform is generated from a time function f2(t), and the third acceleration waveform is generated from a time function f3(t);
If the target speed is greater than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta/3, f1(t)=0,
When t1≦t≦t1+Ta/3, f1(t)=A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta/3, f2(t)=0.
When t2≦t≦t2+Ta/3, f2(t)=A0 is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta/3, f3(t)=0.
For t3≦t≦t3+Ta/3, f3(t)=A0 is a square wave.
If the target speed is slower than the current speed,
The time function f1(t) is
For t<t1, t>t1+Ta/3, f1(t)=0,
When t1≦t≦t1+Ta/3, f1(t)=-A0 is a square wave.
The time function f2(t) is
For t<t2, t>t2+Ta/3, f2(t)=0.
When t2≦t≦t2+Ta/3, f2(t)=−A0, which is a square wave.
The time function f3(t) is
For t<t3 and t>t3+Ta/3, f3(t)=0.
The control device is characterized in that, for t3≦t≦t3+Ta/3, f3(t)=-A0 is a square wave.
高速と低速の2段の前記目標速度が設けられており、
前記目標速度更新部は、前記第3加速波形による加速が完了するまでの間に、前記駆動装置の前記目標速度を変更する指令を検出した場合、前記目標速度を更新しない
ことを特徴とする制御装置。 5. The control device according to claim 3,
Two target speeds, a high speed and a low speed, are provided,
the target speed update unit does not update the target speed when it detects a command to change the target speed of the drive device before acceleration by the third acceleration waveform is completed.
前記目標速度更新部は、所定の条件の下では、前記目標速度を更新しないことを中断し、前記目標速度を更新することを特徴とする制御装置。 6. The control device according to claim 5,
The control device according to claim 1, wherein the target speed update unit stops not updating the target speed under a predetermined condition and updates the target speed.
高速と低速の2段の前記目標速度が設けられており、
前記目標速度をゼロから低速に変更するための前記第3加速波形による加速が完了するまでの間に、前記目標速度をゼロとする前記目標速度変更指令を検出した場合、
前記目標速度をゼロから高速に変更するための前記第3加速波形による加速が完了するまでの間に、前記目標速度をゼロとする前記目標速度変更指令を検出した場合、
または前記目標速度を低速から高速に変更するための前記第3加速波形による加速が完了するまでの間に、前記目標速度をゼロとする前記目標速度変更指令を検出した場合、
前記目標速度更新部は、前記目標速度をゼロとする前記目標速度変更指令を検出した時刻が前記第3の時刻t3から前記加速時間Taを経過していない時刻である場合、前記目標速度をゼロとする前記目標速度変更指令を検出した時刻に対応する停止指令時刻tsを記憶し、前記目標速度をゼロに更新し、
前記加速波形決定部は、
前記駆動装置の現在の速度から停止用の修正加速時間Tasを決定し、
t≦ts+Tasではfs(t)=-A0、
t>ts+Tasではfs(t)=0の矩形波となる
停止用の修正時間関数fs(t)を生成した後、
前記時間関数f1(t)を前記時間関数fs(t)に置き換え、
前記時間関数f2(t)=0
前記時間関数f3(t)=0とする
ことを特徴とする制御装置。 4. The control device according to claim 3,
Two target speeds, a high speed and a low speed, are provided,
When the target speed change command for changing the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a low speed is completed,
When the target speed change command for changing the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from zero to a high speed is completed,
or when a target speed change command for setting the target speed to zero is detected before the acceleration by the third acceleration waveform for changing the target speed from a low speed to a high speed is completed,
the target speed update unit, when the time at which the target speed change command for setting the target speed to zero is detected is a time that has not elapsed since the third time t3 within the acceleration time Ta, stores a stop command time ts corresponding to the time at which the target speed change command for setting the target speed to zero is detected, and updates the target speed to zero;
The acceleration waveform determination unit
determining a corrective acceleration time Tas for stopping from a current speed of the drive;
For t≦ts+Tas, fs(t)=−A0,
After generating a correction time function fs(t) for stopping, which is a square wave with fs(t)=0 when t>ts+Tas,
Replace the time function f(t) with the time function f(t),
The time function f2(t)=0
The control device is characterized in that the time function f3(t)=0.
前記駆動装置は、電力変換装置によってモータを駆動し、
前記駆動制御部は、生成した前記駆動指令信号を、前記電力変換装置に与えて、前記駆動装置を駆動させる、
ことを特徴とする制御装置。 3. The control device according to claim 2,
The drive device drives a motor using a power conversion device,
The drive control unit provides the generated drive command signal to the power conversion device to drive the drive device.
A control device comprising:
前記加速波形は、矩形波形、または台形波形である、
ことを特徴とする制御装置。 4. The control device according to claim 2 or 3,
The acceleration waveform is a rectangular waveform or a trapezoidal waveform.
A control device comprising:
前記駆動装置の目標速度を変更する指令を検出して目標速度を更新する目標速度更新ステップと、
前記目標速度更新ステップにより更新された前記目標速度と前記駆動装置の現在の速度との速度差から、前記加速指令信号を生成するための第1加速波形と第2加速波形と第3加速波形の3個の加速波形を決定する加速波形決定ステップと、
前記加速波形決定ステップで決定された前記3個の加速波形のそれぞれにより前記駆動装置が駆動した場合に発生する前記吊荷の振動波形の位相が1/3ずつずれるように、前記3個の加速波形の開始タイミングを決定するタイミング決定ステップと、
前記3個の加速波形の加速が、前記タイミング決定ステップで決定されたタイミングで開始することを示す前記加速指令信号を生成する加速指令信号生成ステップと、
前記加速指令信号に基づいて駆動指令信号を生成し前記駆動装置を駆動する駆動制御ステップと
を有することを特徴とする制御方法。 A control method for a control device that controls the speed of a drive device that moves a horizontal movement device from which a load is suspended in a horizontal direction based on an acceleration command signal, comprising:
a target speed update step of detecting a command to change a target speed of the driving device and updating the target speed;
an acceleration waveform determination step of determining three acceleration waveforms, i.e., a first acceleration waveform, a second acceleration waveform, and a third acceleration waveform, for generating the acceleration command signal, based on a speed difference between the target speed updated in the target speed update step and a current speed of the driving device;
a timing determination step of determining start timings of the three acceleration waveforms so that the phases of the vibration waveforms of the load generated when the driving device is driven by each of the three acceleration waveforms determined in the acceleration waveform determination step are shifted by 1/3;
an acceleration command signal generating step of generating the acceleration command signal indicating that the acceleration of the three acceleration waveforms is to start at the timing determined in the timing determining step;
a drive control step of generating a drive command signal based on the acceleration command signal to drive the drive device.
13. The vibration damping control method according to claim 12, wherein the acceleration command signal is an acceleration command signal of a constant acceleration.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2025503939A JPWO2024181451A1 (en) | 2023-03-02 | 2024-02-27 |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2023032113 | 2023-03-02 | ||
| JP2023-032113 | 2023-03-02 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2024181451A1 true WO2024181451A1 (en) | 2024-09-06 |
Family
ID=92589852
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2024/007126 Pending WO2024181451A1 (en) | 2023-03-02 | 2024-02-27 | Control device, crane, and control method |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JPWO2024181451A1 (en) |
| WO (1) | WO2024181451A1 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN119526425A (en) * | 2025-01-14 | 2025-02-28 | 湖南墨达智能科技有限公司 | Shock absorption control method and system for linkage hydraulic mechanical arm |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01267297A (en) * | 1988-04-18 | 1989-10-25 | Kawasaki Steel Corp | Center rest control method for hanging cargo and positioning control therein |
| US5219420A (en) * | 1991-03-18 | 1993-06-15 | Kone Oy | Procedure for the control of a crane |
| JP2003081575A (en) * | 2001-09-11 | 2003-03-19 | Ishikawajima Harima Heavy Ind Co Ltd | Crane steadying method and steadying device |
| JP2007514624A (en) * | 2003-07-17 | 2007-06-07 | ケイシーアイ コネクレーンズ ピーエルシー | Crane control method |
| CN102502403A (en) * | 2011-10-28 | 2012-06-20 | 河南卫华重型机械股份有限公司 | Sway-prevention control method for crane |
| JP2021075372A (en) * | 2019-11-12 | 2021-05-20 | 株式会社日立産機システム | Crane and crane control method |
-
2024
- 2024-02-27 JP JP2025503939A patent/JPWO2024181451A1/ja active Pending
- 2024-02-27 WO PCT/JP2024/007126 patent/WO2024181451A1/en active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01267297A (en) * | 1988-04-18 | 1989-10-25 | Kawasaki Steel Corp | Center rest control method for hanging cargo and positioning control therein |
| US5219420A (en) * | 1991-03-18 | 1993-06-15 | Kone Oy | Procedure for the control of a crane |
| JP2003081575A (en) * | 2001-09-11 | 2003-03-19 | Ishikawajima Harima Heavy Ind Co Ltd | Crane steadying method and steadying device |
| JP2007514624A (en) * | 2003-07-17 | 2007-06-07 | ケイシーアイ コネクレーンズ ピーエルシー | Crane control method |
| CN102502403A (en) * | 2011-10-28 | 2012-06-20 | 河南卫华重型机械股份有限公司 | Sway-prevention control method for crane |
| JP2021075372A (en) * | 2019-11-12 | 2021-05-20 | 株式会社日立産機システム | Crane and crane control method |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN119526425A (en) * | 2025-01-14 | 2025-02-28 | 湖南墨达智能科技有限公司 | Shock absorption control method and system for linkage hydraulic mechanical arm |
Also Published As
| Publication number | Publication date |
|---|---|
| JPWO2024181451A1 (en) | 2024-09-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Lee | Modeling and control of a three-dimensional overhead crane | |
| JP5293977B2 (en) | Crane steady rest control method and steady rest control apparatus | |
| CN114195009B (en) | Anti-swing control method and system of double-swing tower crane based on active disturbance rejection controller | |
| WO2024181451A1 (en) | Control device, crane, and control method | |
| JP3810506B2 (en) | Crane control method | |
| JPS6138118B2 (en) | ||
| JP2021102503A (en) | Control device of suspension-type crane and inverter device | |
| JP3132757B2 (en) | Crane control method | |
| JP3274051B2 (en) | Crane steady rest / positioning control method | |
| JP3066424B2 (en) | Crane automatic control device | |
| JP7438925B2 (en) | Crane and crane control method | |
| JP2666959B2 (en) | Sway control method of suspension type crane | |
| JP2019099367A (en) | Operation control device of crane | |
| JP3376772B2 (en) | Crane steady rest / positioning device | |
| WO2022009544A1 (en) | Crane and crane control method | |
| Spruogis et al. | Further Research on an Anti-Swing Control System for Overhead Cranes. | |
| JP2023119137A (en) | Control device and control method | |
| JP2017165580A (en) | Crane operation support method and crane operation support device | |
| JP2001278579A (en) | Sway control method and control device for suspended load | |
| CN120589600B (en) | Crane load monitoring system and method for restraining swing | |
| JP7732953B2 (en) | Anti-sway control method for a rotary crane | |
| JPH05139689A (en) | Method and device for controlling cargo anti-rock operation of jib crane | |
| Robinett et al. | Sway control method and system for rotary cranes | |
| JPH06303788A (en) | Motor-speed deciding method | |
| Sinyukov et al. | Development of an Apparatus Based on Fuzzy Logic to Dampen Load Vibrations in Load Moving Mechanisms |
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: 24763930 Country of ref document: EP Kind code of ref document: A1 |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 2025503939 Country of ref document: JP |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |