JPWO2009051247A1 - 旋回駆動制御装置及びこれを含む建設機械 - Google Patents

旋回駆動制御装置及びこれを含む建設機械 Download PDF

Info

Publication number
JPWO2009051247A1
JPWO2009051247A1 JP2009538181A JP2009538181A JPWO2009051247A1 JP WO2009051247 A1 JPWO2009051247 A1 JP WO2009051247A1 JP 2009538181 A JP2009538181 A JP 2009538181A JP 2009538181 A JP2009538181 A JP 2009538181A JP WO2009051247 A1 JPWO2009051247 A1 JP WO2009051247A1
Authority
JP
Japan
Prior art keywords
turning
value
drive
correction
command
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.)
Granted
Application number
JP2009538181A
Other languages
English (en)
Other versions
JP5653041B2 (ja
Inventor
博三 庄野
博三 庄野
範之 西山
範之 西山
公則 佐野
公則 佐野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sumitomo Heavy Industries Ltd
Sumitomo SHI Construction Machinery Co Ltd
Original Assignee
Sumitomo Heavy Industries Ltd
Sumitomo SHI Construction Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sumitomo Heavy Industries Ltd, Sumitomo SHI Construction Machinery Co Ltd filed Critical Sumitomo Heavy Industries Ltd
Priority to JP2009538181A priority Critical patent/JP5653041B2/ja
Publication of JPWO2009051247A1 publication Critical patent/JPWO2009051247A1/ja
Application granted granted Critical
Publication of JP5653041B2 publication Critical patent/JP5653041B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • E02F9/2062Control of propulsion units
    • E02F9/2075Control of propulsion units of the hybrid type
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/08Superstructures; Supports for superstructures
    • E02F9/10Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
    • E02F9/12Slewing or traversing gears
    • E02F9/121Turntables, i.e. structure rotatable about 360°
    • E02F9/128Braking systems
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • E02F9/2095Control of electric, electro-mechanical or mechanical equipment not otherwise provided for, e.g. ventilators, electro-driven fans
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2246Control of prime movers, e.g. depending on the hydraulic load of work tools
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/64Electric machine technologies in electromobility
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Power Engineering (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

電動機で旋回駆動される建設機械の旋回機構を駆動制御する旋回駆動制御装置であって、建設機械の操作部を介して入力される操作量に基づき、前記電動機を駆動するための駆動指令を生成する駆動指令生成部と、前記旋回機構の旋回動作を検出する旋回動作検出部と、前記操作部に入力される旋回操作方向とは逆方向の旋回動作が前記旋回動作検出部によって検出されると、当該旋回操作方向とは逆方向の旋回動作の度合いに応じて、前記旋回操作方向とは逆方向の旋回動作を減じるように前記駆動指令を補正する駆動指令補正部とを含む。

Description

本発明は、建設機械の旋回機構の駆動制御を行う旋回駆動制御装置及びこれを含む建設機械に関する。
従来より、駆動機構の一部を電動化した建設機械が提案されている。このような建設機械では、上部旋回体を旋回させるための旋回機構の動力源として電動機を備え、この電動機の力行運転で旋回機構を加速(駆動)するとともに、旋回機構を減速(制動)する際に回生運転を行い、発電される電力をバッテリに充電している(例えば、特許文献1参照)。また、この特許文献1に記載された建設機械は、旋回機構以外の駆動機構を油圧で駆動するために油圧ポンプを備えるが、この油圧ポンプを駆動するためのエンジンに増速機を介して発電機を接続し、発電で得る電力をバッテリの充電と旋回機構の電動機の駆動に用いている。
特開平2004−036303号公報
ところで、旋回機構によって回転される上部旋回体には、キャビンやエンジンの他に、ブーム及びアーム等の作業機構が搭載される。この作業機構は自重が大きいため、ブーム又はアームが伸張されている状態と収縮されている状態とでは、上部旋回体の慣性モーメントは大きく異なり、ブーム又はアームが伸張されている状態の方が慣性モーメントは大きくなる。また、アームの先端のバケットに土砂等を積載している状態では、慣性モーメントがさらに大きくなる。
このように、慣性モーメントが大きくなると、上部旋回体の回転中心と重心のずれが大きくなるので、旋回機構の電動機を駆動するために、より多くの駆動トルクが必要となる。
このため、慣性モーメントを考慮していない特許文献1に記載の発明では、傾斜地で作業機構が斜面を登る方向に運転者が旋回操作を行う場合に、慣性モーメントが大きい状態では適切な駆動指令を生成することが困難となり、旋回機構の電動機の駆動トルクが不足して傾斜による回転トルクを上回ることができなくなり、運転者が旋回操作する方向とは逆の方向に旋回する場合があった。
そこで、本発明は、傾斜地においても安定的に旋回動作を行うことができる旋回駆動制御装置及びこれを含む建設機械を提供することを目的とする。
本発明の一局面の旋回駆動制御装置は、電動機で旋回駆動される建設機械の旋回機構を駆動制御する旋回駆動制御装置であって、建設機械の操作部を介して入力される操作量に基づき、前記電動機を駆動するための駆動指令を生成する駆動指令生成部と、前記旋回機構の旋回動作を検出する旋回動作検出部と、前記操作部に入力される旋回操作方向とは逆方向の旋回動作が前記旋回動作検出部によって検出されると、当該旋回操作方向とは逆方向の旋回動作の度合いに応じて、前記旋回操作方向とは逆方向の旋回動作を減じるように前記駆動指令を補正する駆動指令補正部とを含む。
また、前記駆動指令補正部は、前記電動機の回転速度を零にするための零速度指令と、前記旋回動作検出部によって検出される前記逆方向の旋回動作の度合いとに基づいて前記駆動指令を補正してもよい。
また、前記駆動指令補正部は、前記零速度指令の値と、前記旋回動作検出部によって検出される旋回動作の度合いを表す値とに基づいて補正用の駆動指令の値を演算し、当該補正用の駆動指令の値を前記駆動指令生成部によって生成される駆動指令の値に加算するように構成されており、前記旋回動作検出部によって検出される旋回動作の方向が前記旋回操作方向と逆方向である場合は、前記補正用の駆動指令の値を前記駆動指令生成部によって生成される駆動指令の値に加算し、前記旋回動作検出部によって検出される旋回動作の方向が前記旋回操作方向と同一方向である場合は、前記駆動指令の値に加算する前記補正用の駆動指令の値を零にしてもよい。
また、前記補正用の駆動指令の値を演算するための前記駆動指令補正部の第1制御ゲインは、前記駆動指令を生成するための前記駆動指令生成部の第2制御ゲインよりも大きく設定されてもよい。
本発明の一局面の建設機械は、前記いずれかに記載の旋回駆動制御装置を含む。
本発明によれば、傾斜地においても安定的に旋回動作を行うことができる旋回駆動制御装置及びこれを含む建設機械を提供できるという特有の効果が得られる。
本実施の形態の旋回駆動制御装置を含む建設機械を示す側面図である。 図1に示す建設機械が傾斜角θの傾斜地にある状態を示す図である。 本実施の形態の旋回駆動制御装置を含む建設機械の構成を表すブロック図である。 本実施の形態の建設機械の速度指令変換部において操作レバーの操作量を速度指令に変換する変換特性を示す図である。 本実施の形態の旋回駆動制御装置の構成を表す制御ブロック図である。 本実施の形態の旋回駆動制御装置におけるトルク電流指令修正部及びの入出力特性を示す図であり、(a)は左旋回用の修正特性、(b)は右旋回用の修正特性を表す。
符号の説明
1 下部走行体
1A、1B 油圧モータ
2 旋回機構
3 上部旋回体
4 ブーム
5 アーム
6 バケット
7 ブームシリンダ
8 アームシリンダ
9 バケットシリンダ
10 キャビン
11 エンジン
12 電動発電機
13 減速機
14 メインポンプ
15 パイロットポンプ
16 高圧油圧ライン
17 コントロールバルブ
18 インバータ
19 バッテリ
20 インバータ
21 旋回用電動機
23 メカニカルブレーキ
24 旋回減速機
25 パイロットライン
26 操作装置
26A、26B レバー
26C ペダル
27 油圧ライン
28 油圧ライン
29 圧力センサ
30 コントローラ
31 速度指令変換部
32 駆動制御装置
40 旋回駆動制御装置
50 駆動指令生成部
51 減算器
52 PI制御部
53 トルク制限部
54 トルク制限部
55 減算器
56 PI制御部
57 電流変換部
58 旋回動作検出部
60 駆動指令補正部
61 補正用零速度指令生成部
62 減算器
63 PI制御部
64、66 リレー
65、67 トルク電流指令修正部
68 加算器
70 主制御部
以下、本発明の旋回駆動制御装置及びこれを含む建設機械を適用した実施の形態について説明する。
図1は、本実施の形態の旋回駆動制御装置を含む建設機械を示す側面図である。
この建設機械の下部走行体1には、旋回機構2を介して上部旋回体3が搭載されている。また、上部旋回体3には、ブーム4、アーム5、及びバケット6と、これらを油圧駆動するためのブームシリンダ7、アームシリンダ8、及びバケットシリンダ9に加えて、キャビン10及び動力源が搭載される。ここで、図1に示すように建設機械が平坦地にある場合は、旋回機構2の旋回軸は鉛直軸l1と同一方向となる。
図2は、図1に示す建設機械が傾斜角θの傾斜地にある状態を示す図である。傾斜地では、旋回機構2の旋回軸l2は鉛直軸l1に対して角度θだけ傾く。このため、従来のハイブリッド型の建設機械では、平坦地にある場合と異なり、既に課題として説明したように、駆動トルクが不足すると運転者が操作して上部旋回体3を旋回させようとする方向とは逆の方向に旋回するおそれがある。
「全体構成」
図3は、本実施の形態の旋回駆動制御装置を含む建設機械の構成を表すブロック図である。この図3では、機械的動力系を二重線、高圧油圧ラインを実線、パイロットラインを破線、電気駆動・制御系を一点鎖線でそれぞれ示す。
機械式駆動部としてのエンジン11と、アシスト駆動部としての電動発電機12は、ともに増力機としての減速機13の入力軸に接続されている。また、この減速機13の出力軸には、メインポンプ14及びパイロットポンプ15が接続されている。メインポンプ14には、高圧油圧ライン16を介してコントロールバルブ17が接続されている。
コントロールバルブ17は、本実施の形態の建設機械における油圧系の制御を行う制御装置であり、このコントロールバルブ17には、下部走行体1用の油圧モータ1A(右用)及び1B(左用)、ブームシリンダ7、アームシリンダ8、及びバケットシリンダ9が高圧油圧ラインを介して接続される。
また、電動発電機12には、インバータ18を介して蓄電装置としてのバッテリ19が接続されており、また、バッテリ19には、インバータ20を介して旋回用電動機21が接続されている。
旋回用電動機21の回転軸21Aには、レゾルバ22、メカニカルブレーキ23、及び旋回減速機24が接続される。また、パイロットポンプ15には、パイロットライン25を介して操作装置26が接続される。
操作装置26には、油圧ライン27及び28を介して、コントロールバルブ17及びレバー操作検出部としての圧力センサ29がそれぞれ接続される。この圧力センサ29には、本実施の形態の建設機械の電気系の駆動制御を行うコントローラ30が接続されている。
このような本実施の形態の建設機械は、エンジン11、電動発電機12、及び旋回用電動機21を動力源とするハイブリッド型の建設機械である。これらの動力源は、図1に示す上部旋回体3に搭載される。以下、各部について説明する。
「各部の構成」
エンジン11は、例えば、ディーゼルエンジンで構成される内燃機関であり、その出力軸は減速機13の一方の入力軸に接続される。このエンジン11は、建設機械の運転中は常時運転される。
電動発電機12は、電動(アシスト)運転及び発電運転の双方が可能な電動機であればよい。ここでは、電動発電機12として、インバータ20によって交流駆動される電動発電機を示す。この電動発電機12は、例えば、磁石がロータ内部に埋め込まれたIPM(Interior Permanent Magnetic)モータで構成することができる。電動発電機12の回転軸は減速機13の他方の入力軸に接続される。
減速機13は、2つの入力軸と1つの出力軸を有する。2つの入力軸の各々には、エンジン11の駆動軸と電動発電機12の駆動軸が接続される。また、出力軸にはメインポンプ14の駆動軸が接続される。エンジン11の負荷が大きい場合には、電動発電機12が電動(アシスト)を行い、電動発電機12の駆動力が減速機13の出力軸を経てメインポンプ14に伝達される。これによりエンジン11の駆動がアシストされる。一方、エンジン11の負荷が小さい場合は、エンジン11の駆動力が減速機13を経て電動発電機12に伝達されることにより、電動発電機12が発電運転による発電を行う。電動発電機12の電動運転と発電運転の切り替えは、コントローラ30により、エンジン11の負荷等に応じて行われる。
メインポンプ14は、コントロールバルブ17に供給するための油圧を発生するポンプである。この油圧は、コントロールバルブ17を介して油圧モータ1A、1B、ブームシリンダ7、アームシリンダ8、及びバケットシリンダ9の各々を駆動するために供給される。
パイロットポンプ15は、油圧操作系に必要なパイロット圧を発生するポンプである。この油圧操作系の構成については後述する。
コントロールバルブ17は、高圧油圧ラインを介して接続される下部走行体1用の油圧モータ1A、1B、ブームシリンダ7、アームシリンダ8、及びバケットシリンダ9の各々に供給する油圧を運転者の操作入力に応じて制御することにより、これらを油圧駆動制御する油圧制御装置である。
インバータ18は、電動発電機12とバッテリ19との間に設けられ、コントローラ30からの指令に基づき、電動発電機12の運転制御を行う。これにより、インバータ18が電動発電機12を電動運転している際には、必要な電力をバッテリ19から電動発電機12に供給する。また、電動発電機12を発電運転している際には、電動発電機12により発電された電力をバッテリ19に充電する。
バッテリ19は、インバータ18とインバータ20との間に配設されている。これにより、電動発電機12と旋回用電動機21の少なくともどちらか一方が電動運転又は力行運転を行っている際には、電動運転又は力行運転に必要な電力を供給するとともに、また、少なくともどちらか一方が発電運転又は回生運転を行っている際には、発電運転又は回生運転によって発生した回生電力を電気エネルギーとして蓄積するための電源である。
インバータ20は、旋回用電動機21とバッテリ19との間に設けられ、コントローラ30からの指令に基づき、旋回用電動機21に対して運転制御を行う。これにより、インバータが旋回用電動機21を力行運転している際には、必要な電力をバッテリ19から旋回用電動機21に供給する。また、旋回用電動機21が回生運転をしている際には、旋回用電動機21により発電された電力をバッテリ19へ充電する。
旋回用電動機21は、力行運転及び回生運転の双方が可能な電動機であればよく、上部旋回体3の旋回機構2を駆動するために設けられている。力行運転の際には、旋回用電動機21の回転駆動力の回転力が減速機24にて増幅され、上部旋回体3が加減速制御され回転運動を行う。また、上部旋回体3の慣性回転により、減速機24にて回転数が増加されて旋回用電動機21に伝達され、回生電力を発生させることができる。ここでは、旋回用電動機21として、PWM(Pulse Width Modulation)制御信号によりインバータ20によって交流駆動される電動機を示す。この旋回用電動機21は、例えば、磁石埋込型のIPMモータで構成することができる。これにより、より大きな誘導起電力を発生させることができるので、回生時に旋回用電動機21にて発電される電力を増大させることができる。
なお、バッテリ19の充放電制御は、バッテリ19の充電状態、電動発電機12の運転状態(電動運転又は発電運転)、旋回用電動機21の運転状態(力行運転又は回生運転)に基づき、コントローラ30によって行われる。
レゾルバ22は、旋回用電動機21の回転軸21Aの回転位置及び回転角度を検出するセンサであり、旋回用電動機21と機械的に連結することで旋回用電動機21の回転前の回転軸21Aの回転位置と、左回転又は右回転した後の回転位置との差を検出することにより、回転軸21Aの回転角度及び回転方向を検出するように構成されている。旋回用電動機21の回転軸21Aの回転角度を検出することにより、旋回機構2の回転角度及び回転方向が導出される。
メカニカルブレーキ23は、機械的な制動力を発生させる制動装置であり、旋回用電動機21の回転軸21Aを機械的に停止させる。このメカニカルブレーキ23は、電磁式スイッチにより制動/解除が切り替えられる。この切り替えは、コントローラ30によって行われる。
旋回減速機24は、旋回用電動機21の回転軸21Aの回転速度を減速して旋回機構2に機械的に伝達する減速機である。これにより、力行運転の際には、旋回用電動機21の回転力を増力させ、より大きな回転力として旋回体へ伝達することができる。これとは逆に、回生運転の際には、旋回体で発生した回転数を増加させ、より多くの回転動作を旋回用電動機21に発生させることができる。
旋回機構2は、旋回用電動機21のメカニカルブレーキ23が解除された状態で旋回可能となり、これにより、上部旋回体3が左方向又は右方向に旋回される。
操作装置26は、旋回用電動機21、下部走行体1、ブーム4、アーム5、及びバケット6を操作するための操作装置であり、レバー26A及び26Bとペダル26Cを含む。レバー26Aは、旋回用電動機21及びアーム5を操作するためのレバーであり、上部旋回体3の運転席近傍に設けられる。レバー26Bは、ブーム4及びバケット6を操作するためのレバーであり、運転席近傍に設けられる。また、ペダル26Cは、下部走行体1を操作するための一対のペダルであり、運転席の足下に設けられる。
この操作装置26は、パイロットライン25を通じて供給される油圧(1次側の油圧)を運転者の操作量に応じた油圧(2次側の油圧)に変換して出力する。操作装置26から出力される2次側の油圧は、油圧ライン27を通じてコントロールバルブ17に供給されるとともに、圧力センサ29によって検出される。
レバー26A及び26Bとペダル26Cの各々が操作されると、油圧ライン27を通じてコントロールバルブ17が駆動され、これにより、油圧モータ1A、1B、ブームシリンダ7、アームシリンダ8、及びバケットシリンダ9内の油圧が制御されることによって、下部走行体1、ブーム4、アーム5、及びバケット6が駆動される。
なお、油圧ライン27は、油圧モータ1A及び1Bを操作するために1本ずつ(すなわち合計2本)、ブームシリンダ7、アームシリンダ8、及びバケットシリンダをそれぞれ操作するために2本ずつ(すなわち合計6本)設けられるため、実際には全部で8本あるが、説明の便宜上、1本にまとめて表す。
レバー操作検出部としての圧力センサ29では、レバー26Aの操作による、油圧ライン28内の油圧の変化が圧力センサ29で検出される。圧力センサ29は、油圧ライン28内の油圧を表す電気信号を出力する。この電気信号は、コントローラ30に入力される。これにより、レバー26Aの操作量を的確に把握することができる。また、本実施の形態では、レバー操作検出部としての圧力センサを用いたが、レバー26Aの操作量をそのまま電気信号で読み取るセンサを用いてもよい。
「コントローラ30」
コントローラ30は、本実施の形態の建設機械の駆動制御を行う制御装置であり、速度指令変換部31、駆動制御装置32、及び旋回駆動制御装置40を含む。このコントローラ30は、CPU(Central Processing Unit)及び内部メモリを含む演算処理装置で構成され、速度指令変換部31、駆動制御装置32、及び旋回駆動制御装置40は、コントローラ30のCPUが内部メモリに格納される駆動制御用のプログラムを実行することにより、
実現される装置である。
速度指令変換部31は、圧力センサ29から入力される信号を速度指令に変換する演算処理部である。これにより、レバー26Aの操作量は、旋回用電動機21を回転駆動させるための速度指令(rad/s)に変換される。この速度指令は、駆動制御装置32及び旋回駆動制御装置40に入力される。なお、この速度指令変換部31で用いる変換特性については、図4を用いて説明する。
ここで、本明細書及び特許請求の範囲では、運転者が操作装置26のレバー26Aを中立点より操作して上部旋回体3を旋回させようとする方向(すなわち、操作装置26に入力される旋回方向)を「旋回操作方向」と称す。
駆動制御装置32は、電動発電機12の運転制御(電動運転又は発電運転の切り替え)、及び、バッテリ19の充放電制御を行うための制御装置である。この駆動制御装置32は、エンジン11の負荷の状態とバッテリ19の充電状態に応じて、電動発電機12の電動運転と発電運転を切り替える。駆動制御装置32は、電動発電機12の電動運転と発電運転を切り替えることにより、インバータ18を介してバッテリ19の充放電制御を行う。
「操作量/速度指令の変換特性」
図4は、本実施の形態の建設機械の速度指令変換部31において操作レバー26Aの操作量を速度指令(上部旋回体3を旋回させるために旋回用電動機21を回転させるための速度指令)に変換する変換特性を示す図である。この変換特性は、操作レバー26Aの操作量に応じて、不感帯領域、零速度指令領域(左旋回用及び右旋回用)、左方向旋回駆動領域、及び右方向旋回駆動領域の5つの領域に区分される。
ここで、本実施の形態の建設機械の制御系では、左旋回を表す値を正の値で表し、右旋回を表す値を負の値で表すこととする。このため、上部旋回体3を左方向に旋回させるための速度指令の値が正となり、右方向に旋回させるための速度指令の値が負となる。
「不感帯領域」
この変換特性に示すように、不感帯領域は、レバー26Aの中立点付近に設けられている。この不感帯領域では、速度指令変換部31から速度指令は出力されず、旋回駆動制御装置40による旋回用電動機21の駆動制御は行われない。また、不感帯領域では、メカニカルブレーキ23によって旋回用電動機21が機械的に停止された状態となる。
従って、レバー26Aの操作量が不感帯領域内にある間は、メカニカルブレーキ23によって旋回用電動機21が機械的に停止され、これにより、上部旋回体3が機械的に停止された状態となる。
「零速度指令領域」
零速度指令領域は、レバー26Aの操作方向における不感帯領域の両外側に設けられている。この零速度指令領域は、不感帯領域における上部旋回体3の停止状態と、左右方向の旋回駆動領域における旋回状態とを切り替える際に操作性を良くするために設けられる緩衝領域である。
操作レバー26Aの操作量がこの零速度指令領域の範囲内にあるときは、速度指令変換部31から零速度指令が出力され、メカニカルブレーキ23は解除された状態となる。
ここで、零速度指令とは、上部旋回体3の旋回速度を零にするために、旋回用電動機21の回転軸21Aの回転速度を零にするための速度指令であり、後述するPI(Proportional Integral)制御では、回転軸21Aの回転速度を零に近づけるための目標値として用いられる。
なお、メカニカルブレーキ23の制動(オン)/解除(オフ)の切り替えは、不感帯領域と零速度指令領域の境界においてコントローラ30内の旋回駆動制御装置40によって行われる。
従って、平坦地では、レバー26Aの操作量が零速度指令領域内にある間は、メカニカルブレーキ23は解除され、零速度指令により、旋回用電動機21の回転軸21Aは停止状態に保持される。これにより、平坦地では、上部旋回体3は旋回駆動されずに停止状態に保持される。
「左方向旋回駆動領域」
左方向旋回駆動領域は、上部旋回体3を左方向に旋回させるための速度指令が速度指令変換部31から出力される領域である。
この領域内では、レバー26Aの操作量に応じて、速度指令の絶対値が増大するように設定されている。具体的には、図3において速度指令が(+)の方向へ増大する。平坦地では、この速度指令に基づいて旋回駆動制御装置40で駆動指令が演算され、この駆動指令によって旋回用電動機21が駆動され、この結果、上部旋回体3が左方向に旋回駆動される。なお、図4中の速度指令の絶対値は、レバー26Aの操作量が一定の範囲を超えると一定値となっているが、これは、旋回速度を予め定められた値以下に制限するために、速度指令値の絶対値を制限していることを示している。
なお、上部旋回体3の旋回速度をある一定以下に制限するために、左方向旋回駆動領域における速度指令値は、絶対値が所定の値で制限される。
「右方向旋回駆動領域」
右方向旋回駆動領域は、上部旋回体3を右方向に旋回させるための速度指令が速度指令変換部31から出力される領域である。
この領域内では、レバー26Aの操作量に応じて、速度指令の絶対値が増大するように設定されている。具体的には、図3において速度指令が(−)の方向へ増大する。平坦地では、この速度指令に基づいて旋回駆動制御装置40で駆動指令が演算され、この駆動指令によって旋回用電動機21が駆動され、この結果、上部旋回体3が右方向に旋回駆動される。
なお、左方向旋回駆動領域と同様に、右方向旋回駆動領域における速度指令値は、絶対値が所定の値で制限される。
「旋回駆動制御装置40」
図5は、本実施の形態の旋回駆動制御装置40の構成を示す制御ブロック図である。
旋回駆動制御装置40は、インバータ20を介して旋回用電動機21の駆動制御を行うための制御装置であり、旋回用電動機21を駆動するための駆動指令を生成する駆動指令生成部50、駆動指令を補正する駆動指令補正部60、及び制御部70を含む。
駆動指令生成部50には、レバー26Aの操作量に応じて速度指令変換部31から出力される速度指令が入力され、この駆動指令生成部50は速度指令に基づき駆動指令を生成する。駆動指令生成部50から出力される駆動指令はインバータ20に入力され、このインバータ20によって旋回用電動機21がPWM制御信号により交流駆動される。
駆動指令補正部60は、旋回用電動機21の駆動制御に際して、運転者によって指定される旋回操作方向と上部旋回体3の旋回方向が異なる場合には、旋回用電動機21を駆動するための駆動指令を補正する。
制御部70は、旋回駆動制御装置40の制御処理に必要な周辺処理を行う制御部である。具体的な処理内容については、関連箇所においてその都度説明する。
「駆動指令生成部50」
駆動指令生成部50は、減算器51、PI制御部52、トルク制限部53、トルク制限部54、減算器55、PI制御部56、電流変換部57、及び旋回動作検出部58を含む。この駆動指令生成部50の減算器51には、レバー26Aの操作量に応じた旋回駆動用の速度指令(rad/s)が入力される。
減算器51は、レバー26Aの操作量に応じた速度指令の値(以下、速度指令値)から、旋回動作検出部58によって検出される旋回用電動機21の回転速度(rad/s)を減算して偏差を出力する。この偏差は、後述するPI制御部52において、旋回用電動機21の回転速度を速度指令値(目標値)に近づけるためのPI制御に用いられる。
PI制御部52は、減算器51から入力される偏差に基づき、旋回用電動機21の回転速度を速度指令値(目標値)に近づけるように(すなわち、この偏差を小さくするように)PI制御を行い、そのために必要なトルク電流指令を演算する。生成されたトルク電流指令は、トルク制限部53に入力される。
トルク制限部53は、レバー26Aの操作量に応じてトルク電流指令の値(以下、トルク電流指令値)を制限する処理を行う。この制限処理は、レバー26Aの操作量に応じてトルク電流指令値が緩やかに増大するようにトルク電流指令値を制限する制限特性に基づいて行われる。このようなトルク電流指令値の制限は、PI制御部52によって演算されるトルク電流指令値が急激に増大すると制御性が悪化するため、これを抑制するために行われる。
この制限特性は、レバー26Aの操作量の増大に伴ってトルク電流指令値を緩やかに増大させる特性を有し、上部旋回体3の左方向及び右方向の双方向を制限するための特性を有するものである。制限特性を表すデータは、制御部70の内部メモリに格納されており、トルク制限部53によって読み出される。
トルク制限部54は、後述する加算器68から入力されるトルク電流指令によって生じるトルクが旋回用電動機21の許容最大トルク値以下となるように、加算器68から入力されるトルク電流指令値を制限する。このトルク電流指令値の制限は、トルク制限部53と同様に、上部旋回体3の左方向及び右方向の双方向の回転に対して行われる。
ここで、トルク制限部54においてトルク電流指令値を制限するための上限値(左旋回用の最大値)及び下限値(右旋回用の最小値)は、このトルク制限部54によってトルク電流指令値の制限が行われても、傾斜地で、ブーム4、アーム5、及びブーム6が伸張されて上部旋回体3の慣性モーメントが大きい状態においても、ブーム4、アーム5、及びブーム6を斜面の上方に旋回させるための駆動トルクを発生できるような値に設定されている。なお、トルク電流指令値を制限するための特性を表すデータは、制御部70の内部メモリに格納されており、トルク制限部54によって読み出される。
減算器55は、トルク制限部54から入力されるトルク電流指令値から、電流変換部57の出力値を減算して得る偏差を出力する。この偏差は、後述するPI制御部56及び電流変換部57を含むフィードバックループにおいて、電流変換部57から出力される旋回用電動機21の駆動トルクを、トルク制限部54を介して入力されるトルク電流指令値(目標値)によって表されるトルクに近づけるためのPI制御に用いられる。
PI制御部56は、減算器55から入力される偏差に基づき、この偏差を小さくするようにPI制御を行い、インバータ20に送る最終的な駆動指令となるトルク電流指令を生成する。インバータ20は、PI制御部56から入力されるトルク電流指令に基づき、旋回用電動機21をPWM駆動する。
電流変換部57は、旋回用電動機21のモータ電流を検出し、これをトルク電流指令に相当する値に変換し、減算器55に入力する。
旋回動作検出部58は、レゾルバ22によって検出される旋回用電動機21の回転位置の変化(すなわち上部旋回体3の旋回)を検出するとともに、回転位置の時間的に変化から旋回用電動機21の回転速度を微分演算によって導出する。導出された回転速度を表すデータは、減算器51及び駆動指令補正部60に入力される。
このような構成の駆動指令生成部50において、速度指令変換部31から入力される速度指令に基づき、旋回用電動機21を駆動するためのトルク電流指令が生成され、平坦地では、上部旋回体3が所望の位置まで旋回される。このような旋回動作は、平坦地では油圧駆動の建設機械と同様の操作手法により、同様の動作が実現される。
ところで、上述のように、建設機械が傾斜地にある場合には、慣性モーメントが大きいと上部旋回体3が旋回する可能性がある。
しかしながら、本実施の形態の旋回駆動制御装置では、駆動指令補正部60によってトルク電流指令を補正するため、このような旋回操作方向とは逆方向の旋回を減じることができる。以下、駆動指令補正部60について説明する。
「駆動指令補正部60」
駆動指令補正部60は、補正用零速度指令生成部61、減算器62、PI制御部63、リレー64、トルク電流指令修正部65、リレー66、トルク電流指令修正部67、及び加算器68を含み、上述のような操作装置26に入力される旋回操作方向とは逆方向の旋回が生じた場合に、これを減じるために旋回用電動機21を駆動するためのトルク電流指令を補正する演算処理部である。
補正用零速度指令生成部61は、補正用の零速度指令(rad/s)を出力する。この補正用の零速度指令は、駆動指令生成部50で演算されるトルク電流指令が足りない場合に、このトルク電流指令を補正するための補正用のトルク電流指令(以下、補正用トルク電流指令)を生成するための速度指令である。補正用零速度指令生成部61は、レバー26Aの操作量が零速度指令領域、左方向旋回駆動領域、及び右方向旋回駆動領域にある間は、常に補正用の零速度指令を出力する。
減算器62は、補正用零速度指令生成部61から入力される補正用の零速度指令の値(以下、補正用零速度指令値)から回転速度の値(以下、回転速度値)を減算する。減算によって得られる偏差は、PI制御部63に入力される。
PI制御部63は、減算器62から入力される偏差に基づき、この偏差を小さくするように(すなわち、補正用零速度指令生成部61から入力される補正用零速度指令値を目標値として回転速度を零に近づけるように)PI制御を行い、駆動指令生成部50によって生成されるトルク電流指令値を補正するための補正用トルク電流指令値を生成する。
ここで、PI制御部63の制御ゲインは、PI制御部52の制御ゲインに比べて大きく設定される。PI制御部52は、旋回用電動機21を駆動するためのトルク電流指令値を生成する駆動指令生成部50に含まれるため、制御ゲイン(比例ゲイン及び/又は積分ゲイン)をあまり大きくすると、オーバーシュートの原因になる可能性があるため好ましくない。
しかしながら、PI制御部63は、駆動指令生成部50に送るための補正用トルク電流指令値を演算するため、制御ゲイン(比例ゲイン及び/又は積分ゲイン)を大きくしてもオーバーシュートの原因にはなりにくく、逆方向の旋回動作を迅速に抑制することができる。このため、例えば、PI制御部52に対して、PI制御部63の比例ゲインを4倍程度に、かつ、積分ゲインを10倍程度に設定してもよい。
リレー64は、操作レバー26Aによって左旋回が指定された場合に閉成され、これによりトルク電流指令修正部65が選択される。このリレー64の開閉制御は、制御部70によって行われる。
トルク電流指令修正部65は、旋回操作方向(左旋回)と上部旋回体3の回転方向の異同に基づき、必要に応じてPI制御部63から送られる補正用トルク電流指令値を修正する修正処理を行う。この修正処理では、図6に示す特性を用いる。なお、上部旋回体3の回転方向は、旋回用電動機21の回転方向より得られる。
図6は、本実施の形態の旋回駆動制御装置におけるトルク電流指令修正部65及び67の入出力特性を示す図であり、(a)は左旋回用の修正特性、(b)は右旋回用の修正特性を表す。
ここで、図6(a)及び(b)の横軸は、PI制御部63からリレー64及び66を介してトルク電流指令修正部65及び67に入力される補正用トルク電流指令値の値を表す。この入力値(補正用トルク電流指令値)は、減算器62において補正用零速度指令値から回転速度値を減算して得られる偏差に基づいてPI制御部63で演算されるため、上部旋回体3が左方向に旋回している場合に負の値をとる。これは、左旋回を表す回転速度は正の値であるが、減算器62で補正用零速度指令値から減算されて符号が反転して負の値になり、さらにPI制御部63で右方向への駆動トルクを発生させるために負の値を有する補正用トルク電流指令値を生成するからである。
同様に、トルク電流指令修正部65及び67の入力値は、上部旋回体3が右方向に旋回している場合に正の値をとる。これは、右旋回を表す回転速度は負の値であるが、減算器62で補正用零速度指令値から減算されて符号が反転して正の値になり、さらにPI制御部63で左方向への駆動トルクを発生させるために正の値を有する補正用トルク電流指令値を生成するからである。
このため、図6(a)及び(b)では、トルク電流指令修正部65及び67の入力値を表す横軸が負の場合が上部旋回体3の左方向の旋回に対応し、横軸が正の場合が上部旋回体3の右方向の旋回に対応する。
また、図6(a)、(b)の縦軸は、トルク電流指令修正部65及び67から出力される修正後の補正用トルク電流指令値を表し、図4と同様に、上部旋回体3を左旋回方向へ旋回させるための補正用トルク電流指令値を正の値で表し、右旋回方向へ旋回させるための補正用トルク電流指令値を負の値で表す。
なお、図6(a)及び(b)の特性を表すデータは、制御部70の内部メモリに格納されており、トルク電流指令修正部65及び67によって読み出される。
図6(a)に示すように、左旋回用の修正特性は、上部旋回体3が左方向に旋回している際には(修正特性の縦軸より左側の領域では)出力値が零となる特性を有する。また、上部旋回体3が右方向に旋回している際には(修正特性の縦軸より右側の領域では)入出力値の比(出力値/入力値)が「1」になる特性を有する。
レバー26Aによって左方向の旋回操作が行われているときに、上部旋回体3が左方向に旋回しているときは、駆動指令生成部50の内部で生成されるトルク電流指令だけで十分であり、補正用トルク電流指令値は不要である。
このため、トルク電流指令修正部65で用いる入出力特性は、図6(a)に示すように、入力値が(左旋回を表す)負の値である場合は、PI制御部63から入力される補正用トルク電流指令値を零にする特性となっている。トルク電流指令修正部65は、この特性を用いて、旋回操作方向(左旋回)と上部旋回体3の回転方向が同一の場合は、PI制御部63で演算される補正用トルク電流指令を零に修正する。
一方、レバー26Aによって左方向の旋回操作が行われているときに、上部旋回体3が右方向に逆旋回しているときは、駆動指令生成部50の内部で生成されるトルク電流指令だけでは不十分であるため、右方向(逆方向)への旋回動作を減じるために、PI制御部63で演算される補正用トルク電流指令を駆動指令生成部50に送る必要がある。
このため、トルク電流指令修正部65で用いる入出力特性は、図6(a)に示すように、入力値が(右旋回を表す)正の値である場合は、補正用トルク電流指令値を出力するために、入力値に対する出力値の比(出力値/入力値)が「1」の特性となっている。これにより、PI制御部63から入力される補正用トルク電流指令値と等しい値の補正用トルク電流指令値がトルク電流指令修正部65から出力される。なお、ここでは入出力比が「1」の場合について説明するが、この入出力比は零(0)以外の値であれば、制御系内のゲイン等に応じて任意に設定することができる値である。
トルク電流指令修正部65は、この特性を用いて、旋回操作方向(左旋回)と上部旋回体3の回転方向が異なる場合は、PI制御部63から入力される補正用トルク電流指令値と等しい値の補正用トルク電流指令値を駆動指令生成部50の加算器68に送る。
なお、旋回操作方向と旋回用電動機21の回転方向の異同の判定は、制御部70によって行われる。
リレー66は、操作レバー26Aによって右旋回が指定された場合に閉成され、これによりトルク電流指令修正部67が選択される。このリレー66の開閉制御は、制御部70によって行われる。
トルク電流指令修正部67は、旋回操作方向(右旋回)と上部旋回体3の回転方向の異同に基づき、必要に応じてPI制御部63から入力される補正用トルク電流指令値を修正する修正処理を行う。この修正処理では、図6(b)に示す特性を用いる。なお、上部旋回体3の回転方向は、レゾルバ22の検出値により得られる。
図6(b)に示すように、右旋回用の修正特性は、上部旋回体3が左方向に旋回している際には(修正特性の縦軸より左側の領域では)入出力値の比(出力値/入力値)が「1」になる特性を有する。また、上部旋回体3が右方向に旋回している際には(修正特性の縦軸より右側の領域では)出力値が零となる特性を有する。
修正処理の内容は、左右の方向が異なるだけでトルク電流指令修正部65と基本的に同一である。トルク電流指令修正部67は、旋回操作方向(右旋回)と上部旋回体3の回転方向が同一である場合は、駆動指令生成部50の内部で生成されるトルク電流指令だけで十分であり、補正用トルク電流指令値は不要であるため、トルク電流指令修正部67は、PI制御部63で演算される補正用トルク電流指令を零に修正する。
このため、トルク電流指令修正部67で用いられる入出力特性は、図6(b)に示すように、入力値が(右旋回を表す)正の値である場合は、PI制御部63から入力される補正用トルク電流指令値を零にする特性を有する。
一方、旋回操作方向(右旋回)と上部旋回体3の回転方向が異なる場合は、駆動指令生成部50の内部で生成されるトルク電流指令だけでは不十分であるため、左方向(逆方向)への旋回動作を減じるために、PI制御部63で演算される補正用トルク電流指令を駆動指令生成部50に送る必要がある。
このため、トルク電流指令修正部67で用いられる入出力特性は、図6(b)に示すように、入力値が(左旋回を表す)負の値である場合は、補正用トルク電流指令値を出力するために、入力値に対する出力値の比(出力値/入力値)が「1」の特性となっている。これにより、PI制御部63から入力される補正用トルク電流指令値と等しい値の補正用トルク電流指令値がトルク電流指令修正部65から出力される。なお、ここでは入出力比が「1」の場合について説明するが、この入出力比は零(0)以外の値であれば、制御系内のゲイン等に応じて任意に設定することができる値である。
トルク電流指令修正部67は、この特性を用いて、PI制御部63で演算される補正用トルク電流指令値と等しい値の補正用トルク電流指令値を駆動指令生成部50の加算器68に送る。
なお、旋回操作方向と旋回用電動機21の回転方向の異同の判定は、制御部70によって行われる。
加算器68は、トルク制限部53から送られるトルク電流指令値と、旋回操作方向と上部旋回体3の回転方向が異なる場合にトルク電流指令修正部65又はトルク電流指令修正部67から入力される補正用トルク電流指令値とを加算する。この加算処理によって駆動指令生成部50によって生成されるトルク電流指令が補正される。
なお、リレー64及び66は、レバー26Aによって旋回方向が指定されることによって閉成されるリレーであり、旋回方向が指定されていない場合は開放される。
「駆動指令補正部60による補正が行われない場合の旋回操作(比較例)」
ここで、比較のために、駆動指令補正部60による補正が行われない場合の旋回操作(すなわち、図4の変換特性による速度指令のみによる旋回動作)について説明する。
平坦地において、停止状態からレバー26Aが左旋回方向に操作されて行くと、不感帯領域を越えて零速度指令領域に切り替わる際に、メカニカルブレーキ23が解除されるとともに、速度指令変換部31から出力される零速度指令が駆動指令生成部50に入力される。零速度指令が入力されると、旋回用電動機21の回転軸21Aが回転して旋回動作検出部58から回転速度を表すデータが出力されて減算器51から回転速度の偏差が出力されても、この回転速度の偏差を零にするように旋回用電動機21が駆動制御され、回転軸21Aが停止状態に保持される。
さらに、レバー26Aが操作されることにより、速度指令特性が零速度指令領域を越えて左旋回駆動領域に切り替わると、速度指令変換部31から出力される速度指令に基づくトルク電流指令が駆動指令生成部50から出力される。これにより、速度指令変換部31から出力される速度指令を目標値とした駆動制御が行われ、旋回用電動機21の回転軸21Aが駆動されて上部旋回体3が左方向に旋回する。
また、平坦地で上部旋回体3が左方向に旋回している状態でレバー26Aの操作量を減じて行き、速度指令特性が左方向旋回駆動領域から零速度指令領域に切り替わると、零速度指令によって旋回用電動機21の回転軸21Aが停止状態に保持される。
さらに、レバー26Aの操作量を減じて行き、速度指令特性が零速度指令領域から不感帯領域に切り替わると、メカニカルブレーキ23が掛かるとともに、速度指令変換部31から駆動指令は出力されなくなり、駆動指令生成部50は駆動制御を行わなくなる。これにより、旋回用電動機21の回転軸21Aは機械的に停止された状態となる。これら一連の動作は平坦地における右方向の旋回動作においても同様であるため、その説明は省略する。
このように、平坦地では、上述のように運転者がレバー26Aに入力する旋回操作方向に応じた上部旋回体3の旋回駆動が可能である。
また、傾斜地において、重量の大きいブーム4、アーム5、及びバケット6が斜面下方に向かう方向に上部旋回体3を旋回させる場合も、上述の平坦地の場合と同様に旋回を行うことができる。
しかしながら、傾斜地において、重量の大きいブーム4、アーム5、及びバケット6が斜面上方に向かう方向に上部旋回体3を旋回させる場合は、速度指令によって旋回用電動機21の回転軸21Aに生じる駆動トルクよりも、慣性モーメントによって上部旋回体3が逆方向に旋回するトルクの方が大きくなる場合がある。この場合には、重量の大きいブーム4、アーム5、及びバケット6が斜面下方に向かう方向に上部旋回体3が旋回してしまう。
すなわち、傾斜地では、レバー26Aで左方向又は右方向への旋回操作を行い、操作量が零速度指令領域にある場合でも、旋回操作方向とは逆方向に旋回する場合がある。
また、速度指令特性が左方向旋回領域又は右方向旋回領域にある場合でも、旋回用電動機21の回転軸21Aに生じる駆動トルクよりも、慣性モーメントによって上部旋回体3が旋回するトルクの方が大きくなる場合がある。この場合には、上部旋回体3が旋回操作方向とは逆方向(ブーム4、アーム5、及びバケット6が斜面下方に向かう方向)に旋回してしまう。
すなわち、傾斜地では、レバー26Aで左方向又は右方向への旋回操作を行い、操作量が左方向旋回領域又は右方向旋回領域にある場合でも、旋回操作方向とは逆方向に旋回する場合がある。
ところが本実施の形態の旋回駆動制御装置を含む建設機械によれば、駆動指令補正部60によって駆動指令の補正が行われるため、このような旋回操作方向とは逆方向への旋回を減じることができ、さらに動きだしを滑らかにすることができる。以下、その原理を説明する。
「駆動指令補正部60による補正が行われる場合の旋回動作」
次に、本実施の形態の旋回駆動制御装置を含む建設機械の平坦地及び傾斜地における旋回動作を説明する。駆動指令補正部60による補正が行われると、比較のために説明した補正が行われな平坦地での旋回動作とは異なり、以下のように旋回操作方向とは逆方向への旋回が減じられる。
傾斜地においても、慣性力の影響を受けない程度の緩やかな傾斜で旋回動作をさせる婆合いには、平坦地と同様に、レバー26Aの操作量に応じた左方向又は右方向への速度指令特性に基づき、駆動指令生成部50でトルク電流指令が演算される。また、傾斜が緩やかであると、平坦地と同様に上部旋回体3を旋回させるための旋回用電動機21の駆動トルクが不足することはなく、旋回操作方向とは逆方向への旋回は検出されない。このため、トルク電流指令修正部65及びトルク電流指令修正部67から出力される補正値は零であり、トルク電流値の補正は行われない。これにより、平坦地では図4に示す速度指令特性に応じた旋回動作が行われる。
これと同様に、傾斜地において、重量の大きいブーム4、アーム5、及びバケット6が斜面下方に向かう方向に上部旋回体3を旋回させる場合も、平坦地の場合と同様に上部旋回体3を旋回させるための旋回用電動機21の駆動トルクが不足することはなく、旋回操作方向とは逆方向への旋回は検出されないため、旋回操作方向と同一の方向に旋回を行うことができる。
次に、傾斜地において、重量の大きいブーム4、アーム5、及びバケット6が左方向の旋回を行うことで斜面上方に向かう方向に上部旋回体を旋回させる際の動作について説明する。
運転者によるレバー26Aの操作により左旋回が指定されると、レバー26Aの操作量が図4に示す零速度指令領域に入ってメカニカルブレーキ23が解除される。この状態で、旋回動作検出部58によって右方向(逆方向)の旋回が検出されると、減算器62から回転速度の偏差(正の値)が出力され、この偏差に基づいてPI制御部63で正の値を有する補正用トルク電流指令値が演算される。この補正用トルク電流指令値は、トルク電流指令修正部65に入力され、この入力値と等しい値を有する補正用トルク電流指令値がトルク電流指令修正部65から出力され、加算器68においてトルク制限部53から出力されるトルク電流指令値(左旋回用の正の値を有する)と加算される。
ここで、上部旋回体3の慣性力によって右方向(逆方向)へ動き出す際には、減算器62から出力される偏差は増大する。このため、トルク電流指令修正部65から出力される出力値も右方向(逆方向)への動きだしの際には増大し、トルク制限部53から出力されるトルク電流指令値も増大する(図6(a)。そして、旋回用電動機21の駆動トルクが増大すると、上部旋回体3を左方向(正方向)へ回転させようとする力が大きくなるため、上部旋回体3の右方向(逆方向)への回転速度は低下し始める。これにより、減算器62からの偏差は徐々に減少し、トルク電流指令修正部65から出力される補正用トルク電流指令値も徐々に小さくなる。このようにして右方向(逆方向)への旋回動作が減じられる。
なお、逆方向への旋回が停止するのは、旋回用電動機21の駆動軸に発生する駆動トルクと上部旋回体3の重力が吊り合うときである。この吊り合いの位置は、傾斜角や上部旋回体3の慣性モーメントによって決まるため、レバー26Aの操作量が零速度指令領域内にあるときに吊り合いが取れる場合もあれば、レバー26Aの操作量がさらに増して左方向旋回駆動領域に入ってから吊り合いが取れる場合もある。この吊り合いの位置にレバー26Aの操作量が到達するまでの間は、駆動指令補正部60で生成される補正用トルク電流指令値によって逆方向の旋回が減じられるため、運転者がレバー26Aの操作量を増やすことにより、滑らかに左方向への旋回動作を行うことができる。
その後、上部旋回体3が左方向(正方向)へ旋回すると、旋回駆動制御装置40においては駆動指令補正部60による補正処理は行われず、平坦地と同様の処理が行われる。
なお、傾斜地において、重量の大きいブーム4、アーム5、及びバケット6が斜面上方に向かう方向に上部旋回体3を旋回させるために、右方向の旋回を行う場合は、上述の動作説明において左右を入れ替えた内容となるため、省略する。
以上より、本実施の形態の旋回駆動制御装置を含む建設機械によれば、旋回操作方向とは逆方向の上部旋回体3の旋回が検出されても、駆動指令補正部60で生成される補正用トルク電流指令値によって旋回用電動機21の駆動トルクが補われるため、傾斜地でブーム4等の重量物が斜面上方に移動するように上部旋回体3を旋回させようとした場合に、上部旋回体3の慣性モーメントが大きくても、旋回操作方向とは逆方向への旋回を減じることができる。これにより、動き出しの滑らかな旋回動作を実現できる旋回駆動制御装置及び建設機械を提供することができる。
なお、本実施の形態のように駆動指令補正部60を備えることなく、PI制御部52又は56におけるPI制御のゲインを増大させることによって旋回操作方向とは逆方向の旋回動作を減じる手法も考えられる。しかしながら、このような手法では、増大されたゲインを用いたPI制御により、速度指令(運転者の入力)に基づいてトルク電流指令値が演算されることになるため、PI制御におけるオーバーシュートが生じ、トルク電流指令値が目標値に収束しにくくなり、これにより滑らかな旋回動作が実現しにくくなるという課題がある。
これに対して、本実施の形態の旋回駆動制御装置を含む建設機械によれば、上述のように、駆動指令生成部50におけるPI制御のゲインを増大させることなく、駆動指令補正部60で演算される補正用トルク電流指令値によって旋回操作方向とは逆方向の旋回動作が減じられるため、動き出しの滑らかな旋回動作と良好な乗り心地を提供することができる。
以上では、旋回用電動機21がインバータ20によってPWM駆動される交流モータであり、その回転速度を検出するために、レゾルバ22及び旋回動作検出部58を用いる形態について説明したが、旋回用電動機21は直流モータであってもよい。この場合は、インバータ20、レゾルバ22及び旋回動作検出部58が不要となり、回転速度としては直流モータのタコジェネレータで検出される値を用いればよい。
また、以上では、駆動指令補正部60が補正用零速度指令生成部61を含み、補正用トルク電流指令値を演算するための補正用零速度指令が駆動指令補正部60の内部で生成される形態について説明したが、駆動指令補正部60が補正用零速度指令生成部61を含まずに、駆動指令補正部60の外部から補正用零速度指令が供給されるように構成されていてもよい。
また、以上では、トルク電流指令の演算にPI制御を用いる形態について説明したが、これに代えて、ロバスト制御、適応制御、比例制御、積分制御等を用いてもよい。
また、以上では、ハイブリッド型の建設機械を用いて説明したが、旋回機構が電動化されている建設機械であれば、本実施の形態の旋回駆動装置の適用対象は、バイブリッド型に限定されるものではない。
以上、本発明の例示的な実施の形態の旋回駆動制御装置及びこれを用いた建設機械について説明したが、本発明は、具体的に開示された実施の形態に限定されるものではなく、特許請求の範囲から逸脱することなく、種々の変形や変更が可能である。
本国際出願は、2007年10月18日に出願した日本国特許出願第2007−271656号に基づく優先権を主張するものであり、日本国特許出願第2007−271656号の全内容を本国際特許出願に援用する。

Claims (5)

  1. 電動機で旋回駆動される建設機械の旋回機構を駆動制御する旋回駆動制御装置であって、
    建設機械の操作部を介して入力される操作量に基づき、前記電動機を駆動するための駆動指令を生成する駆動指令生成部と、
    前記旋回機構の旋回動作を検出する旋回動作検出部と、
    前記操作部に入力される旋回操作方向とは逆方向の旋回動作が前記旋回動作検出部によって検出されると、当該旋回操作方向とは逆方向の旋回動作の度合いに応じて、前記旋回操作方向とは逆方向の旋回動作を減じるように前記駆動指令を補正する駆動指令補正部と
    を含む、旋回駆動制御装置。
  2. 前記駆動指令補正部は、前記電動機の回転速度を零にするための零速度指令と、前記旋回動作検出部によって検出される前記逆方向の旋回動作の度合いとに基づいて前記駆動指令を補正する、請求項1に記載の旋回駆動制御装置。
  3. 前記駆動指令補正部は、前記零速度指令の値と、前記旋回動作検出部によって検出される旋回動作の度合いを表す値とに基づいて補正用の駆動指令の値を演算し、当該補正用の駆動指令の値を前記駆動指令生成部によって生成される駆動指令の値に加算するように構成されており、
    前記旋回動作検出部によって検出される旋回動作の方向が前記旋回操作方向と逆方向である場合は、前記補正用の駆動指令の値を前記駆動指令生成部によって生成される駆動指令の値に加算し、前記旋回動作検出部によって検出される旋回動作の方向が前記旋回操作方向と同一方向である場合は、前記駆動指令の値に加算する前記補正用の駆動指令の値を零にする、請求項2に記載の旋回駆動制御装置。
  4. 前記補正用の駆動指令の値を演算するための前記駆動指令補正部の第1制御ゲインは、前記駆動指令を生成するための前記駆動指令生成部の第2制御ゲインよりも大きく設定される、請求項3に記載の旋回駆動制御装置。
  5. 請求項1に記載の旋回駆動制御装置を含む建設機械。
JP2009538181A 2007-10-18 2008-10-17 旋回駆動制御装置及びこれを含む建設機械 Expired - Fee Related JP5653041B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009538181A JP5653041B2 (ja) 2007-10-18 2008-10-17 旋回駆動制御装置及びこれを含む建設機械

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP2007271656 2007-10-18
JP2007271656 2007-10-18
PCT/JP2008/068905 WO2009051247A1 (ja) 2007-10-18 2008-10-17 旋回駆動制御装置及びこれを含む建設機械
JP2009538181A JP5653041B2 (ja) 2007-10-18 2008-10-17 旋回駆動制御装置及びこれを含む建設機械

Publications (2)

Publication Number Publication Date
JPWO2009051247A1 true JPWO2009051247A1 (ja) 2011-03-03
JP5653041B2 JP5653041B2 (ja) 2015-01-14

Family

ID=40567509

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009538181A Expired - Fee Related JP5653041B2 (ja) 2007-10-18 2008-10-17 旋回駆動制御装置及びこれを含む建設機械

Country Status (6)

Country Link
US (1) US8473165B2 (ja)
EP (1) EP2208829A4 (ja)
JP (1) JP5653041B2 (ja)
KR (1) KR101317631B1 (ja)
CN (1) CN102124166B (ja)
WO (1) WO2009051247A1 (ja)

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8283879B2 (en) * 2006-08-04 2012-10-09 Millennium Oilflow Systems & Technology Inc. Braking controller of a three-phase permanent magnetic brushless DC motor for directly driving a screw pump
JP5420324B2 (ja) * 2009-06-23 2014-02-19 住友建機株式会社 旋回駆動制御装置及びこれを含む建設機械
JP5185349B2 (ja) * 2010-10-08 2013-04-17 日立建機株式会社 ハイブリッド式建設機械
JP5562893B2 (ja) * 2011-03-31 2014-07-30 住友建機株式会社 ショベル
CA2968400A1 (en) 2011-04-29 2012-11-01 Harnischfeger Technologies, Inc. Controlling a digging operation of an industrial machine
CN103620125B (zh) * 2011-08-09 2016-05-04 住友建机株式会社 回转驱动装置
CN103717808A (zh) * 2011-08-12 2014-04-09 伊顿公司 用于回收惯性能量的方法和装置
WO2013039182A1 (ja) 2011-09-15 2013-03-21 住友重機械工業株式会社 電動旋回制御装置及び旋回用電動機の制御方法
JP5982774B2 (ja) * 2011-10-11 2016-08-31 セイコーエプソン株式会社 モーター制御装置、ロボットハンド
CA2872608C (en) * 2012-06-08 2017-05-02 Volvo Construction Equipment Ab Apparatus for controlling a cascaded hybrid construction machine system and a method therefor
CN102748202B (zh) * 2012-07-04 2015-02-18 徐工集团工程机械股份有限公司 液压泵马达转矩控制方法及系统
US8909437B2 (en) * 2012-10-17 2014-12-09 Caterpillar Inc. Payload Estimation system
JP6125272B2 (ja) * 2013-02-26 2017-05-10 住友建機株式会社 電動旋回式作業機械
JP6529721B2 (ja) * 2014-05-08 2019-06-12 住友建機株式会社 建設機械
KR101634609B1 (ko) * 2015-07-17 2016-06-29 주식회사 디지워크 영상 음성 데이터 처리 방법 및 이를 실행하는 단말 장치
JP6848845B2 (ja) * 2017-12-15 2021-03-24 オムロン株式会社 サーボモータの負荷状態診断装置及び負荷状態診断方法
JP7229109B2 (ja) * 2019-06-19 2023-02-27 株式会社小松製作所 作業機械および作業機械の制御方法
JP7472761B2 (ja) 2020-11-18 2024-04-23 コベルコ建機株式会社 旋回制御装置及び作業機械
IT202100018932A1 (it) * 2021-07-16 2023-01-16 Cnh Ind Italia Spa Metodo e sistema di controllo di un attuatore idraulico per un veicolo da lavoro elettrificato

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA1222824A (en) * 1982-10-18 1987-06-09 David Eglise Data collection system
US6078855A (en) * 1996-06-19 2000-06-20 Kabushiki Kaisha Kobe Seiko Sho Battery-driven hydraulic excavator
US5848485A (en) * 1996-12-27 1998-12-15 Spectra Precision, Inc. System for determining the position of a tool mounted on pivotable arm using a light source and reflectors
JPH11269937A (ja) * 1998-03-26 1999-10-05 Kobe Steel Ltd 作業機械の振動抑制装置
DE60141137D1 (de) * 2000-05-23 2010-03-11 Kobelco Constr Machinery Ltd Baumaschine
JP2004036303A (ja) * 2002-07-05 2004-02-05 Kobelco Contstruction Machinery Ltd 作業機械の旋回制御装置
CN100374665C (zh) 2002-05-09 2008-03-12 神钢建设机械株式会社 作业机械的旋转控制装置
JP2004150304A (ja) * 2002-10-29 2004-05-27 Komatsu Ltd エンジンの制御装置
JP4228980B2 (ja) 2004-04-22 2009-02-25 コベルコ建機株式会社 作業機械の旋回駆動装置
US7362071B2 (en) * 2004-05-13 2008-04-22 Komatsu Ltd. Rotation control device, rotation control method and construction machine
US7869923B2 (en) * 2004-09-24 2011-01-11 Komatsu Ltd. Slewing controller, slewing control method, and construction machine
JP4697543B2 (ja) 2006-03-30 2011-06-08 カシオ計算機株式会社 導光装置及びプロジェクタ
JP4835986B2 (ja) * 2006-06-15 2011-12-14 株式会社アドヴィックス 電動ステアリング制御装置
US7746067B2 (en) * 2007-08-31 2010-06-29 Caterpillar Inc. Machine with a position-sensing system

Also Published As

Publication number Publication date
US8473165B2 (en) 2013-06-25
JP5653041B2 (ja) 2015-01-14
KR101317631B1 (ko) 2013-10-10
CN102124166A (zh) 2011-07-13
EP2208829A4 (en) 2016-09-14
EP2208829A1 (en) 2010-07-21
WO2009051247A1 (ja) 2009-04-23
KR20100072259A (ko) 2010-06-30
CN102124166B (zh) 2015-06-17
US20100222970A1 (en) 2010-09-02

Similar Documents

Publication Publication Date Title
JP5653041B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5090527B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5420324B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5031718B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5095361B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5074432B2 (ja) ハイブリッド型建設機械
JP5101406B2 (ja) 建設機械
JP5844377B2 (ja) 建設機械及び旋回用電動機の制御方法
JP4949308B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP4611370B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP2010150898A (ja) 旋回駆動制御装置及びこれを含む建設機械
JP4745322B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5059565B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5101405B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP4648938B2 (ja) 旋回駆動制御装置及びこれを用いた建設機械
JP5139257B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5242359B2 (ja) 旋回駆動制御装置
JP4824004B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP2010185257A (ja) ハイブリッド型作業機械
JP5101407B2 (ja) 建設機械
JP2010150897A (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5207232B2 (ja) 旋回駆動制御装置及びこれを含む建設機械
JP5814835B2 (ja) ショベル

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20111206

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120206

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20120904

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121203

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20121211

A912 Re-examination (zenchi) completed and case transferred to appeal board

Free format text: JAPANESE INTERMEDIATE CODE: A912

Effective date: 20121228

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140924

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20141118

R150 Certificate of patent or registration of utility model

Ref document number: 5653041

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees