JP3166411B2 - Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling - Google Patents

Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling

Info

Publication number
JP3166411B2
JP3166411B2 JP14234993A JP14234993A JP3166411B2 JP 3166411 B2 JP3166411 B2 JP 3166411B2 JP 14234993 A JP14234993 A JP 14234993A JP 14234993 A JP14234993 A JP 14234993A JP 3166411 B2 JP3166411 B2 JP 3166411B2
Authority
JP
Japan
Prior art keywords
stepping motor
cargo handling
cpu
spool
hydraulic
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.)
Expired - Fee Related
Application number
JP14234993A
Other languages
Japanese (ja)
Other versions
JPH072499A (en
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.)
Toyota Industries Corp
Original Assignee
Toyota Industries Corp
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 Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP14234993A priority Critical patent/JP3166411B2/en
Publication of JPH072499A publication Critical patent/JPH072499A/en
Application granted granted Critical
Publication of JP3166411B2 publication Critical patent/JP3166411B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Forklifts And Lifting Vehicles (AREA)
  • Control Of Fluid Pressure (AREA)

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【産業上の利用分野】本発明は荷役用油圧制御装置に係
り、詳しくは荷役用コントロールバルブのスプールを駆
動制御するステッピングモータを備えた荷役用油圧制御
装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a hydraulic control device for cargo handling, and more particularly to a hydraulic control device for cargo handling provided with a stepping motor for controlling a spool of a control valve for cargo handling.

【0002】[0002]

【従来の技術】従来、産業車両におけるフォークリフト
にはコントロールバルブが設けられている。このコント
ロールバルブのスプール移動量及びその方向を調整する
ことにより、油圧シリンダに供給される作動油の供給量
及び供給方向が決定される。又、近年コントロールバル
ブのスプールをステッピングモータにより制御する荷役
用油圧制御装置が提案されている。この荷役用油圧制御
装置を図6に示す。
2. Description of the Related Art Conventionally, forklifts in industrial vehicles are provided with control valves. By adjusting the amount and direction of the spool movement of the control valve, the supply amount and supply direction of the hydraulic oil supplied to the hydraulic cylinder are determined. Also, in recent years, a cargo handling hydraulic control device that controls a spool of a control valve by a stepping motor has been proposed. FIG. 6 shows this hydraulic control device for cargo handling.

【0003】荷役レバー51には、その操作量を検出す
るポテンショメータ52が設けられ、ポテンショメータ
52は荷役レバー51の操作量を検出してコントローラ
53に出力する。コントローラ53は荷役レバー51の
操作量に基づいてステッピングモータ54を駆動制御
し、コントロールバルブ55のスプール56を移動させ
て荷役レバー51の操作量に対応した目標位置に停止さ
せる。
The loading lever 51 is provided with a potentiometer 52 for detecting the operation amount of the loading lever 51. The potentiometer 52 detects the operation amount of the loading lever 51 and outputs it to the controller 53. The controller 53 controls the drive of the stepping motor 54 based on the operation amount of the cargo handling lever 51, moves the spool 56 of the control valve 55, and stops at the target position corresponding to the operation amount of the cargo handling lever 51.

【0004】このスプール56の位置に応じて作動油が
図示しない油圧シリンダに供給され、フォークが昇降す
るようになっている。この時、ステッピングモータ54
は予め実験等で求めた500pps(単位、1秒間にス
テッピングモータ54が作動するパルス数)で駆動制御
される。又、ステッピングモータ54は図示しないバッ
テリから供給される駆動電圧(定電圧)によって制御さ
れている。
Hydraulic oil is supplied to a hydraulic cylinder (not shown) in accordance with the position of the spool 56, and the fork moves up and down. At this time, the stepping motor 54
Is driven and controlled at 500 pps (unit: the number of pulses at which the stepping motor 54 operates per second) previously obtained by an experiment or the like. The stepping motor 54 is controlled by a drive voltage (constant voltage) supplied from a battery (not shown).

【0005】[0005]

【発明が解決しようとする課題】ところで、冬季にフォ
ークリフトを作動させようとすると、作動油の温度は低
く、その粘性は高くなる。また、朝一番の操作のときに
はスプール56の周囲の作動油の粘性が高くなる。その
ため、スプール56の摺動抵抗が大きくなり、摺動しに
くくなる場合がある。この場合、スプール56を作動さ
せるための力は、図3の2点鎖線で示すように増加する
ことになる。
When a forklift is operated in winter, the temperature of the hydraulic oil is low and the viscosity thereof is high. Further, at the time of the first operation in the morning, the viscosity of the hydraulic oil around the spool 56 increases. For this reason, the sliding resistance of the spool 56 may increase, and the sliding may be difficult. In this case, the force for operating the spool 56 increases as shown by a two-dot chain line in FIG.

【0006】しかし、ステッピングモータ54はコント
ローラ53によって常に500ppsの駆動周波数で制
御される。従って、ステッピングモータ54に発生する
トルクは変化しない。そのため、摺動抵抗が大きくなっ
たスプール56を作動させるのに必要なトルクがステッ
ピングモータ54のトルクを上回ると、ステッピングモ
ータ54が脱調してしまうという問題がある。
However, the stepping motor 54 is always controlled by the controller 53 at a driving frequency of 500 pps. Therefore, the torque generated in the stepping motor 54 does not change. Therefore, when the torque required to operate the spool 56 having the increased sliding resistance exceeds the torque of the stepping motor 54, there is a problem that the stepping motor 54 steps out.

【0007】又、ステッピングモータ54が脱調すると
コントロールバルブ55内に設けられた図示しないバネ
の力でスプール56が中立位置に戻ってしまう。従っ
て、荷役レバー51を操作しても油圧シリンダが制御で
きなくなり、荷役作業ができなくなる問題がある。
When the stepping motor 54 steps out, the spool 56 returns to the neutral position due to the force of a spring (not shown) provided in the control valve 55. Accordingly, there is a problem that the hydraulic cylinder cannot be controlled even when the cargo handling lever 51 is operated, and the cargo handling work cannot be performed.

