WO2010095585A1 - 作業機械の旋回制御装置、制御プログラム及び作業機械 - Google Patents
作業機械の旋回制御装置、制御プログラム及び作業機械 Download PDFInfo
- Publication number
- WO2010095585A1 WO2010095585A1 PCT/JP2010/052169 JP2010052169W WO2010095585A1 WO 2010095585 A1 WO2010095585 A1 WO 2010095585A1 JP 2010052169 W JP2010052169 W JP 2010052169W WO 2010095585 A1 WO2010095585 A1 WO 2010095585A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- speed
- torque
- operation unit
- electric motor
- control mode
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18145—Cornering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W20/00—Control systems specially adapted for hybrid vehicles
- B60W20/10—Controlling the power contribution of each of the prime movers to meet required power demand
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K6/00—Arrangement or mounting of plural diverse prime-movers for mutual or common propulsion, e.g. hybrid propulsion systems comprising electric motors and internal combustion engines ; Control systems therefor, i.e. systems controlling two or more prime movers, or controlling one of these prime movers and any of the transmission, drive or drive units Informative references: mechanical gearings with secondary electric drive F16H3/72; arrangements for handling mechanical energy structurally associated with the dynamo-electric machine H02K7/00; machines comprising structurally interrelated motor and generator parts H02K51/00; dynamo-electric machines not otherwise provided for in H02K see H02K99/00
- B60K6/20—Arrangement or mounting of plural diverse prime-movers for mutual or common propulsion, e.g. hybrid propulsion systems comprising electric motors and internal combustion engines ; Control systems therefor, i.e. systems controlling two or more prime movers, or controlling one of these prime movers and any of the transmission, drive or drive units Informative references: mechanical gearings with secondary electric drive F16H3/72; arrangements for handling mechanical energy structurally associated with the dynamo-electric machine H02K7/00; machines comprising structurally interrelated motor and generator parts H02K51/00; dynamo-electric machines not otherwise provided for in H02K see H02K99/00 the prime-movers consisting of electric motors and internal combustion engines, e.g. HEVs
- B60K6/42—Arrangement or mounting of plural diverse prime-movers for mutual or common propulsion, e.g. hybrid propulsion systems comprising electric motors and internal combustion engines ; Control systems therefor, i.e. systems controlling two or more prime movers, or controlling one of these prime movers and any of the transmission, drive or drive units Informative references: mechanical gearings with secondary electric drive F16H3/72; arrangements for handling mechanical energy structurally associated with the dynamo-electric machine H02K7/00; machines comprising structurally interrelated motor and generator parts H02K51/00; dynamo-electric machines not otherwise provided for in H02K see H02K99/00 the prime-movers consisting of electric motors and internal combustion engines, e.g. HEVs characterised by the architecture of the hybrid electric vehicle
- B60K6/46—Series type
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/30—Conjoint control of vehicle sub-units of different type or different function including control of auxiliary equipment, e.g. air-conditioning compressors or oil pumps
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/08—Superstructures; Supports for superstructures
- E02F9/10—Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
- E02F9/12—Slewing or traversing gears
- E02F9/121—Turntables, i.e. structure rotatable about 360°
- E02F9/123—Drives or control devices specially adapted therefor
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2058—Electric or electro-mechanical or mechanical control devices of vehicle sub-units
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2058—Electric or electro-mechanical or mechanical control devices of vehicle sub-units
- E02F9/2062—Control of propulsion units
- E02F9/2075—Control of propulsion units of the hybrid type
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/24—Safety devices, e.g. for preventing overload
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W20/00—Control systems specially adapted for hybrid vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2300/00—Indexing codes relating to the type of vehicle
- B60W2300/17—Construction vehicles, e.g. graders, excavators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/40—Special vehicles
- B60Y2200/41—Construction vehicles, e.g. graders, excavators
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/62—Hybrid vehicles
Definitions
- the present invention relates to a swing control device, a control program, and a work machine for a work machine that uses an electric motor as a power source, and particularly relates to an improved operability.
- a hydraulic pump is driven by an engine.
- the endless track is rotated by a hydraulic travel motor driven by the hydraulic pressure from the hydraulic pump.
- the swivel is swiveled by a hydraulic swivel motor driven by hydraulic pressure from a hydraulic pump.
- the opening and closing of the bucket and the expansion and contraction of the arm are also performed by a hydraulic cylinder supplied with hydraulic pressure from a hydraulic pump.
- a hydraulic device using hydraulic pressure has a work efficiency of about 50% with respect to input energy.
- the hydraulic device is braked against the rotational operation, the energy cannot be returned, and the pressure is released by the relief valve, converted into heat and discarded.
- hybrid construction machines have been actively developed with the aim of improving engine fuel efficiency, reducing greenhouse gas emissions, and reducing operating costs.
- a generator In a hybrid construction machine, a generator is driven by an engine, and the electric power is used to drive an electric hydraulic pump or a rotating body is driven by an electric motor. In order to improve the energy efficiency of the entire system, the excess energy generated by this is stored and used when necessary. Especially in turning work, the turning body is frequently turned and stopped, so it is more efficient than a hydraulic motor, and energy regeneration is performed by power regeneration during braking, and the regenerated energy can be reused. There are many examples using an electric turning system.
- the speed deviation is proportionally integrated by the PI controller, but the output, that is, the torque target value is saturated according to the integration time constant of the PI controller.
- the torque target value is saturated, there is no problem as long as the pressing operation is continued with the saturation torque (maximum torque). However, even if the operation lever is returned, the actual speed value is zero. Continues the integration operation and the torque target value remains saturated. In other words, once the pressing operation is started and the torque is saturated, the torque target value is decreased unless the operating lever is returned to the reverse rotation and the PI controller input is reversed to cause the negative integral action. Therefore, the lever operation becomes ON / OFF control, and it becomes impossible to control the pressing torque by operating the operation lever.
- a speed deviation is obtained by an operation amount of an operation lever, and a deceleration torque is controlled by this speed deviation.
- the maximum acceleration torque is generated when the operation amount is the maximum
- the maximum braking torque is generated when the position of the operation lever is neutral, that is, at or near the speed command.
- the magnitude of acceleration torque and braking torque is controlled according to the operation amount.
- torque control or torque limitation is applied instead of speed control according to the operation amount during the pressing operation.
- the speed target value and the torque limit value are calculated from the operation amount.
- the maximum torque value is determined as a function of the speed deviation, and when it is pressed against the earth wall at the maximum acceleration, the torque is saturated, and the speed deviation is reduced by performing the operation lever return operation. Even if a considerable return operation is not performed, the torque will not be reduced, and if the operation lever is returned a little, the torque will remain saturated and will not match the operation feeling of the operator. According to the technique of Patent Document 2, when the operation lever is pressed near or in the middle of the neutral position, the amount of operation of the operation lever from that position is added as torque.
- An object of the present invention is to provide a turning control device for a work machine that can perform control in accordance with an operation feeling of an operator.
- the turning control device for a work machine of one embodiment of the present invention has an operation unit.
- the operation unit can be operated from the neutral position in the forward rotation direction and the reverse rotation direction, and can output an operation signal indicating the operation amount from the neutral position in the forward rotation direction and the reverse rotation direction.
- the speed control mode for controlling the electric motor that turns the revolving body to the speed according to the operation amount of the operation section when the speed of the electric motor becomes almost zero, the speed according to the operation amount of the operation section and the A time constant changer that increases the time constant of an integrator that integrates the deviation from the speed of the motor, and when the operation unit is operated in a state where the time constant is increased, the torque before operation of the operation unit
- a second mode change unit is provided that changes to the speed control mode when the operation unit is operated in reverse in the control mode.
- the time constant of the integrator is large. Is done. Therefore, even if the operation unit maintains the current operation amount, the output of the integrator increases, so that the torque of the motor increases and the earth wall can be destroyed. If the operator adds and operates the operation unit without being able to destroy, the mode is changed to the torque control mode. Moreover, since the motor is controlled so that the torque of the motor becomes the value obtained by adding the torque according to the operation amount of the operation unit after the operation to the torque before the operation of the operation unit, the operation unit is set to the neutral position side, for example.
- a third mode changing unit that sets the torque control mode when the integrator is saturated.
- the speed of the electric motor does not decrease unless the operation unit is operated from the neutral position side to the reverse rotation direction side in the speed control mode.
- the torque control mode when the operation unit is returned as described above, the speed of the electric motor is reduced and it is possible to prevent the worker from being confused.
- the electric motor In the torque control mode, when the operation amount per predetermined time of the operation unit is larger than a predetermined reference value in a state where the speed of the electric motor is substantially zero, the electric motor is generated by operation of the operation unit.
- Means may be provided for increasing the torque and reducing the torque generated by the electric motor by the operation of the operation unit when the operation amount per predetermined time of the operation unit is smaller than the predetermined reference value. it can.
- the amount of operation of the operation unit per predetermined time when the speed of the motor is substantially zero means that the torque generated by the motor is small and a fixed object such as a dirt wall is attached. It is thought that the worker felt that it was not easy to destroy. Therefore, the torque generated by the electric motor is increased. In addition, when the speed of the electric motor is almost zero, the fact that the operation amount of the operation unit per predetermined time is small means that the operator feels that the torque generated by the electric motor is too large. Therefore, the torque is reduced. By controlling in this way, it is possible to perform control that matches the intention that the operator wants to operate.
- the speed control mode when the operation speed per predetermined time of the operation unit is larger than a predetermined speed reference value, the speed of the electric motor is increased by the operation of the operation unit, and the operation unit It is also possible to provide means for slowing down the speed of the electric motor by the operation of the operation unit when the determined operation speed per time is smaller than the predetermined speed reference value.
- the large amount of operation of the operation unit per predetermined time in the speed control mode means that the worker feels that the speed of the motor is slow, so the speed of the motor is increased. ing.
- the fact that the amount of operation of the operation unit per predetermined time is small means that the worker feels that the speed of the motor is fast, so the speed of the motor is slowed down.
- FIG. 1 is a block diagram of a turning control device for a work machine according to an embodiment of the present invention.
- Operation timing chart of the turning control device of the work machine in FIG. Operation timing chart of the turning control device for work machine in FIG.
- Operation timing chart of the turning control device of the work machine in FIG. It is a figure which shows the relationship between the amount of operation lever operation of the turning control apparatus of the working machine of FIG. 1, and a speed / torque target value.
- It is a figure which shows a part of control flowchart of the turning control apparatus of the working machine of FIG.
- FIG. 1 shows a block diagram of a turning control device for a construction machine (not shown) according to an embodiment of the present invention.
- the engine 1 mounted on the construction work machine rotates the generator 2, and also drives a mechanical load 3, for example, a hydraulic pump, directly connected to the generator 2 coaxially.
- the AC voltage generated by the generator 2 is converted to DC by the converter 4, smoothed by the smoothing capacitor 5, converted to AC by the inverter 6, and supplied to a swing body (not shown), for example, an arm swing motor 7. .
- the electric motor 7 is, for example, PMSM (permanent magnet type synchronous motor), and its control is performed by a general vector control system in this embodiment.
- PMSM permanent magnet type synchronous motor
- the three-phase current that is the output current of the inverter 6 is detected by the detectors 22a, 22b, and 22c.
- the detected three-phase current is converted into a two-phase current in the stator coordinate system by the three-phase two-phase converter 16. Thereafter, the converted two-phase current is converted into an excitation current Id of the rotor coordinate system and a torque current Iq orthogonal to the magnetic pole axis by the vector analyzer 14 based on the output of the position sensor 8 that detects the magnetic pole position of the electric motor 7.
- Id excitation current
- Iq torque current
- a target value control signal is generated for each of the exciting current Id and the torque current Iq by the integration regulators 12a and 12b. These are synthesized by the vector synthesizer 13 and supplied to the inverter 6 via the two-phase / three-phase converter 15, the current regulator 17 and the pulse distributor 21, and the inverter 6 is controlled. As a result, the torque of the electric motor 7 is adjusted.
- This is a general vector control method and will not be described in detail. Although the output current of the electric motor 7 has detected all three phases, it is also possible to detect only two phases and obtain the three-phase output current by calculation based on these.
- the excitation current Id is normally set to zero in the PMSM.
- the field-weakening magnetic flux calculator 23 creates a speed versus magnetic flux pattern, and the excitation current Id has a zero target. Subtracted from the value. In the present invention, this field weakening portion is irrelevant.
- the main part of the present invention relates to target value control of the torque current Iq.
- the operation unit for example, the operation lever 9 is for instructing the forward / reverse speed of the turning arm or the like in turning the work machine to operate the turning arm or the like.
- the operation lever 9 represents an operation amount by an electric signal or the like like a joystick, and the operation amount including the operation direction is output as a speed target value N *.
- the actual speed value N which is the output of the speed calculator 24, is subtracted from the target speed value N * by the subtractor 10a to obtain a speed deviation ⁇ N, which is input to an integrator, for example, the proportional integration controller 10.
- the speed calculator 24 differentiates the angle ⁇ that is the output of the position sensor 8 with respect to time to calculate the actual speed value N. Similar to the frequently used feedback control operation, if the speed deviation is large, a proportional integral output is output from the proportional integral controller 10 so that the deviation becomes zero, and this is output by the torque current calculator 11 as a torque current target value of the motor 7. Converted to Iq *. A deviation between the torque current target value Iq * and the torque current Iq from the vector analyzer 14 is calculated by the subtractor 11a, and the deviation is supplied to the integral adjuster 12a. Thereby, as described above, the electric motor 7 generates torque and tries to reach the target speed.
- the speed threshold for determining whether the speed of the swing arm is substantially zero is provided on the output side of the speed calculator 24.
- a value setter 29 and a zero speed detector 30 for detecting whether the speed of the swing arm is almost zero based on the speed threshold value of the speed threshold value setter 29 are connected.
- the output of the zero speed detector 30 is supplied to first to third mode changing units, for example, the control unit 19.
- a neutral point detector 25 that gives an instruction and reverse operation detection that detects that the operation lever 9 has been operated in the opposite direction.
- the device 26 is connected to the operation lever 9.
- the output of the return determination device 34 for determining whether the operation lever 9 has been returned to the neutral position side from the operation direction so far from the output of the operation lever 9 is also supplied to the control unit 19.
- the output of the saturation detector 35 that detects the saturation of the output of the proportional integration controller 10 is also supplied to the control unit 19.
- the operation lever movement amount detector 27 is connected to the output of the operation lever 9.
- the operation lever movement amount detector 27 detects the movement amount from the position when the operation lever 9 is operated to a certain position.
- the output of the hold circuit 32 b is added to the output of the operation lever movement amount detector 27.
- the hold circuit 32b holds the speed target value N * when the speed of the swing arm is determined to be substantially zero as will be described later.
- the addition value by the adder 27a between the output of the operation lever movement force detector 27 and the hold value of the hold circuit 32b is converted into torque by the operation lever movement amount torque converter 28.
- the output of the torque converter 28 is supplied to the input side of the torque current calculator 11 via the torque target value connection switch 33b.
- the torque target value connection switch 33 b is controlled to open and close by the control unit 19.
- the output of the hold circuit 32 a that holds the output of the proportional integration controller 10 is also supplied to the input side of the torque current calculator 11.
- the control unit 19 supplies a hold signal to the hold circuit 32a and supplies a hold signal to the hold circuit 32b that holds the speed target value N *. Moreover, the control part 19 performs opening / closing control of the torque target value connection switch 33b. The control unit 19 also controls the time constant changing means 31 connected to the proportional-plus-integral controller 10.
- FIG. 2 shows the speed target value N * from the top, the return detection signal of the operation lever 9 (output of the return determination unit 34), the reverse rotation detection signal of the operation lever 9 (output of the reverse operation detector 26), the actual speed value N, The magnitude of the time constant of the proportional integral controller 10, the switching of the control mode, the speed deviation ⁇ N, and the torque target value T * are displayed with the time axis as the horizontal axis.
- FIG. 2 shows a timing chart when a pressing operation occurs during the turning operation, the operating lever 9 is returned to weaken the pressing force, and then the operating lever 9 is reversed to stop the pressing operation.
- N * can be regarded as almost the same as the operation amount of the operation lever. In this example, for simplicity, the operation lever amount and the speed target value have a linear relationship.
- the torque target value T * is constant at a constant speed and becomes constant torque.
- the control unit 19 controls the time constant changer 31 to lengthen the integration time of the proportional integration adjuster 10. If the operation lever 9 is maintained in the zero speed state, the torque is integrated and increased by the proportional-plus-integral controller 10, so that this time constant is set to be quite long or is held at a constant value (not shown). When the zero speed is detected, the control unit 19 supplies a hold signal to the hold circuit 32b and holds the speed target value N * at that time.
- the value of the torque target value T * becomes smaller as the operating lever 9 is returned. Even if the operation lever 9 is returned in the speed control mode, the value of ⁇ N is large, so the output of the proportional integrator 10 does not decrease and the speed does not decrease, but decreases in the torque control mode.
- the torque target value connection switch 33b is opened by the control unit 19, the torque control mode is released, and the speed control mode is set. .
- the hold of the hold circuit 32a is released by the control unit 19.
- the torque target value connection switch 33b is opened, the torque target value T * is a value obtained by proportionally integrating the speed deviation ⁇ N due to the difference between the speed target value N * according to the position of the operation lever 9 and the actual speed value N.
- the proportional-plus-integral regulator 10 is reset so that the torque target value is first input when the speed target value is inputted and integration is started. This is because if it is not released, it will rapidly change to a value integrated by the amount of the operating lever at the time of the previous torque control. Such processing is performed from the control unit 19.
- the connection switch 33b is closed and the speed control is switched to the torque control.
- the operation amount is obtained by the operation lever movement amount calculator 27, converted into torque by the operation lever movement amount torque converter 28, and proportionally before the torque current calculator 11. It is added to the output of the integral regulator 10.
- the proportional integrator 10 when the proportional integrator 10 is saturated, the speed cannot be lowered unless the operation lever 10 is returned to the reverse direction beyond the neutral position.
- the torque control mode is set when the proportional integrator 10 is saturated, the speed of the electric motor can be reduced only by returning the operation lever 9 to the neutral position direction (without returning to the reverse direction).
- the control lever 9 moves to the reverse side beyond the neutral point, the torque target is controlled by the control unit 19 based on the output of the neutral point detector 25 and the output of the reverse motion detector 26 as in the example of FIG.
- the value connection switch 33b is opened and immediately switched to the speed control mode.
- FIG. 4 shows the operation when the actual speed is generated after the pushing operation is completed and the torque is saturated to enter the torque control mode and the obstacles such as the earth and sand of the pushing operation are removed. ing.
- the control unit 19 cancels all restrictions of the torque control mode based on the output of the zero speed detector 30, and the torque target value.
- the connection switch 33b is opened, and the speed control mode is immediately switched.
- the proportional-plus-integral regulator 10 is not reset, and speed control is performed from the torque based on the output of the previous proportional-plus-integral regulator 10. This is to prevent the pressing operation from being suddenly released and the speed control from being lost due to runaway due to torque acceleration.
- FIG. 5 is a state change diagram during the operation of the timing chart of FIG. 2 with the configuration of FIG. 1, in which the horizontal axis indicates the lever operation amount, and the vertical axis indicates the speed target value and the torque target value.
- the speed control mode is released, and the operation proceeds to the operation with the torque target value indicated by the solid line arrow.
- the control shifts immediately to the speed control and shifts to the left coordinate to enter negative speed control, that is, reverse rotation mode.
- the speed target value and the torque target value are linearly displayed with respect to the operation lever operation amount. However, this may be a quadratic curve, for example, in an operation sense related to operation and speed. It can be combined.
- FIG. 6 mainly shows a flowchart of the operation of the control unit 19, and the turning device is started (step S2), and turning is started by operating the operation lever 9 (step S4). At this time, it is a speed control mode.
- step S6 it is determined by the control unit 19 whether the zero speed has been reached from the actual speed state. This determination is made, for example, by determining whether the zero speed detector 30 detects a zero speed. If the answer to this determination is no, repeat from step S6 again. If the answer to this determination is yes, the control unit 19 determines whether or not the operating lever 9 is positioned at the neutral point (step S8). This determination is made by determining whether the neutral point detector 25 indicates that the operation lever 9 is located at the neutral point. If the answer to this determination is no, the process is executed again from step S6. If the answer to this determination is yes, it is not a neutral point, but the actual speed is changed to zero speed. Therefore, it can be determined that the pushing operation is performed and the speed is zero. Accordingly, an operation of extending the integration time of the proportional integration controller 10 is performed (step S10). At the same time, in step S10, the hold circuit 32b holds the speed target value N * at zero speed.
- step S12 determines whether the return operation of the operation lever 9 is being performed (step S12). This determination is performed by determining whether or not the return determination unit 34 detects a return operation. If the answer to this determination is yes, that is, if there is a return, a hold signal is supplied to the hold circuit 32a, the original torque target value (output of the proportional integrator 10) is held in the hold circuit 32a, and the torque target The value connection switch 33 is closed (step S14).
- the operation lever movement amount calculated by the operation lever movement amount calculator 27 is added to the output of the hold circuit 32b (the operation amount of the operation lever 9 at the time of zero speed), which is torqued by the operation lever movement amount torque converter 28. Therefore, this is added to the torque target value by closing the torque target value connection switch 33.
- the torque is controlled so that the torque decreases if the operating lever 9 is returned, and conversely, if the operating lever 9 is pushed in, the torque increases.
- step S16 If the answer to the determination at step S12 is no, it is determined whether torque saturation has occurred (step S16). This determination is made by determining whether the saturation detector 35 detects saturation. Even if the answer to this determination is yes, step S14 is executed and torque control is performed.
- step S18 it is determined whether a reverse operation has occurred. This determination is made by determining whether the reverse motion detector 26 outputs a reverse motion detection signal. That is, it is determined whether to return to the speed control mode. If the answer to this determination is yes, the torque target value connection switch 33 is opened to return to the speed control mode (step S20).
- step S22 it is determined whether an actual speed has occurred. This is done by determining if the zero speed detector 30 is no longer detecting zero speed. If the answer to this determination is yes, it means that the pressing work has been suddenly lost, such as when there is no dirt wall, the hold of the proportional integral controller 10 is released, the immediately preceding torque target value is adopted, and the speed is determined from there.
- the control mode is entered (step S24). If the answer to the determination in step S22 is no, or after the execution of step S24, the determination loop is repeated from step S6.
- FIG. 7 is a process performed every time a predetermined time elapses.
- the frequency with which the operator operates the lever greatly and quickly within the predetermined time is illustrated. If it is higher, it is determined that a stronger pressing torque is required, and the gain of the regulator that controls the torque current of the motor is increased. If the operator frequently operates the control lever large and fast when performing a rotation operation instead of stopping the turning, it is determined that a higher speed is required, and the gain of the controller that controls the speed of the motor To increase.
- step S30 it is determined whether the speed is zero (step S30). If the answer to this determination is yes, it is recognized that it is a pressing operation (step S32).
- step S34 the lever operation amount is detected (step S36), and it is determined whether the lever operation amount per time is larger than a predetermined reference (step S38). ). If the answer to this determination is yes, it is necessary to increase the pressing force, so the torque current gain is increased (step S40). For example, the time constant of the integral adjuster 12a is increased. If the answer to the determination in step S38 is no, it is determined whether the lever operation amount per time is smaller than a predetermined reference (step S42).
- step S44 If the answer to this determination is yes, it is necessary to reduce the pressing force, so the torque current gain is reduced (step S44). Subsequent to step S40 or step S44, or if the answer to the determination in step S42 is no, a predetermined time elapses (step S46), and the process is executed again from step S30.
- step S30 If the answer to the determination in step S30 is no, it is recognized as a normal turning motion (step S48), and when the operation lever 9 is operated in the normal turning motion (step S50), the lever operation amount is detected (step S50).
- step S52 it is determined whether the operation speed per time is faster than a predetermined reference (step S54). If the answer to this determination is yes, the speed needs to be increased, so the speed gain is increased (step S56). . For example, the time constant of the proportional integral adjuster 10 is reduced. If the answer to the determination in step S54 is no, it is determined whether the operation speed per hour is slower than a predetermined reference (step S58). If the answer is yes, the speed needs to be reduced. The gain is reduced (step S60).
- step S56 the time constant of the proportional integrator 10 is increased.
- step S60 the time constant of the proportional integrator 10 is increased.
- step S62 the process waits for the elapse of a predetermined time (step S62) and executes again from step S30.
- the turning control device is configured by various devices, but the engine 1, the generator 2, the converter 4, the capacitor 5, the inverter 6, the electric motor 7, the position sensor 8, the current regulator 17, the operation lever 9, Each device except the neutral point detector 25 can be executed by a microcomputer control program.
Abstract
Description
Claims (8)
- 操作部と、
前記操作部の操作量に応じた速度に、旋回体を旋回させる電動機を制御する速度制御モードにおいて、前記電動機の速度がほぼゼロになったとき、前記操作部の操作量に応じた速度と前記電動機の速度との偏差を積分する積分器の時定数を大きくする時定数変更器と、
前記時定数が大きくされた状態において、前記操作部が操作されたとき、前記操作部の操作前のトルクに、操作後の前記操作部の操作量に応じたトルクを加算した値に、前記電動機のトルクがなるように、前記電動機を制御するトルク制御モードとする第1のモード変更部と、
前記トルク制御モードにおいて前記操作部が逆転操作されたとき、前記速度制御モードに変更する第2のモード変更部とを、
具備する作業機械の旋回制御装置。 - 請求項1記載の作業機械の旋回制御装置において、前記積分器が飽和したとき、前記トルク制御モードとする第3のモード変更部を有する
作業機械の旋回制御装置。 - 請求項1記載の作業機械の旋回制御装置において、
前記トルク制御モードにおいて、前記電動機の速度がほぼゼロの状態で前記操作部の予め定めた時間あたりの操作量が予め定めた基準値よりも大きいとき、前記操作部の操作によって前記前記電動機が発生するトルクを大きくし、前記操作部の前記予め定めた時間あたりの操作量が前記予め定めた基準値よりも小さいとき、前記操作部の操作によって前記前記電動機が発生するトルクを小さくする手段を備えた作業機械の旋回制御装置。 - 請求項3記載の作業機械の旋回制御装置において、
前記速度制御モードにおいて、前記操作部の予め定めた時間あたりの操作速度が予め定めた速度基準値よりも大きいとき、前記操作部の操作による前記電動機の速度を速くし、前記操作部の前記予め定めた時間あたりの操作速度が前記予め定めた速度基準値よりも小さいとき、前記操作部の操作による前記電動機の速度を遅くする手段を備えた作業機械の旋回制御装置。 - 操作部の操作量に応じた速度に、旋回体を旋回させる電動機を制御する速度制御モードにおいて、前記電動機の速度がほぼゼロになったとき、前記操作部の操作量に応じた速度と前記電動機の速度との偏差を積分する積分器の時定数を大きくする時定数変更手段と、
前記時定数が大きくされた状態で前記操作部が操作されたとき、前記操作部の操作前のトルクに、操作後の前記操作部の操作量に応じたトルクを加算した値に、前記電動機のトルクがなるように、前記電動機を制御するトルク制御モードとする手段と、
前記トルク制御モードにおいて前記操作部が逆転操作されたとき、前記速度モードに変更する手段とを、
備えた作業機械の旋回制御プログラム。 - 請求項5記載の作業機械の旋回制御プログラムにおいて、
前記トルク制御モードにおいて、前記操作部の予め定めた時間あたりの操作量が予め定めた基準値よりも大きいとき、前記操作部の操作によって前記前記電動機が発生するトルクを大きくし、前記操作部の前記予め定めた時間あたりの操作量が前記予め定めた基準値よりも小さいとき、前記操作部の操作によって前記前記電動機が発生するトルクを小さくする手段を備えた作業機械の旋回制御プログラム。 - 請求項5記載の作業機械の旋回制御プログラムにおいて、
前記速度制御モードにおいて、前記操作部の予め定めた時間あたりの操作速度が予め定めた速度基準値よりも大きいとき、前記操作部の操作による前記電動機の速度を速くし、前記操作部の前記予め定めた時間あたりの操作速度が前記予め定めた速度基準値よりも小さいとき、前記操作部の操作による前記電動機の速度を遅くする手段を備えた作業機械の旋回制御プログラム。 - 作業機械の旋回体を旋回させる電動機と、
操作部と、
前記電動機を制御する制御装置とを、
具備し、前記制御装置は、前記操作部の操作量に応じた速度に前記電動機を制御する速度制御モードにおいて、前記電動機の速度がほぼゼロの状態で前記操作部が操作されたとき、前記操作部の操作前のトルクに、操作後の前記操作部の操作量に応じたトルクを加算した値に、前記電動機のトルクがなるように、前記電動機を制御するトルク制御モードとする手段と、
前記トルク制御モードにおいて前記操作部が逆転操作されたとき、前記速度モードに変更する手段とを、
具備する作業機械。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011500592A JP4938153B2 (ja) | 2009-02-23 | 2010-02-15 | 作業機械の旋回制御装置、制御プログラム及び作業機械 |
CN2010800032623A CN102224304B (zh) | 2009-02-23 | 2010-02-15 | 作业机械的回转控制装置、控制方法以及作业机械 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009039413 | 2009-02-23 | ||
JP2009-039413 | 2009-02-23 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2010095585A1 true WO2010095585A1 (ja) | 2010-08-26 |
Family
ID=42633867
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2010/052169 WO2010095585A1 (ja) | 2009-02-23 | 2010-02-15 | 作業機械の旋回制御装置、制御プログラム及び作業機械 |
Country Status (3)
Country | Link |
---|---|
JP (1) | JP4938153B2 (ja) |
CN (1) | CN102224304B (ja) |
WO (1) | WO2010095585A1 (ja) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013099983A1 (ja) * | 2011-12-28 | 2013-07-04 | 住友建機株式会社 | 旋回制御装置及び方法 |
CN103797194A (zh) * | 2011-09-15 | 2014-05-14 | 住友重机械工业株式会社 | 电动回转控制装置及回转用电动机的控制方法 |
WO2016088904A1 (ja) * | 2016-01-20 | 2016-06-09 | 株式会社小松製作所 | 建設機械、ハイブリッド油圧ショベル、および電動発電機の出力トルク制御方法 |
US9725881B2 (en) | 2012-12-26 | 2017-08-08 | Doosan Infracore Co., Ltd. | Charging system for energy storage device of hybrid construction machinery |
WO2023037515A1 (ja) * | 2021-09-10 | 2023-03-16 | 日本電気株式会社 | 接触判定装置、接触判定システム、接触判定方法及びプログラム |
JP7472761B2 (ja) | 2020-11-18 | 2024-04-23 | コベルコ建機株式会社 | 旋回制御装置及び作業機械 |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013060010A1 (zh) * | 2011-10-27 | 2013-05-02 | 中联重科股份有限公司 | 电驱回转控制系统、工程机械及回转紧急制动控制方法 |
JP5552523B2 (ja) * | 2012-11-20 | 2014-07-16 | 株式会社小松製作所 | 作業機械および作業機械の作業量計測方法 |
JP5529241B2 (ja) | 2012-11-20 | 2014-06-25 | 株式会社小松製作所 | 作業機械および作業機械の作業量計測方法 |
JP5969379B2 (ja) * | 2012-12-21 | 2016-08-17 | 住友建機株式会社 | ショベル及びショベル制御方法 |
CN103774849B (zh) * | 2014-01-03 | 2016-03-23 | 中联重科股份有限公司 | 混凝土泵车及其臂架的回转制动控制方法、装置 |
JP5652977B1 (ja) * | 2014-01-31 | 2015-01-14 | 山洋電気株式会社 | モータ制御装置 |
CN105471329B (zh) * | 2015-12-30 | 2018-05-08 | 南京航空航天大学 | 交流同步电机系统转矩冲量平衡控制方法 |
JP6190916B1 (ja) * | 2016-04-28 | 2017-08-30 | Kyb株式会社 | 作業機の昇降制御装置 |
JP6552996B2 (ja) * | 2016-06-07 | 2019-07-31 | 日立建機株式会社 | 作業機械 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003328398A (ja) * | 2002-05-09 | 2003-11-19 | Kobe Steel Ltd | 作業機械の旋回制御装置 |
JP2005273262A (ja) * | 2004-03-24 | 2005-10-06 | Sumitomo (Shi) Construction Machinery Manufacturing Co Ltd | 建設機械の旋回装置 |
WO2005111322A1 (ja) * | 2004-05-13 | 2005-11-24 | Komatsu Ltd. | 旋回制御装置、旋回制御方法、および建設機械 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002044975A (ja) * | 2000-07-26 | 2002-02-08 | Fuji Electric Co Ltd | 誘導電動機の制御装置 |
DE112005001054B4 (de) * | 2004-05-13 | 2018-08-16 | Komatsu Ltd. | Drehsteuervorrichtung, Drehsteuerverfahren und Baumaschine |
JP2006336306A (ja) * | 2005-06-02 | 2006-12-14 | Shin Caterpillar Mitsubishi Ltd | 作業機械 |
JP4851802B2 (ja) * | 2006-02-01 | 2012-01-11 | 日立建機株式会社 | 建設機械の旋回駆動装置 |
-
2010
- 2010-02-15 JP JP2011500592A patent/JP4938153B2/ja not_active Expired - Fee Related
- 2010-02-15 CN CN2010800032623A patent/CN102224304B/zh not_active Expired - Fee Related
- 2010-02-15 WO PCT/JP2010/052169 patent/WO2010095585A1/ja active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003328398A (ja) * | 2002-05-09 | 2003-11-19 | Kobe Steel Ltd | 作業機械の旋回制御装置 |
JP2005273262A (ja) * | 2004-03-24 | 2005-10-06 | Sumitomo (Shi) Construction Machinery Manufacturing Co Ltd | 建設機械の旋回装置 |
WO2005111322A1 (ja) * | 2004-05-13 | 2005-11-24 | Komatsu Ltd. | 旋回制御装置、旋回制御方法、および建設機械 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103797194A (zh) * | 2011-09-15 | 2014-05-14 | 住友重机械工业株式会社 | 电动回转控制装置及回转用电动机的控制方法 |
WO2013099983A1 (ja) * | 2011-12-28 | 2013-07-04 | 住友建機株式会社 | 旋回制御装置及び方法 |
CN104011300A (zh) * | 2011-12-28 | 2014-08-27 | 住友建机株式会社 | 回转控制装置及方法 |
KR20140106616A (ko) * | 2011-12-28 | 2014-09-03 | 스미토모 겐키 가부시키가이샤 | 선회제어장치 및 방법 |
JPWO2013099983A1 (ja) * | 2011-12-28 | 2015-05-11 | 住友建機株式会社 | 旋回制御装置及び方法 |
US9284717B2 (en) | 2011-12-28 | 2016-03-15 | Sumitomo(S.H.I.) Construction Machinery Co., Ltd. | Swivel control apparatus and method |
KR101671876B1 (ko) * | 2011-12-28 | 2016-11-03 | 스미토모 겐키 가부시키가이샤 | 선회제어장치 및 방법 |
US9725881B2 (en) | 2012-12-26 | 2017-08-08 | Doosan Infracore Co., Ltd. | Charging system for energy storage device of hybrid construction machinery |
WO2016088904A1 (ja) * | 2016-01-20 | 2016-06-09 | 株式会社小松製作所 | 建設機械、ハイブリッド油圧ショベル、および電動発電機の出力トルク制御方法 |
JP7472761B2 (ja) | 2020-11-18 | 2024-04-23 | コベルコ建機株式会社 | 旋回制御装置及び作業機械 |
WO2023037515A1 (ja) * | 2021-09-10 | 2023-03-16 | 日本電気株式会社 | 接触判定装置、接触判定システム、接触判定方法及びプログラム |
Also Published As
Publication number | Publication date |
---|---|
JPWO2010095585A1 (ja) | 2012-08-23 |
JP4938153B2 (ja) | 2012-05-23 |
CN102224304B (zh) | 2013-07-10 |
CN102224304A (zh) | 2011-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4938153B2 (ja) | 作業機械の旋回制御装置、制御プログラム及び作業機械 | |
EP2287406B1 (en) | Swivel drive controller and construction machine including the same | |
JP5653041B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP3942948B2 (ja) | 作業機械の旋回制御装置 | |
JP2011006862A (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP5095361B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
US9431952B2 (en) | Construction machine and method of controlling turning electric motor | |
JP5101406B2 (ja) | 建設機械 | |
JP4949308B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2010138586A (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP4611370B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2010150898A (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2011078277A (ja) | 電動式建設機械 | |
JP4704725B2 (ja) | 建設機械の旋回制御装置 | |
JP5139257B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2010185257A (ja) | ハイブリッド型作業機械 | |
JP4824004B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2010001655A (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2009108551A (ja) | 旋回駆動制御装置及びこれを用いた建設機械 | |
JP6369239B2 (ja) | ハイブリッド建設機械 | |
JP2010150897A (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
JP2010001714A (ja) | 駆動制御装置及びこれを含む建設機械 | |
JP5207232B2 (ja) | 旋回駆動制御装置及びこれを含む建設機械 | |
WO2018105180A1 (ja) | 旋回制御装置 | |
JP6830725B2 (ja) | ショベル |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 201080003262.3 Country of ref document: CN |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 10743711 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2011500592 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 10743711 Country of ref document: EP Kind code of ref document: A1 |