【0008】本発明の目的は作動油の粘性が高い場合に
おいてもスプールを確実に作動させることのできる荷役
用油圧制御装置を提供することにある。
It is an object of the present invention to provide a cargo handling hydraulic control device capable of reliably operating a spool even when the viscosity of hydraulic oil is high.

【0009】[0009]

【課題を解決するための手段】上記問題点を解決するた
めに請求項1に記載の発明は、荷役レバーの操作量に基
づいてステッピングモータを回転し、その回転に基づい
てコントロールバルブのスプールを作動させ、そのコン
トロールバルブを介して作動油を油圧シリンダに供給
し、該油圧シリンダを作動させる荷役用油圧制御装置に
おいて、キースイッチのオン操作後の荷役レバーの操作
に基づいて回転するステッピングモータを、予め設定さ
れた所定の時間高トルクで駆動制御させた後、低トルク
で駆動制御させるようにした荷役用油圧制御装置におけ
るステッピングモータの制御方法を採用した。
SUMMARY OF THE INVENTION In order to solve the above-mentioned problems, an invention according to claim 1 is to rotate a stepping motor based on an operation amount of a cargo handling lever, and to rotate a control valve spool based on the rotation. Activate, supply hydraulic oil to the hydraulic cylinder via its control valve, and in the cargo handling hydraulic control device that activates the hydraulic cylinder, a stepping motor that rotates based on the operation of the cargo handling lever after the key switch is turned on. Then, a stepping motor control method in a cargo handling hydraulic control device in which drive control is performed at a high torque for a preset predetermined time and then drive control is performed at a low torque is adopted.

【0010】又、請求項2に記載の発明は、荷役レバー
の操作量に基づいてステッピングモータを回転し、その
回転に基づいてコントロールバルブのスプールを作動さ
せ、そのコントロールバルブを介して作動油を油圧シリ
ンダに供給し、該油圧シリンダを作動させる荷役用油圧
制御装置において、前記作動油の粘性状態を判定する判
定手段と、キースイッチのオン操作後の荷役レバーの操
作に基づいてステッピングモータを高トルクで駆動制御
させ、前記判断手段の判断結果に基づいて、ステッピン
グモータを低トルクで駆動制御させるモータ制御手段と
を備えたことを要旨とする。
According to a second aspect of the present invention, the stepping motor is rotated based on the operation amount of the cargo handling lever, the spool of the control valve is operated based on the rotation, and the operating oil is supplied through the control valve. In the hydraulic control device for cargo supplied to the hydraulic cylinder and operating the hydraulic cylinder, the stepping motor is raised based on the operation of the cargo handling lever after the key switch is turned on and the determining means for determining the viscosity state of the hydraulic oil. The gist of the invention is to provide a motor control means for controlling the driving of the stepping motor with a low torque based on the result of the judgment by the judgment means.

【0011】[0011]

【作用】請求項1に記載の発明においては、キースイッ
チのオン操作後の荷役レバーの操作に基づいて回転する
ステッピングモータを、予め設定された所定の時間高ト
ルクで駆動制御させた後、低トルクで駆動制御させるよ
うにしたので、キースイッチオン操作後、直ちに荷役レ
バーを操作した時、作動油の粘性が高くてもスプールを
確実に作動させることができる。
According to the first aspect of the present invention, after the stepping motor, which is rotated based on the operation of the loading / unloading lever after the key switch is turned on, is driven and controlled at a high torque for a predetermined period of time, the drive is controlled to a low level. Since the drive is controlled by the torque, when the cargo handling lever is operated immediately after the key switch is turned on, the spool can be reliably operated even if the viscosity of the hydraulic oil is high.

【0012】又、請求項2に記載の発明では、判定手段
は作動油の粘性状態を判定する。そして、モータ制御手
段はキースイッチのオン操作後の荷役レバーの操作に基
づいて高トルクでステッピングモータを駆動制御させ、
前記判断手段の判断結果に基づいて低トルクでステッピ
ングモータを駆動制御させるようにしたので、キースイ
ッチオン操作後、直ちに荷役レバーを操作した時、作動
油の粘性が高くてもスプールを確実に作動させることが
できる。
[0012] In the invention according to claim 2, the judging means judges the viscosity state of the hydraulic oil. Then, the motor control means drives and controls the stepping motor with high torque based on the operation of the cargo handling lever after the key switch is turned on,
Since the stepping motor is driven and controlled with a low torque based on the result of the judgment by the judgment means, when the cargo handling lever is operated immediately after the key switch-on operation, the spool is reliably operated even if the viscosity of the hydraulic oil is high. Can be done.

【0013】[0013]

【実施例】以下、本発明を具体化した一実施例を図1〜
図5に従って説明する。図1に示すように、荷役レバー
1は図示しないフォークリフトの運転席に設けられてい
る。荷役レバー1には、その操作量(角度)を検出する
ポテンショメータ2が接続されている。そして、ポテン
ショメータ2はコントローラ3に接続されている。
DESCRIPTION OF THE PREFERRED EMBODIMENTS One embodiment of the present invention will now be described with reference to FIGS.
This will be described with reference to FIG. As shown in FIG. 1, the cargo handling lever 1 is provided in a driver seat of a forklift (not shown). A potentiometer 2 for detecting the operation amount (angle) of the cargo handling lever 1 is connected thereto. The potentiometer 2 is connected to the controller 3.

【0014】又、フォークリフトの運転席にはキースイ
ッチ4が設けられている。キースイッチ4はコントロー
ラ3に接続されている。そして、キースイッチ4をオン
操作すると、フォークリフトが運転操作可能になるよう
になっている。
A key switch 4 is provided on the driver's seat of the forklift. The key switch 4 is connected to the controller 3. When the key switch 4 is turned on, the forklift can be operated.

【0015】又、フォークリフトにはフォークを昇降さ
せる油圧シリンダ5が設けられている。油圧シリンダ5
はコントロールバルブ6に接続されている。該コントロ
ールバルブ6には、荷役用ポンプモータ7によって回転
駆動される油圧ポンプ8により、作動油が供給されてい
る。又、コントロールバルブ6にはスプール9が設けら
れている。このスプール9を上下方向に摺動させること
により、油圧ポンプ8から供給される作動油が油圧シリ
ンダ5に供給され、フォークが昇降するようになってい
る。
The forklift is provided with a hydraulic cylinder 5 for raising and lowering the fork. Hydraulic cylinder 5
Is connected to the control valve 6. Hydraulic oil is supplied to the control valve 6 by a hydraulic pump 8 that is rotated by a cargo pump motor 7. The control valve 6 is provided with a spool 9. By sliding the spool 9 in the vertical direction, the hydraulic oil supplied from the hydraulic pump 8 is supplied to the hydraulic cylinder 5, and the fork moves up and down.

【0016】スプール9にはステッピングモータ10が
リンク機構11を介して連結されている。リンク機構1
1は連結リンク12、第一リンク13、第二リンク1
4、固定軸15及び第三リンク16で構成されている。
連結リンク12はその一端が前記スプール9に回動可能
に軸着され、他端は第一リンク13の中央部に回動可能
に軸着されている。第一リンク13はその一端が第二リ
ンク14の一端に、他端が固定軸15に回動可能に軸着
されている。第二リンク14の他端には第三リンク16
の一端が回動可能に軸着されている。第三リンク16の
他端にはステッピングモータ10が回動不能に軸着され
ている。
A stepping motor 10 is connected to the spool 9 via a link mechanism 11. Link mechanism 1
1 is a connecting link 12, a first link 13, and a second link 1.
4, a fixed shaft 15 and a third link 16.
One end of the connection link 12 is rotatably mounted on the spool 9, and the other end is rotatably mounted on the center of the first link 13. The first link 13 has one end rotatably mounted on one end of the second link 14 and the other end rotatably mounted on the fixed shaft 15. The other end of the second link 14 has a third link 16
Is pivotally mounted at one end. A stepping motor 10 is non-rotatably mounted on the other end of the third link 16.

【0017】そして、ステッピングモータ10の回動に
より第一リンク13、第二リンク14及び第三リンク1
6がそれぞれ回動し、ステッピングモータ10の回動運
動が直線運動に変換され、連結リンク12を介してスプ
ール9の移動を制御するようになっている。
The rotation of the stepping motor 10 causes the first link 13, the second link 14, and the third link 1 to move.
6 rotate, the rotational movement of the stepping motor 10 is converted to a linear movement, and the movement of the spool 9 is controlled via the connecting link 12.

【0018】又、ステッピングモータ10はコントロー
ラ3によって駆動制御される。尚、本発明において、ス
テッピングモータ10には図示しないバッテリから駆動
電圧(12V)が供給されている。
The driving of the stepping motor 10 is controlled by the controller 3. In the present invention, a drive voltage (12 V) is supplied to the stepping motor 10 from a battery (not shown).

【0019】次に、荷役用油圧制御装置の電気的構成に
ついて説明する。コントローラ3は中央処理装置17
(以下CPUという)、読み出し専用メモリ18(以下
ROMという)、読み出し及び書き込み可能なメモリ1
9(以下RAMという)、A/Dコンバータ20及びモ
ータ駆動回路21から構成されている。
Next, the electrical configuration of the hydraulic control device for cargo handling will be described. The controller 3 is a central processing unit 17
(Hereinafter referred to as CPU), read-only memory 18 (hereinafter referred to as ROM), readable and writable memory 1
9 (hereinafter referred to as RAM), an A / D converter 20 and a motor drive circuit 21.

【0020】A/Dコンバータ20には荷役レバー1に
設けられたポテンショメータ2が接続されている。A/
Dコンバータ20はポテンショメータ2にて検出された
荷役レバー1の操作量として操作方向及び操作角度を所
定の分解能でA/D変換してCPU17に出力する。
A potentiometer 2 provided on the cargo handling lever 1 is connected to the A / D converter 20. A /
The D converter 20 A / D converts the operation direction and the operation angle with a predetermined resolution as an operation amount of the cargo handling lever 1 detected by the potentiometer 2 and outputs the result to the CPU 17.

【0021】ROM18には、図4に示すように前記ス
テッピングモータ10を制御するための操作量−ステッ
プ数マップが記憶されている。CPU17は操作量−ス
テップ数マップにより、荷役レバー1の操作量としての
出力値のA/D変換値を、スプール9の位置としてステ
ッピングモータ10の目標ステップ数を読み出す。そし
て、CPU17はROM18から読み出した目標ステッ
プ数をRAM19に記憶し、この目標ステップ数に対応
した位置までステッピングモータ10を駆動制御する。
The ROM 18 stores an operation amount-step number map for controlling the stepping motor 10 as shown in FIG. The CPU 17 reads the A / D conversion value of the output value as the operation amount of the cargo handling lever 1 and the target number of steps of the stepping motor 10 as the position of the spool 9 from the operation amount-step number map. Then, the CPU 17 stores the target step number read from the ROM 18 in the RAM 19, and controls the drive of the stepping motor 10 to a position corresponding to the target step number.

【0022】尚、この操作量−ステップ数マップにおい
ては、荷役レバー1の中立位置付近に不感帯が設けら
れ、荷役レバー1が中立位置から少し動いただけではス
テッピングモータ10が回動しないようになっている。
荷役レバー1の操作量が不感帯を過ぎると、ステッピン
グモータ10の目標ステップ数は操作量に対応して増加
するようになっている。更に、荷役レバー1の操作量が
大きい領域では、ステッピングモータ10が最大回動位
置に回動してスプール9を摺動させるようになってい
る。
In this operation amount-step number map, a dead zone is provided near the neutral position of the cargo handling lever 1, so that the stepping motor 10 does not rotate if the cargo handling lever 1 is slightly moved from the neutral position. I have.
When the operation amount of the cargo handling lever 1 passes through the dead zone, the target number of steps of the stepping motor 10 increases in accordance with the operation amount. Further, in a region where the operation amount of the cargo handling lever 1 is large, the stepping motor 10 rotates to the maximum rotation position and slides the spool 9.

【0023】又、ROM18には、図5に示すように1
2Vの駆動電圧において、ステッピングモータ10の駆
動周波数に対して得られるトルクを示す駆動周波数−ト
ルクマップが記憶されている。そして、本実施例におい
ては予め実験等で求めた駆動周波数500pps又は2
00ppsでステッピングモータ10を駆動するように
なっている。駆動周波数が500ppsの場合、ステッ
ピングモータ10にはトルクT1が発生する。又、駆動
周波数が200ppsの場合、ステッピングモータ10
にはトルクT2が発生する。
As shown in FIG.
At a driving voltage of 2 V, a driving frequency-torque map indicating torque obtained with respect to the driving frequency of the stepping motor 10 is stored. In the present embodiment, the driving frequency 500 pps or 2
The stepping motor 10 is driven at 00 pps. When the driving frequency is 500 pps, a torque T1 is generated in the stepping motor 10. When the driving frequency is 200 pps, the stepping motor 10
Generates a torque T2.

【0024】更に、ROM18にはステッピングモータ
10の移動量が予め設定された規定値として記憶されて
いる。この規定値はキースイッチ4のオン操作から所定
の時間経過するまでにステッピングモータ10が移動す
る移動量が設定されている。この所定の時間はキースイ
ッチ4のオン操作後の荷役レバー1の操作から作動油の
粘性が低下するまでの時間となっている。そして、規定
値はこの所定の時間の間に移動するステッピングモータ
10の移動量にしている。
Further, the moving amount of the stepping motor 10 is stored in the ROM 18 as a preset specified value. The specified value is set to the amount of movement of the stepping motor 10 until a predetermined time elapses after the key switch 4 is turned on. This predetermined time is the time from the operation of the cargo handling lever 1 after the key switch 4 is turned on until the viscosity of the hydraulic oil decreases. The specified value is the amount of movement of the stepping motor 10 that moves during the predetermined time.

【0025】CPU17はポテンショメータ2により荷
役レバー1の操作量を検出し、その検出結果に基づいて
図4に示す操作量−ステップ数マップからステッピング
モータ10の目標ステップ数を読み出すようになってい
る。CPU17はこの目標ステップ数によりステッピン
グモータ10をモータ駆動回路21を介して回動させ、
スプール9を摺動させる。さらに、CPU17はキース
イッチ4のオン操作からのステップ数を加算し、ステッ
ピングモータ10の移動量を算出する。
The CPU 17 detects the operation amount of the cargo handling lever 1 by the potentiometer 2 and reads out the target step number of the stepping motor 10 from the operation amount-step number map shown in FIG. 4 based on the detection result. The CPU 17 rotates the stepping motor 10 via the motor drive circuit 21 according to the target number of steps,
Slide the spool 9. Further, the CPU 17 calculates the amount of movement of the stepping motor 10 by adding the number of steps since the key switch 4 was turned on.

【0026】又、CPU17はステッピングモータ10
の移動量と前記規定値とを比較するようになっている。
そして、移動量が規定値より小さいとき、CPU17は
ステッピングモータ10を駆動周波数200ppsで駆
動制御するようになっている。この時、ステッピングモ
ータ10はトルクT2で回転する。このトルクT2は摺
動抵抗が大きいスプール9を充分に摺動させることがで
きる大きさになっている。
The CPU 17 has a stepping motor 10
Is compared with the specified value.
When the moving amount is smaller than the specified value, the CPU 17 controls the driving of the stepping motor 10 at a driving frequency of 200 pps. At this time, the stepping motor 10 rotates at the torque T2. This torque T2 is large enough to allow the spool 9 having a large sliding resistance to slide sufficiently.

【0027】一方、ステッピングモータ10の移動量が
規定値以上のとき、CPU17はステッピングモータ1
0を駆動周波数500ppsで駆動制御するようになっ
ている。この時、ステッピングモータ10はトルクT1
で回転する。このトルクT1は摺動抵抗が低下したスプ
ール9を充分摺動させることができる大きさになってい
る。
On the other hand, when the moving amount of the stepping motor 10 is equal to or more than the specified value, the CPU 17
0 is driven and controlled at a driving frequency of 500 pps. At this time, the stepping motor 10 applies the torque T1
Rotate with. This torque T1 is large enough to allow the spool 9 having reduced sliding resistance to slide sufficiently.

【0028】又、ROM18にはCPU17の制御プロ
グラムが記憶されている。この制御プログラムは図2に
示すメイン制御と割り込み制御とで構成される。メイン
制御において、CPU17は荷役レバー1の操作量をA
/Dコンバータ20を介して読み込み、その操作量に応
じたステッピングモータ10の目標ステップ数を算出す
る。又、メイン制御において、CPU17はステッピン
グモータ10の移動量を求め、その移動量と規定値とを
比較した結果に基づいて周波数フラグをセットする。
The ROM 18 stores a control program for the CPU 17. This control program includes the main control and the interrupt control shown in FIG. In the main control, the CPU 17 sets the operation amount of the
The target number of steps of the stepping motor 10 is calculated according to the operation amount by reading the data via the / D converter 20. In the main control, the CPU 17 obtains a moving amount of the stepping motor 10 and sets a frequency flag based on a result of comparing the moving amount with a specified value.

【0029】割り込み制御において、CPU17はステ
ッピングモータ10をモータ駆動回路21を介して1ス
テップ駆動させ、前記ステッピングモータ10の目標ス
テップ数に達するように制御する。又、前記周波数フラ
グに基づいて次の割り込み周期をセットする。
In the interrupt control, the CPU 17 drives the stepping motor 10 by one step via the motor drive circuit 21 and controls the stepping motor 10 to reach the target number of steps. Further, the next interrupt cycle is set based on the frequency flag.

【0030】RAM19にはCPU17の演算結果が一
時的に記憶されている。又、RAM19には割り込み制
御の割り込み周期に対応する周波数フラグが記憶されて
いる。割り込み制御は、割り込み周期を所定のアドレス
に書き込むことによりその割り込み周期で起動され、1
回行う毎にステッピングモータ10を正方向又は逆方向
に1ステップ進ませるステップ駆動を行うようになって
いる。
The calculation result of the CPU 17 is temporarily stored in the RAM 19. The RAM 19 stores a frequency flag corresponding to the interrupt cycle of the interrupt control. The interrupt control is started at the interrupt cycle by writing the interrupt cycle to a predetermined address.
Each time the stepping motor 10 is rotated, the stepping motor 10 is moved forward by one step in the forward direction or the reverse direction.

【0031】割り込み周期はステッピングモータ10の
駆動周波数により決定される。例えば、ステッピングモ
ータ10を500ppsで駆動しようとすると、その割
り込み周期は2msとなり、200ppsで駆動しよう
とすると、割り込み周期は5msとなる。そして、周波
数フラグが”0”であるとき、CPU17は割り込み周
期を5msにセットし、周波数フラグが”1”であると
き、CPU17は割り込み周期を2msにセットする。
The interrupt cycle is determined by the drive frequency of the stepping motor 10. For example, if the stepping motor 10 is driven at 500 pps, the interrupt cycle is 2 ms. If the stepping motor 10 is driven at 200 pps, the interrupt cycle is 5 ms. When the frequency flag is "0", the CPU 17 sets the interrupt cycle to 5 ms, and when the frequency flag is "1", the CPU 17 sets the interrupt cycle to 2 ms.

【0032】CPU17に接続されるモータ駆動回路2
1にはステッピングモータ10が接続されている。モー
タ駆動回路21は、CPU17から出力される正方向又
は逆方向の回動方向に対応して駆動周波数に応じたパル
スを出力する。そのため、ステッピングモータ10は正
方向又は逆方向に1ステップ回動するようになってい
る。
Motor drive circuit 2 connected to CPU 17
1 is connected to a stepping motor 10. The motor drive circuit 21 outputs a pulse corresponding to the drive frequency corresponding to the forward or reverse rotation direction output from the CPU 17. Therefore, the stepping motor 10 rotates one step forward or backward.

【0033】次に、上記のように構成された荷役用油圧
制御装置の作用を図2のフローチャートに従って説明す
る。先ず、図2(a)のフローチャートに従って、CP
U17のメイン制御を説明する。
Next, the operation of the hydraulic control apparatus for cargo handling configured as described above will be described with reference to the flowchart of FIG. First, according to the flowchart of FIG.
The main control of U17 will be described.

【0034】CPU17はキースイッチ4のオン操作に
基づいてメイン制御を開始すると、ステップ1(以下ス
テップを単にSという)にてステッピングモータ10の
目標位置や移動量等の初期化を行う。このとき、目標位
置はスプール9の中立位置をステッピングモータ10の
初期位置として設定される。
When the CPU 17 starts the main control based on the ON operation of the key switch 4, the CPU 17 initializes a target position, a moving amount, and the like of the stepping motor 10 in step 1 (hereinafter, step is simply referred to as S). At this time, the neutral position of the spool 9 is set as the initial position of the stepping motor 10 as the target position.

【0035】そして、CPU17はS2にてステッピン
グモータ10にトルクT2発生させるために、RAM1
9に記憶された周波数フラグをクリア、即ち”0”にセ
ットする。次に、CPU17はS3にて荷役レバー1の
操作量をポテンショメータ2から検出する。
Then, in S2, the CPU 17 generates a torque T2 for the stepping motor 10 in S1.
9 is cleared, that is, set to "0". Next, the CPU 17 detects the operation amount of the cargo handling lever 1 from the potentiometer 2 in S3.

【0036】そして、CPU17はS4にて荷役レバー
1の操作量に応じたステッピングモータ10の目標ステ
ップ数をROM18に記憶された操作量−ステップ数マ
ップより読み出してRAM19に記憶する。CPU17
はこの目標ステップ数に対応した位置までステッピング
モータ10を駆動制御する。
The CPU 17 reads the target step number of the stepping motor 10 corresponding to the operation amount of the cargo handling lever 1 from the operation amount-step number map stored in the ROM 18 and stores it in the RAM 19 in S4. CPU17
Drives and controls the stepping motor 10 to a position corresponding to the target number of steps.

【0037】一方、CPU17はS4においてステッピ
ングモータ10のステップ数を加算し、移動量を算出す
る。そして、CPU17はS5においてステッピングモ
ータ10の移動量とROM18に記憶された規定値とを
比較する。移動量が規定値より小さい場合、CPU17
はS7に進む。このとき、周波数フラグは”0”に保持
される。従って、ステッピングモータ10の駆動周波数
は200ppsのままとなる。
On the other hand, the CPU 17 adds the number of steps of the stepping motor 10 in S4 to calculate a moving amount. Then, the CPU 17 compares the moving amount of the stepping motor 10 with the specified value stored in the ROM 18 in S5. If the moving amount is smaller than the specified value, the CPU 17
Goes to S7. At this time, the frequency flag is held at "0". Therefore, the drive frequency of the stepping motor 10 remains at 200 pps.

【0038】ステッピングモータ10の移動量が規定値
以上の場合、CPU17はステッピングモータ10の駆
動周波数を500ppsにセットするために、S6にて
周波数フラグをセット、即ち”1”にセットする。
If the moving amount of the stepping motor 10 is equal to or larger than the specified value, the CPU 17 sets a frequency flag, that is, "1" in S6 to set the driving frequency of the stepping motor 10 to 500 pps.

【0039】次に、CPU17はS7にて10ms経過
するのを待つ。そして、10ms経過すると、CPU1
7はS3以後の処理を繰り返し行う。従って、CPU1
7はS3からS7の処理を10ms毎に行い、その1周
期毎に荷役レバー1の操作量に応じてステッピングモー
タ10の目標ステップ数を設定する。又、CPU17は
ステッピングモータ10の移動量と規定値とを比較した
結果に基づいて、移動量が規定値以上になったときに周
波数フラグを”1”にセットする。
Next, the CPU 17 waits for 10 ms to elapse in S7. After 10 ms, the CPU 1
7 repeats the processing after S3. Therefore, CPU1
7 performs the processing from S3 to S7 every 10 ms, and sets the target number of steps of the stepping motor 10 according to the operation amount of the cargo handling lever 1 for each cycle. Further, the CPU 17 sets the frequency flag to “1” based on the result of comparing the movement amount of the stepping motor 10 with the specified value when the movement amount becomes equal to or more than the specified value.

【0040】次に、図2(b)のフローチャートに従っ
て、CPU17の割り込み制御を説明する。割り込み制
御が開始されると、CPU17はS11にてステッピン
グモータ10の位置を確認する。ステッピングモータ1
0がメイン制御のS3で求めた目標位置に達していない
場合には、CPU17はS12にて正方向又は逆方向へ
ステッピングモータ10を1ステップ進める。S11に
てステッピングモータ10が既に目標位置に達している
場合には、CPU17はS13にてステッピングモータ
10をその目標位置を保持する。
Next, the interrupt control of the CPU 17 will be described with reference to the flowchart of FIG. When the interrupt control is started, the CPU 17 checks the position of the stepping motor 10 in S11. Stepping motor 1
If 0 has not reached the target position determined in S3 of the main control, the CPU 17 advances the stepping motor 10 by one step in the forward or reverse direction in S12. If the stepping motor 10 has already reached the target position in S11, the CPU 17 holds the target position of the stepping motor 10 in S13.

【0041】次に、CPU17は、S14にてRAM1
9に記憶された周波数フラグを読み出し、その周波数フ
ラグの状態をチェックする。周波数フラグはメイン制御
のS2においてキースイッチ4のオン操作時には常に”
0”にセットされている。従って、CPU17はS16
に進む。そして、CPU17はS16において次の割り
込み周期を5msにしてRAM19に記憶する。この割
り込み周期でCPU17がステッピングモータ10を回
動制御するので、ステッピングモータ10にはトルクT
2が発生する。この結果、摺動抵抗が大きいスプール9
を摺動させることができる。
Next, in S14, the CPU 17
9 is read, and the state of the frequency flag is checked. When the key switch 4 is turned on in S2 of the main control, the frequency flag is always "".
0 ". Therefore, the CPU 17 proceeds to S16.
Proceed to. Then, the CPU 17 sets the next interrupt cycle to 5 ms and stores it in the RAM 19 in S16. Since the CPU 17 controls the rotation of the stepping motor 10 in this interrupt cycle, the torque T
2 occurs. As a result, the spool 9 having a large sliding resistance
Can be slid.

【0042】一方、ステッピングモータ10の移動量が
ROM18に記憶された規定値以上になった場合、CP
U17はS6において周波数フラグを”1”にセットす
る。従って、CPU17はS14においてS15に進
む。そして、CPU17はS15において次の割り込み
周期2msをRAM19に記憶する。この割り込み周期
でCPU17はステッピングモータ10を駆動周波数5
00ppsで回動制御する。
On the other hand, when the moving amount of the stepping motor 10 exceeds a specified value stored in the ROM 18, the CP
U17 sets the frequency flag to "1" in S6. Therefore, the CPU 17 proceeds to S15 in S14. Then, the CPU 17 stores the next interrupt cycle 2 ms in the RAM 19 in S15. In this interrupt cycle, the CPU 17 drives the stepping motor 10 to drive frequency 5
The rotation is controlled at 00 pps.

【0043】従って、本実施例の荷役用油圧制御装置に
おいては、キースイッチ4のオン操作時にステッピング
モータ10の駆動周波数を下げ、ステッピングモータ1
0を摺動抵抗より充分大きなトルクT2で駆動させるよ
うにした。この結果、作動油の粘性が高く摺動抵抗が大
きい場合においてもスプール9を確実に作動させること
ができるので、ステッピングモータ10の脱調を防止し
て荷役作業を行うことができる。
Therefore, in the hydraulic control apparatus for cargo handling according to the present embodiment, the drive frequency of the stepping motor 10 is reduced when the key switch 4 is turned on, and the stepping motor 1
0 is driven with a torque T2 sufficiently larger than the sliding resistance. As a result, even when the viscosity of the hydraulic oil is high and the sliding resistance is large, the spool 9 can be reliably operated, so that the stepping motor 10 can be prevented from stepping out and the cargo handling operation can be performed.

【0044】又、作動油の粘性が低く、スプール9の摺
動抵抗が小さくなるとステッピングモータ10の駆動周
波数を上げ、ステッピングモータ10を速く駆動制御で
きるので、フィーリングを損なうことなく荷役操作を行
うことができる。
When the viscosity of the hydraulic oil is low and the sliding resistance of the spool 9 is low, the driving frequency of the stepping motor 10 is increased and the driving of the stepping motor 10 can be controlled quickly, so that the cargo handling operation is performed without impairing the feeling. be able to.

【0045】なお、本発明は上記実施例に限定されるこ
とはなく、本発明の趣旨から逸脱しない範囲で以下のよ
うにしてもよい。 (1)上記実施例ではステッピングモータ10の駆動周
波数を予め実験で求めた値である500PPS,200
ppsに設定したが、必要に応じて任意の値としてもよ
い。又、ステッピングモータ10の駆動周波数を200
ppsから500ppsに変更する実施例としたが、種
々のトルクを得るために駆動周波数を可変的に変更する
ようにしてもよい。
It should be noted that the present invention is not limited to the above embodiment, and may be as follows without departing from the spirit of the present invention. (1) In the above embodiment, the driving frequency of the stepping motor 10 is 500 PPS, 200
Although set to pps, it may be set to an arbitrary value as needed. Further, the driving frequency of the stepping motor 10 is set to 200
Although the embodiment is changed from pps to 500 pps, the drive frequency may be variably changed to obtain various torques.

【0046】(2)上記実施例ではステッピングモータ
10の規定値を1つ設定したが複数の規定値を設定し、
その規定値に対応してステッピングモータ10の駆動周
波数を変更するようにしてもよい。
(2) In the above embodiment, one specified value of the stepping motor 10 is set, but a plurality of specified values are set.
The driving frequency of the stepping motor 10 may be changed according to the specified value.

【0047】(3)上記実施例ではフォークの昇降用の
油圧シリンダ5に用いたが、他のリーチやティルト用の
油圧シリンダに応用してもよい。又、フォークリフト以
外の荷役車両に応用してもよい。
(3) In the above embodiment, the hydraulic cylinder 5 for lifting and lowering the fork is used. However, the present invention may be applied to another hydraulic cylinder for reach and tilt. Further, the present invention may be applied to a cargo handling vehicle other than a forklift.

【0048】(4)上記実施例ではステッピングモータ
10の移動量をステッピングモータ10を駆動するステ
ップ数によって算出し、その移動量によってステッピン
グモータ10の駆動周波数を変更するようにしたが、ス
テッピングモータ10にロータリエンコーダを設け、そ
の移動量によってステッピングモータ10の駆動周波数
を変更するようにしてもよい。又、コントロールバルブ
6にスプールセンサを設けてスプール9の移動量を検出
し、その移動量によってステッピングモータ10の駆動
周波数を変更するようにしてもよい。
(4) In the above embodiment, the moving amount of the stepping motor 10 is calculated by the number of steps for driving the stepping motor 10, and the driving frequency of the stepping motor 10 is changed according to the moving amount. May be provided with a rotary encoder, and the driving frequency of the stepping motor 10 may be changed according to the amount of movement. Alternatively, the control valve 6 may be provided with a spool sensor to detect the amount of movement of the spool 9 and change the drive frequency of the stepping motor 10 according to the amount of movement.

【0049】(5)上記実施例では所定の時間、即ち作
動油の粘性が低下するまでの時間をステッピングモータ
10の移動量によって判断したが、荷役レバー1の操作
回数をカウントし、その操作回数によって判断するよう
にしてもよい。又、コントロールバルブ6に作動油の油
温を検出する温度センサを設け、その検出結果に基づい
て判断するようにしてもよい。
(5) In the above embodiment, the predetermined time, that is, the time until the viscosity of the hydraulic oil decreases, is determined based on the movement amount of the stepping motor 10. However, the number of operations of the cargo handling lever 1 is counted, and the number of operations is determined. The determination may be made by using Further, the control valve 6 may be provided with a temperature sensor for detecting the oil temperature of the hydraulic oil, and the determination may be made based on the detection result.

【0050】(6)上記実施例において、キースイッチ
のオン操作後の荷役レバー1の操作からの時間を計測す
るタイマを設けて経過時間を計測し、その計測結果に基
づいて所定の時間を判断するようにしてもよい。又、C
PU17からモータ駆動回路21に送出されるパルスに
よって駆動されるタイマをコントローラ3に設け、その
タイマによって所定の時間経過を判断してもよい。
(6) In the above embodiment, a timer for measuring the time from the operation of the cargo handling lever 1 after the key switch is turned on is provided to measure the elapsed time, and a predetermined time is determined based on the measurement result. You may make it. Also, C
A timer driven by a pulse transmitted from the PU 17 to the motor drive circuit 21 may be provided in the controller 3, and the elapse of a predetermined time may be determined by the timer.

【0051】[0051]

【発明の効果】以上詳述したように請求項1に記載の荷
役用油圧制御装置におけるステッピングモータの制御方
法によれば、キースイッチのオン操作後の荷役レバーの
操作に基づいて回転するステッピングモータを、予め設
定された所定の時間高トルクで駆動制御させた後、低ト
ルクで駆動制御させるようにしたので、キースイッチオ
ン操作時に作動油の粘性が高い場合においてもスプール
を確実に作動させることができるという優れた効果を奏
する。
As described above in detail, according to the method for controlling a stepping motor in the hydraulic control device for cargo handling according to the first aspect, the stepping motor that rotates based on the operation of the cargo handling lever after the key switch is turned on. Is controlled at a high torque for a predetermined period of time and then at a low torque, so that the spool can be reliably operated even when the viscosity of the hydraulic oil is high when the key switch is turned on. An excellent effect is achieved.

【0052】又、請求項2に記載の荷役用油圧制御装置
によれば、判定手段は作動油の粘性状態を判定する。そ
して、モータ制御手段はキースイッチのオン操作後の荷
役レバーの操作に基づいて高トルクでステッピングモー
タを駆動制御し、前記判断手段の判断結果に基づいて低
トルクでステッピングモータを駆動制御するようにした
ので、キースイッチオン操作時に作動油の粘性が高い場
合においてもスプールを確実に作動させることができる
という優れた効果を奏する。
According to the second aspect of the present invention, the judging means judges the viscous state of the hydraulic oil. Then, the motor control means drives and controls the stepping motor with a high torque based on the operation of the cargo handling lever after the key switch is turned on, and controls the drive of the stepping motor with a low torque based on the determination result of the determination means. Therefore, there is an excellent effect that the spool can be reliably operated even when the viscosity of the hydraulic oil is high when the key switch is turned on.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の一実施例における荷役用油圧制御装置
の構成図である。
FIG. 1 is a configuration diagram of a hydraulic control device for cargo handling in one embodiment of the present invention.

【図2】本発明の一実施例のメイン制御とステッピング
モータを1ステップ作動させる割り込み制御のフローチ
ャートである。
FIG. 2 is a flowchart of main control and interrupt control for operating a stepping motor by one step according to an embodiment of the present invention.

【図3】スプールのストロークと操作力との関係を示す
特性図である。
FIG. 3 is a characteristic diagram illustrating a relationship between a stroke of a spool and an operation force.

【図4】荷役レバーの操作量とステッピングモータの目
標ステップ数との関係を示す特性図である。
FIG. 4 is a characteristic diagram illustrating a relationship between an operation amount of a cargo handling lever and a target number of steps of a stepping motor.

【図5】ステッピングモータの駆動周波数と発生トルク
との関係を示す特性図である。
FIG. 5 is a characteristic diagram showing a relationship between a driving frequency of a stepping motor and a generated torque.

【図6】従来の荷役用油圧制御装置の構成図である。FIG. 6 is a configuration diagram of a conventional hydraulic control device for cargo handling.

【符号の説明】[Explanation of symbols]

4…キースイッチ、5…油圧シリンダ、6…コントロー
ルバルブ、9…スプール、10…ステッピングモータ、
17…判定手段及びモータ制御手段としてのCPU
4 key switch, 5 hydraulic cylinder, 6 control valve, 9 spool, 10 stepping motor,
17 CPU as determination means and motor control means

フロントページの続き (72)発明者 成瀬 靖彦 愛知県刈谷市豊田町2丁目1番地 株式 会社 豊田自動織機製作所 内 (56)参考文献 特開 平5−83814(JP,A) 特開 平3−28029(JP,A) 特開 平4−69471(JP,A) (58)調査した分野(Int.Cl.7,DB名) B66F 9/24 Continuation of the front page (72) Inventor Yasuhiko Naruse 2-1-1, Toyota-cho, Kariya-shi, Aichi Prefecture Inside Toyota Industries Corporation (56) References JP-A-5-83814 (JP, A) JP-A-3-28029 (JP, A) JP-A-4-69471 (JP, A) (58) Fields investigated (Int. Cl. 7 , DB name) B66F 9/24

Claims (2)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 荷役レバーの操作量に基づいてステッピ
ングモータを回転し、その回転に基づいてコントロール
バルブのスプールを作動させ、そのコントロールバルブ
を介して作動油を油圧シリンダに供給し、該油圧シリン
ダを作動させる荷役用油圧制御装置において、 キースイッチのオン操作後の荷役レバーの操作に基づい
て回転するステッピングモータを、予め設定された所定
の時間高トルクで駆動制御させた後、低トルクで駆動制
御させるようにした荷役用油圧制御装置におけるステッ
ピングモータの制御方法。
A stepping motor that rotates based on an operation amount of a cargo handling lever, a spool of a control valve is operated based on the rotation, and hydraulic oil is supplied to the hydraulic cylinder via the control valve. The stepping motor, which rotates based on the operation of the cargo handling lever after the key switch is turned on, is driven at a high torque for a predetermined time and then driven at a low torque. A method for controlling a stepping motor in a hydraulic control device for cargo handling which is controlled.
【請求項2】 荷役レバーの操作量に基づいてステッピ
ングモータを回転し、その回転に基づいてコントロール
バルブのスプールを作動させ、そのコントロールバルブ
を介して作動油を油圧シリンダに供給し、該油圧シリン
ダを作動させる荷役用油圧制御装置において、 前記作動油の粘性状態を判定する判定手段と、 キースイッチのオン操作後の荷役レバーの操作に基づい
てステッピングモータを高トルクで駆動制御させ、前記
判断手段の判断結果に基づいて、ステッピングモータを
低トルクで駆動制御させるモータ制御手段とを備えた荷
役用油圧制御装置。
2. A hydraulic motor according to claim 1, wherein the stepping motor is rotated based on the operation amount of the loading lever, a spool of a control valve is operated based on the rotation, and hydraulic oil is supplied to the hydraulic cylinder via the control valve. And a determining means for determining the viscosity state of the hydraulic oil; and controlling the stepping motor with a high torque based on the operation of the loading lever after the key switch is turned on. And a motor control means for controlling the driving of the stepping motor with low torque on the basis of the result of the determination.
JP14234993A 1993-06-14 1993-06-14 Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling Expired - Fee Related JP3166411B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP14234993A JP3166411B2 (en) 1993-06-14 1993-06-14 Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP14234993A JP3166411B2 (en) 1993-06-14 1993-06-14 Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling

Publications (2)

Publication Number Publication Date
JPH072499A JPH072499A (en) 1995-01-06
JP3166411B2 true JP3166411B2 (en) 2001-05-14

Family

ID=15313308

Family Applications (1)

Application Number Title Priority Date Filing Date
JP14234993A Expired - Fee Related JP3166411B2 (en) 1993-06-14 1993-06-14 Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling

Country Status (1)

Country Link
JP (1) JP3166411B2 (en)

Also Published As

Publication number Publication date
JPH072499A (en) 1995-01-06

Similar Documents

Publication Publication Date Title
US6807471B2 (en) Steering wheel position compensating apparatus in steering apparatus
US4491918A (en) Method and system for horizontally controlling a fork for a fork lift truck
EP1034991B1 (en) Wiper control apparatus and method capable of variably adjusting wiper blade motion
EP1512608B1 (en) Electric power steering apparatus
US6542801B2 (en) Power steering system
JP3166411B2 (en) Method and apparatus for controlling stepping motor in hydraulic control device for cargo handling
JP3487223B2 (en) Power steering system
TW546219B (en) Steering apparatus in vehicle and industrial vehicle
JP3116648B2 (en) Hydraulic control device for cargo handling
EP0987163B1 (en) Power steering apparatus
JP3166412B2 (en) Hydraulic control device
JP4787722B2 (en) DC motor drive controller
US7885743B2 (en) Electric mirror control device and electric mirror control method
JP4228474B2 (en) Power steering control device
EP0798260B1 (en) Arrangement at fork-lift trucks
JPH06292397A (en) Hydraulic controller for cargo
JP3166410B2 (en) Hydraulic control device for cargo handling
JPH07172797A (en) Stroke end detector and method of material handling hydraulic cylinder as well as material handling controller and method thereof
JP2001026278A (en) Power steering control device
KR100880393B1 (en) Method for controlling steering of electromotive forklift truck by use of angle sensor
JPS6330800Y2 (en)
JP3846847B2 (en) Control device for electric power steering
JP4840797B2 (en) Handling equipment
JP3368631B2 (en) Power steering control device
JPH0632564Y2 (en) Handling lever operation amount detector

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees