JP6546682B1 - Self-propelled work machine and control system and control method of self-propelled work machine - Google Patents
Self-propelled work machine and control system and control method of self-propelled work machine Download PDFInfo
- Publication number
- JP6546682B1 JP6546682B1 JP2018112624A JP2018112624A JP6546682B1 JP 6546682 B1 JP6546682 B1 JP 6546682B1 JP 2018112624 A JP2018112624 A JP 2018112624A JP 2018112624 A JP2018112624 A JP 2018112624A JP 6546682 B1 JP6546682 B1 JP 6546682B1
- Authority
- JP
- Japan
- Prior art keywords
- motor
- cutting blade
- unit
- traveling
- rotation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 30
- 230000003028 elevating effect Effects 0.000 claims abstract description 40
- 238000006243 chemical reaction Methods 0.000 claims description 26
- 244000025254 Cannabis sativa Species 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 241001494496 Leersia Species 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
Images
Landscapes
- Harvester Elements (AREA)
- Lifting Devices For Agricultural Implements (AREA)
Abstract
【課題】遠隔操作を行うとともに、駆動用モータの回転制御を電気信号で行うことで複数の入出力信号の制御を可能にし、且つ、部品点数を減らすことができる。【解決手段】機体Lの進行方向左右側に設けられ駆動走行をさせる走行モータ15を有した走行部Dと、前記機体L及び前記走行部Dの前方に位置させて作業をするための複数の作業モータ51を備えた作業部Kと、前記作業部Kを昇降自在にする昇降アーム43及び昇降モータ61を備えた昇降部Fと、前記走行部D及び前記作業部K及び前記昇降部Fを操作するための操作部Bと、該操作部Bから送られた信号を変換し、前記走行モータ15及び前記作業モータ51及び前記昇降モータ61の回転を制御するため信号を出力する変換部制御装置Eと、を備えた自走式作業機。【選択図】図1An object of the present invention is to perform control of a plurality of input / output signals by performing remote control and performing rotation control of a drive motor by an electric signal, and reduce the number of parts. A traveling unit D having traveling motors 15 provided on the left and right sides in the traveling direction of an aircraft L and having a traveling motor 15 for driving, and a plurality of works for positioning the aircraft L and the traveling unit D in front of them A working unit K including a working motor 51, a lifting and lowering unit F including a lifting arm 43 and a lifting motor 61 for lifting and lowering the working unit K, the traveling unit D, the working unit K, and the lifting and lowering unit F An operation unit B for operating, and a converter control unit that converts signals sent from the operation unit B, and outputs signals for controlling rotation of the traveling motor 15, the work motor 51, and the elevating motor 61. E, a self-propelled working machine equipped with E. [Selected figure] Figure 1
Description
この発明は、自走式作業機及び自走式作業機の制御システム及び制御方法に係る。 The present invention relates to a self-propelled work machine and a control system and control method for a self-propelled work machine.
農作業においては、作業者が立ち入ることが困難な場所に、作業機械が立ち入って作業ができることが求められている。作業機械を扱う作業者に対しては、機体操作に関わる省力化が可能で、且つ、経済的に導入しやすいことが求められている。
特許文献1「自走式草刈機」には、機体に備えられたハンドルを持って地面の草を刈ることができる自走式草刈機が開示されている。この自走式草刈機は、機体から延びたハンドル長さを調節することで、作業者の位置から機体を離して草刈作業をすることができる。
In agricultural work, it is required that work machines can enter and work at places where it is difficult for workers to enter. Workers who handle work machines are required to be able to save labor associated with the operation of the vehicle and to be able to be economically introduced easily.
Patent Document 1 "Self-propelled mowing machine" discloses a self-propelled mowing machine capable of mowing grass on the ground with a handle provided on the machine body. This self-propelled mowing machine can carry out mowing work by releasing the machine body from the position of the operator by adjusting the length of the handle extending from the machine body.
特許文献2「サーボモータ装置の較正方法およびサーボモータ装置」には、模型用ラジオコントロール装置におけるサーボモータ装置の較正方法及びサーボモータ装置についてであるが開示されている。
このサーボモータ装置は、「ブラシレスモータの持つセンサの情報を利用して、モータの回転の位置をカウンタによって表す。カウンタの値から求められるサーボモータ装置の出力軸の回転角度と、このときのポテンショメータからの出力信号の出力値を対応付けて複数記録し、データテーブルを作成する。サーボモータ装置を使用するときには、出力信号からデータテーブルを用いて出力軸の回転角度を求め、この回転角度を利用した駆動制御を行う」、とされる。
Patent Document 2 "Calibration method of servo motor device and servo motor device" discloses a calibration method of servo motor device and servo motor device in a radio control device for model.
This servomotor device “represents the position of rotation of the motor by a counter using information of the sensor of the brushless motor. The rotation angle of the output shaft of the servomotor device determined from the value of the counter and the potentiometer at this time A plurality of output values of the output signal from are recorded in association with each other to create a data table.When using the servo motor device, the rotation angle of the output shaft is obtained from the output signal using the data table, and this rotation angle is used Drive control is performed.
特許文献1記載の自走式の作業機を操作する場合、機体に備えられたハンドルを把持するため、作業者は常時機体に随行しなければならない問題がある。
そこで、常時機体への随行を回避するために機体を作業者から遠ざけて遠隔操作を可能にする装置が必要になる。
When operating the self-propelled work machine described in Patent Document 1, there is a problem that the operator must always accompany the machine in order to grip the handle provided on the machine.
Therefore, in order to always avoid traveling to the aircraft, a device is needed which allows the aircraft to be remote from the operator to enable remote control.
特許文献2記載の装置は、模型の各部を駆動させるためにサーボモータ装置を使用するものである。サーボモータ装置は、ブラシレスモータとポテンショメータを使用していて、このポテンショメータから得られたデータを用いて各駆動源を制御する。
複数の走行駆動用モータを同時に制御しようとすると、サーボモータ装置も同数必要になる。結果として部品点数が増加して価格が高騰する要因になる。また、このサーボモータ装置では、複数の信号を入力して複数のモータを同時に制御しようとした場合、システムが複雑になる問題がある。
The device described in Patent Document 2 uses a servomotor device to drive each part of a model. The servomotor device uses a brushless motor and a potentiometer, and controls each drive source using data obtained from the potentiometer.
In order to control a plurality of traveling drive motors simultaneously, the same number of servomotor devices are required. As a result, the number of parts increases and the price rises. In addition, in this servo motor device, there is a problem that the system becomes complicated when trying to control a plurality of motors simultaneously by inputting a plurality of signals.
本発明は、上述の問題点に着眼してなされたものであり、遠隔操作を行うとともに、駆動用モータの回転制御を電気信号で行うことで複数の入出力信号の制御を可能にし、且つ、部品点数を減らすことができる自走式作業機の制御システムを提供することを目的とする。 The present invention has been made in view of the above problems, and enables remote control and control of a plurality of input / output signals by controlling rotation of a drive motor with an electrical signal, and An object of the present invention is to provide a control system of a self-propelled work machine capable of reducing the number of parts.
この発明は、
機体の進行方向左右側に設けられ駆動走行をさせる走行モータを有した走行部と、
前記機体及び前記走行部の前方に並べて位置させて作業をするための右刈刃、左刈刃と、
右刈刃と、左刈刃とをそれぞれ駆動する複数の作業モータである右刈刃モータ、左刈刃モータと、
右刈刃モータを駆動停止及び回転方向を選択するためのスイッチである右刈刃スイッチと、
左刈刃モータを駆動停止及び回転方向を選択するためのスイッチである左刈刃スイッチと、
を備えた作業部と、
前記作業部を昇降自在にする昇降アーム及び昇降モータを備えた昇降部と、
前記走行部及び前記作業部及び前記昇降部を操作するための操作部と、
該操作部から送られた信号を変換し、前記走行モータ及び前記作業モータ及び前記昇降モータの回転を制御するため信号を出力する変換部制御装置と、
を備え、
前記変換部制御装置は、前記操作部から送られた信号を、前記走行モータ及び前記作業モータ及び前記昇降モータを動作させる出力信号に変換するパルス数変換部をさらに備え、
前記操作部から送られた旋回信号を前記パルス数変換部の出力信号が指定された出力値であるか判断する演算部をさらに備え、
前記演算部での判断に応じて前記走行モータの走行モータ回転信号、刈刃モータの負荷に応じた走行モータの電流、回転数、パルス数を予め設定した設定値を記憶する記憶部をさらに備え、
刈刃信号の処理を開始すると、「刈刃モータのON/OFF信号を取得」し、次いで、「パルス数を刈刃モータのON/OFF範囲に変換」し、
次いで、「刈刃スイッチがON」か否かを判断し、
「刈刃スイッチがON」がNOの場合は、「全ての刈刃を停止」し、終了し、
「刈刃スイッチがON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断し、
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断し、
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了し、
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータは過負荷か」否かを判断し、
「左側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータは過負荷か」がNOの場合は、「左側の刈刃モータを回転」し「開始」に戻り、
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータは過負荷か」否かを判断し、
「右側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として「終了」し、
「右側の刈刃モータは過負荷か」がNOの場合は、「右側の刈刃モータを回転」し、「左側刈刃の回転指示はあるか」を判断し、
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返し、
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断し、
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断し、
「待機時間経過か」がYESの場合は、「左側の刈刃モータが過負荷か」否かを判断し、「左側の刈刃モータが過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータが過負荷か」がNOの場合は、「左側の刈刃モータを回転」し、その後「開始」に戻り処理を繰り返す、
ことを特徴とする自走式作業機、
からなる。
This invention is
A traveling unit provided with a traveling motor provided on the left and right sides in the traveling direction of the vehicle to drive the vehicle;
A right cutting blade, a left cutting blade, for performing work by arranging in front of the machine body and the traveling unit ;
The right cutting blade motor and the left cutting blade motor, which are a plurality of work motors that drive the right cutting blade and the left cutting blade,
A right cutting blade switch which is a switch for stopping driving the right cutting blade motor and selecting a rotation direction,
A left cutting blade switch that is a switch for stopping driving the left cutting blade motor and selecting a rotation direction;
A working unit equipped with
A lift arm including a lift arm and a lift motor that lifts and lowers the working unit;
An operating unit for operating the traveling unit, the working unit, and the elevating unit;
A converter control unit that converts a signal sent from the operation unit and outputs a signal to control rotation of the traveling motor, the work motor, and the elevating motor;
Equipped with
The conversion unit control device further includes a pulse number conversion unit that converts the signal sent from the operation unit into an output signal for operating the traveling motor, the work motor, and the elevating motor.
The computer further comprises an operation unit that determines whether the output signal of the pulse number conversion unit is a designated output value or not, the turning signal sent from the operation unit.
It further comprises a storage unit for storing a preset value in which the traveling motor rotation signal of the traveling motor, the current of the traveling motor according to the load of the cutting blade motor, the number of rotations and the number of pulses are preset according to the determination in the arithmetic unit. ,
When processing of the reaping blade signal is started, "acquire ON / OFF signal of reaping blade motor", then "convert the number of pulses into ON / OFF range of reaping blade motor",
Then, it is judged whether "the cutting blade switch is ON",
If "Mowing blade switch is ON" is "NO", "Stop all cutting blades" and complete,
If "the cutting blade switch is ON" is YES, it is determined whether "the rotation instruction of the right cutting blade is instructed",
If "Is there a rotation instruction for the right cutting blade?" Is NO, it is judged whether or not "There is a rotation instruction for the left cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all cutting blades and finish
If “Is there a rotation instruction for the left cutting blade?” Is “YES”, it is judged whether “the left cutting blade motor is overloaded” or not,
If "Is the cutting blade motor on the left overloaded?" Is YES, it ends as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Is the left cutting blade motor overloaded?" Is "NO,""Reply the left cutting blade motor" and return to "Start",
If "Is there a rotation instruction for the right cutting blade?" Is "YES", it is determined whether or not the "right cutting blade motor is overloaded",
If "Is the right cutting blade motor overloaded?" Is "YES", "End" is executed as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Does the right-side cutting blade motor overload?" Is "NO,""rotate the right-side cutting blade motor" and determine "is there a rotation instruction for the left-side cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, then return to “Start” and repeat the process,
If "Is there a rotation instruction for the left cutting blade?" Is YES, it is determined whether "waiting time has elapsed",
If "wait time elapsed" is NO, it is judged again whether "wait time elapsed",
If "Is the waiting time elapsed" is YES, it is judged whether "the left cutting blade motor is overloaded" or not, and if "the left cutting blade motor is overloaded" is YES, the "traveling motor, End as "all stop of cutting blade motor and lifting motor"
If “Is the left cutting blade motor overloaded?” Is “NO,” “Rotate the left cutting blade motor”, then return to “Start” and repeat the process,
Self-propelled work machine, characterized by
It consists of
この発明は、
機体の進行方向左右側に設けられ駆動走行をさせる走行モータを有した走行部と、
前記機体及び前記走行部の前方に並べて位置させて作業をするための右刈刃、左刈刃と、
右刈刃と、左刈刃とをそれぞれ駆動する複数の作業モータである右刈刃モータ、左刈刃モータと、
右刈刃モータを駆動停止及び回転方向を選択するためのスイッチである右刈刃スイッチと、
左刈刃モータを駆動停止及び回転方向を選択するためのスイッチである左刈刃スイッチと、
を備えた作業部と、
前記作業部を昇降自在にする昇降アーム及び昇降モータを備えた昇降部と、前記走行部及び前記作業部及び前記昇降部を操作するための操作部と、該操作部から送られた信号を変換し、前記走行モータ及び前記作業モータ及び前記昇降モータの回転を制御するため信号を出力する変換部制御装置と、前記変換部制御装置は演算部、前記演算部での判断に応じて前記走行モータの走行モータ回転信号、刈刃モータの負荷に応じた走行モータの電流、回転数、パルス数を予め設定した設定値を記憶する記憶部、パルス数変換部と、を備えた自走式作業機の制御システムであって、
前記操作部から送られた信号を、前記走行モータ及び前記作業モータ及び前記昇降モータを動作させる出力信号に変換する工程と、
前記出力信号の値に応じて前記走行モータの走行モータ回転信号の値を前記演算部で演算させる工程と、
前記演算部での判断に応じて前記走行モータの走行モータ回転信号を前記記憶部に記憶させる工程と、
前記記憶部から記憶された値を取り出し前記演算部で演算された値によって走行モータを回転させる信号を出力させる工程と、
を含み、
刈刃信号の処理を開始すると、「刈刃モータのON/OFF信号を取得」し、次いで、「パルス数を刈刃モータのON/OFF範囲に変換」し、
次いで、「刈刃スイッチがON」か否かを判断し、
「刈刃スイッチがON」がNOの場合は、「全ての刈刃を停止」し、終了し、
「刈刃スイッチがON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断し、
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断し、
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了し、
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータは過負荷か」否かを判断し、
「左側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータは過負荷か」がNOの場合は、「左側の刈刃モータを回転」し「開始」に戻り、
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータは過負荷か」否かを判断し、
「右側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として「終了」し、
「右側の刈刃モータは過負荷か」がNOの場合は、「右側の刈刃モータを回転」し、「左側刈刃の回転指示はあるか」を判断し、
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返し、
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断し、
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断し、
「待機時間経過か」がYESの場合は、「左側の刈刃モータが過負荷か」否かを判断し、「左側の刈刃モータが過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータが過負荷か」がNOの場合は、「左側の刈刃モータを回転」し、その後「開始」に戻り処理を繰り返す、
ことを特徴とする自走式作業機の制御の制御システム、
からなる。
This invention is
A traveling unit provided with a traveling motor provided on the left and right sides in the traveling direction of the vehicle to drive the vehicle;
A right cutting blade, a left cutting blade, for performing work by arranging in front of the machine body and the traveling unit;
The right cutting blade motor and the left cutting blade motor, which are a plurality of work motors that drive the right cutting blade and the left cutting blade,
A right cutting blade switch which is a switch for stopping driving the right cutting blade motor and selecting a rotation direction,
A left cutting blade switch that is a switch for stopping driving the left cutting blade motor and selecting a rotation direction;
A working unit equipped with
A lifting unit including a lifting arm and a lifting motor for moving the working unit up and down, an operating unit for operating the traveling unit, the working unit and the lifting unit, and a signal sent from the operating unit A converter control unit that outputs a signal to control rotation of the traveling motor, the work motor, and the elevating motor; and the traveling motor according to the judgment of the operation unit and the operation unit, the conversion unit control device Storage unit for storing a preset value in which a traveling motor rotation signal according to the current of the traveling motor, the current of the traveling motor according to the load of the cutting blade motor, the number of rotations, and the number of pulses are stored; Control system of
Converting the signal sent from the operation unit into an output signal for operating the traveling motor, the work motor, and the elevating motor;
Causing the calculation unit to calculate the value of the traveling motor rotation signal of the traveling motor according to the value of the output signal;
Storing a traveling motor rotation signal of the traveling motor in the storage unit according to the determination of the arithmetic unit;
Taking a value stored in the storage unit and outputting a signal for rotating the traveling motor according to the value calculated by the calculation unit;
Including
When processing of the reaping blade signal is started, "acquire ON / OFF signal of reaping blade motor", then "convert the number of pulses into ON / OFF range of reaping blade motor",
Then, it is judged whether "the cutting blade switch is ON",
If "Mowing blade switch is ON" is "NO", "Stop all cutting blades" and complete,
If "the cutting blade switch is ON" is YES, it is determined whether "the rotation instruction of the right cutting blade is instructed",
If "Is there a rotation instruction for the right cutting blade?" Is NO, it is judged whether or not "There is a rotation instruction for the left cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all cutting blades and finish
If “Is there a rotation instruction for the left cutting blade?” Is “YES”, it is judged whether “the left cutting blade motor is overloaded” or not,
If "Is the cutting blade motor on the left overloaded?" Is YES, it ends as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Is the left cutting blade motor overloaded?" Is "NO,""Reply the left cutting blade motor" and return to "Start",
If "Is there a rotation instruction for the right cutting blade?" Is "YES", it is determined whether or not the "right cutting blade motor is overloaded",
If "Is the right cutting blade motor overloaded?" Is "YES", "End" is executed as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Does the right-side cutting blade motor overload?" Is "NO,""rotate the right-side cutting blade motor" and determine "is there a rotation instruction for the left-side cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, then return to “Start” and repeat the process,
If "Is there a rotation instruction for the left cutting blade?" Is YES, it is determined whether "waiting time has elapsed",
If "wait time elapsed" is NO, it is judged again whether "wait time elapsed",
If "Is the waiting time elapsed" is YES, it is judged whether "the left cutting blade motor is overloaded" or not, and if "the left cutting blade motor is overloaded" is YES, the "traveling motor, End as "all stop of cutting blade motor and lifting motor"
If “Is the left cutting blade motor overloaded?” Is “NO,” “Rotate the left cutting blade motor”, then return to “Start” and repeat the process,
Control system for control of self-propelled work machine, characterized by
It consists of
この発明は、
機体の進行方向左右側に設けられ駆動走行をさせる走行モータを有した走行部と、
前記機体及び前記走行部の前方に並べて位置させて作業をするための右刈刃、左刈刃と、
右刈刃と、左刈刃とをそれぞれ駆動する複数の作業モータである右刈刃モータ、左刈刃モータと、
右刈刃モータを駆動停止及び回転方向を選択するためのスイッチである右刈刃スイッチと、
左刈刃モータを駆動停止及び回転方向を選択するためのスイッチである左刈刃スイッチと、
を備えた作業部と、
前記作業部を昇降自在にする昇降アーム及び昇降モータを備えた昇降部と、前記走行部及び前記作業部及び前記昇降部を操作するための操作部と、該操作部から送られた信号を変換し、前記走行モータ及び前記作業モータ及び前記昇降モータの回転を制御するため信号を出力する変換部制御装置と、前記変換部制御装置は演算部、前記演算部での判断に応じて前記走行モータの走行モータ回転信号、刈刃モータの負荷に応じた走行モータの電流、回転数、パルス数を予め設定した設定値を記憶する記憶部、パルス数変換部と、を備えた自走式作業機の制御システムであって、
前記操作部から送られた信号を、前記走行モータ及び前記作業モータ及び前記昇降モータを動作させる出力信号に変換する工程と、
前記出力信号の値に応じて前記走行モータの走行モータ回転信号の値を前記演算部で演算させる工程と、
前記演算部での判断に応じて前記走行モータの走行モータ回転信号を前記記憶部に記憶させる工程と、
前記記憶部から記憶された値を取り出し前記演算部で演算された値によって走行モータを回転させる信号を出力させる工程と、
を含み、
刈刃信号の処理を開始すると、「刈刃モータのON/OFF信号を取得」し、次いで、「パルス数を刈刃モータのON/OFF範囲に変換」し、
次いで、「刈刃スイッチがON」か否かを判断し、
「刈刃スイッチがON」がNOの場合は、「全ての刈刃を停止」し、終了し、
「刈刃スイッチがON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断し、
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断し、
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了し、
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータは過負荷か」否かを判断し、
「左側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータは過負荷か」がNOの場合は、「左側の刈刃モータを回転」し「開始」に戻り、
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータは過負荷か」否かを判断し、
「右側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として「終了」し、
「右側の刈刃モータは過負荷か」がNOの場合は、「右側の刈刃モータを回転」し、「左側刈刃の回転指示はあるか」を判断し、
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返し、
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断し、
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断し、
「待機時間経過か」がYESの場合は、「左側の刈刃モータが過負荷か」否かを判断し、「左側の刈刃モータが過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータが過負荷か」がNOの場合は、「左側の刈刃モータを回転」し、その後「開始」に戻り処理を繰り返す、
ことを特徴とする自走式作業機の制御の制御方法。
This invention is
A traveling unit provided with a traveling motor provided on the left and right sides in the traveling direction of the vehicle to drive the vehicle;
A right cutting blade, a left cutting blade, for performing work by arranging in front of the machine body and the traveling unit;
The right cutting blade motor and the left cutting blade motor, which are a plurality of work motors that drive the right cutting blade and the left cutting blade,
A right cutting blade switch which is a switch for stopping driving the right cutting blade motor and selecting a rotation direction,
A left cutting blade switch that is a switch for stopping driving the left cutting blade motor and selecting a rotation direction;
A working unit equipped with
A lifting unit including a lifting arm and a lifting motor for moving the working unit up and down, an operating unit for operating the traveling unit, the working unit and the lifting unit, and a signal sent from the operating unit A converter control unit that outputs a signal to control rotation of the traveling motor, the work motor, and the elevating motor; and the traveling motor according to the judgment of the operation unit and the operation unit, the conversion unit control device Storage unit for storing a preset value in which a traveling motor rotation signal according to the current of the traveling motor, the current of the traveling motor according to the load of the cutting blade motor, the number of rotations, and the number of pulses are stored; Control system of
Converting the signal sent from the operation unit into an output signal for operating the traveling motor, the work motor, and the elevating motor;
Causing the calculation unit to calculate the value of the traveling motor rotation signal of the traveling motor according to the value of the output signal;
Storing a traveling motor rotation signal of the traveling motor in the storage unit according to the determination of the arithmetic unit;
Taking a value stored in the storage unit and outputting a signal for rotating the traveling motor according to the value calculated by the calculation unit;
Including
When processing of the reaping blade signal is started, "acquire ON / OFF signal of reaping blade motor", then "convert the number of pulses into ON / OFF range of reaping blade motor",
Then, it is judged whether "the cutting blade switch is ON",
If "Mowing blade switch is ON" is "NO", "Stop all cutting blades" and complete,
If "the cutting blade switch is ON" is YES, it is determined whether "the rotation instruction of the right cutting blade is instructed",
If "Is there a rotation instruction for the right cutting blade?" Is NO, it is judged whether or not "There is a rotation instruction for the left cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all cutting blades and finish
If “Is there a rotation instruction for the left cutting blade?” Is “YES”, it is judged whether “the left cutting blade motor is overloaded” or not,
If "Is the cutting blade motor on the left overloaded?" Is YES, it ends as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Is the left cutting blade motor overloaded?" Is "NO,""Reply the left cutting blade motor" and return to "Start",
If "Is there a rotation instruction for the right cutting blade?" Is "YES", it is determined whether or not the "right cutting blade motor is overloaded",
If "Is the right cutting blade motor overloaded?" Is "YES", "End" is executed as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Does the right-side cutting blade motor overload?" Is "NO,""rotate the right-side cutting blade motor" and determine "is there a rotation instruction for the left-side cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, then return to “Start” and repeat the process,
If "Is there a rotation instruction for the left cutting blade?" Is YES, it is determined whether "waiting time has elapsed",
If "wait time elapsed" is NO, it is judged again whether "wait time elapsed",
If "Is the waiting time elapsed" is YES, it is judged whether "the left cutting blade motor is overloaded" or not, and if "the left cutting blade motor is overloaded" is YES, the "traveling motor, End as "all stop of cutting blade motor and lifting motor"
If “Is the left cutting blade motor overloaded?” Is “NO,” “Rotate the left cutting blade motor”, then return to “Start” and repeat the process,
Control method of control of self-propelled work machine characterized by things.
本発明によれば、遠隔操作を行うとともに、駆動用モータの回転制御を電気信号で行うことで複数の入出力信号の制御を可能にし、且つ、部品点数を減らすことができる自走式作業機の制御システム及び方法を提供できる。 According to the present invention, a self-propelled working machine capable of controlling a plurality of input / output signals by performing remote control and performing rotation control of a drive motor by an electric signal, and reducing the number of parts. Control system and method.
この発明の実施例に係る自走式作業機及び自走式作業機の制御システム及び方法について説明する。
Aは、自走式草刈機である。自走式草刈機Aの平面図をあらわす図1において、図中左側が自走式草刈機Aの前方、右が後方、上が右側、下が左側である。
Bは、自走式草刈機Aにおける、操作部である送信機である。自走式草刈機Aは、送信機Bによって操作する。Jは受信機であり自走式草刈機A上に設置する。
A control system and method of a self-propelled work machine and a self-propelled work machine according to an embodiment of the present invention will be described.
A is a self-propelled mowing machine. In FIG. 1 showing a plan view of the self-propelled mower A, the left side in the drawing is the front of the self-propelled mower A, the right is the rear, the top is the right, and the bottom is the left.
B is a transmitter which is an operation unit in the self-propelled mowing machine A. The self-propelled mowing machine A is operated by a transmitter B. J is a receiver and is installed on a self-propelled mowing machine A.
自走式草刈機Aには、中央に機体である本体部Lを設ける。本体部Lには、本体フレーム01、走行部Dを設ける。本体部Lの前部に、作業部Kを設ける。作業部Kには、2個の刈刃部Cを進行方向に向かって並べて設置する。本体部Lの左右には、走行部Dを設ける。本体部Lの後部には、牽引部Pを設ける。牽引部Pには、連結部を介して、被牽引作業車を取り付ける。
Eは変換部制御装置であり、自走式草刈機Aの駆動、作動を制御する。Fは刈刃リフト部であり、走行部Dに取り付けた刈刃部Cを昇降する。
The self-propelled mowing machine A is provided with a main body L which is an airframe at the center. The main body portion L is provided with a
E is a converter control unit, which controls the drive and operation of the self-propelled mowing machine A. F is a cutting blade lift part, which raises and lowers the cutting blade C attached to the traveling part D.
走行部Dには、走行フレーム11を設ける。走行フレーム11は、自走式草刈機Aの進行方向両側に平行にそれぞれ設ける。12は駆動輪、13は従動輪である。12aは右駆動輪、12bは左駆動輪である。121は、駆動輪12の回転軸である。
駆動輪12は、走行フレーム11の後部に幅方向に取り付けた回転軸121に取り付ける。従動輪13は、走行フレーム11の前部に取り付ける。14は、転輪である。転輪14は、駆動輪12、従動輪13の間の走行フレーム11に取り付ける。
The traveling part D is provided with a traveling
The driving wheel 12 is attached to a
走行部Dには、機体である本体部Lの進行方向左右側に、自走式草刈機Aに駆動走行をさせる走行モータ15を設ける。15aは右走行モータ、15bは左走行モータである。走行モータ15は、左右駆動輪12の左右駆動軸にそれぞれ取り付ける。16は、クローラである。16aは右クローラ、16bは左クローラである。クローラ16は、左右の駆動輪12、転輪14、従動輪13間にそれぞれ架け渡す。
2個の走行モータ15a、15bを駆動して、各駆動輪12を駆動させクローラ16を駆動させ、転輪14、従動輪13を回転することで、自走式草刈機Aは、駆動走行する。
The traveling unit D is provided with a traveling motor 15 for causing the self-propelled mowing machine A to drive and travel on the left and right sides in the traveling direction of the main body L which is an airframe. 15a is a right traveling motor, and 15b is a left traveling motor. The traveling motor 15 is attached to the left and right drive shafts of the left and right drive wheels 12 respectively. 16 is a crawler. 16a is a right crawler and 16b is a left crawler. The crawler 16 spans between the left and right drive wheels 12, the
The two traveling
21、22は、バッテリである。バッテリ21、バッテリ22は、それぞれ自走式草刈機Aに積載される。23は、電源スイッチである。電源スイッチ23は、バッテリ21、バッテリ22をそれぞれ入切して通電状態を切替える。
31は、切替スイッチである。切替スイッチ31は、自走式草刈機Aの走行部Dに積載する。切替スイッチ31には、右刈刃スイッチ32、左刈刃スイッチ33、非常停止スイッチ34、通常信地旋回/超信地旋回切替スイッチ38の各スイッチが設置される。右刈刃スイッチ32は、作業部Kに設けた右刈刃51aを駆動停止及び回転方向を選択するためのスイッチである。左刈刃スイッチ33は、作業部Kに設けた左刈刃51bを駆動停止及び回転方向を選択するためのスイッチである。非常停止スイッチ34は、緊急時に自走式草刈機Aの作動を停止させるためのスイッチである。
21 and 22 are batteries. The
31 is a changeover switch. The changeover switch 31 loads the traveling portion D of the self-propelled mowing machine A. The
切替スイッチ31には、左刈刃運転ランプ35、右刈刃運転ランプ36、電源ランプ37の各ランプを設置する。左刈刃運転ランプ35は、左刈刃運転ランプの作動時に点灯して知らせる。右刈刃運転ランプ36は、右刈刃運転ランプの作動時に点灯して知らせる。電源ランプ37は、自走式草刈機Aの電源の入切、自走式草刈機Aの作動状態を知らせるランプである。
これらランプは、変換部制御装置Eによって走行モータ15及び刈刃モータ51及びリフト部Fに設ける昇降モータ61を含む全ての駆動の異常を検知して停止した場合は点滅発光する。
In the
These lamps blink when they are stopped by detecting abnormality in all driving including the traveling motor 15 and the cutting blade motor 51 and the lifting
41は昇降支点、42は昇降支点軸、43は昇降アーム、44は支点部材である。支点部材44は、本体部Lに垂直方向に取り付け、昇降支点41、昇降支点軸42を取り付ける。43aは右昇降アーム、43bは左昇降アームであり、これらで刈刃リフト部Fを構成する。
昇降支点41は、自走式草刈機Aの走行部Dに幅方向に取り付ける。昇降支点軸42は、昇降支点41に取り付ける。昇降アーム43の一方は昇降支点軸42に取り付ける。
61は、昇降モータである。昇降モータ61は、基部は自走式草刈機Aの本体フレーム01上に取り付ける。62は出力軸である。昇降モータ61からは、出力軸62が突設される。出力軸62は、自走式草刈機Aの前後方向と平行に設置する。出力軸62にはピニオンギヤ63を取り付ける。
The
64は、昇降ギヤである。昇降ギヤ64は、全体として扇形からなり、自走式草刈機Aの前後方向と垂直に設置する。昇降ギヤ64の基部には、自走式草刈機Aの前後方向と平行にギヤ旋回支点66を設け、本体部Lに取り付ける。昇降ギヤ64の扇形に広がった扇状部先端には、ラックギヤ65を設ける。
ピニオンギヤ63は、昇降ギヤ64に設けたラックギヤ65と噛み合わせる。
昇降モータ61が回転すると、昇降モータ61の出力軸62に取り付けられたピニオンギヤ63が回転する。ピニオンギヤ63の回転により、ピニオンギヤ63に噛み合った昇降ギヤ64の広がった端部に設けられたラックギヤ65を上下に移動する。ラックギヤ65の上下への移動により、昇降ギヤ64の基部に設けたギヤ旋回支点66を回動中心として昇降ギヤ64は回動する。
64 is an elevating gear. The raising and lowering
The
When the
図3に図示する641は、昇降ピンである。昇降ピン641は、ラックギヤ65の歯部近傍の下部で進行方向前方に向けて固着する。642は、ピンである。ピン642は、昇降支点41から作業部Kよりの昇降アーム43に幅方向に設ける。昇降ピン641は、ピン642を下方から支える。
図5、図6に図示するように、昇降アーム43と本体フレーム01の間に、スプリング643を設置する。スプリング643は、昇降アーム43を上方に常に付勢していて、作業部Kの上昇動作を補助している。
As illustrated in FIGS. 5 and 6, a
ラックギヤ65の上下への移動により、昇降ピン641も上下動する。ピン641は、ギヤ旋回支点66が回動することによる、ラックギヤ65の上下への移動と共に、昇降支点41を回動中心として、昇降アーム43を上下動させる。
昇降ピン641は、昇降アーム43が下方へ移動することを規制しているのみで、昇降アーム43の上方側への移動は自由である。
As the
The elevating pins 641 only restrict the downward movement of the elevating
刈刃リフト部Fである昇降部には、作業部Kを昇降自在にする昇降アーム43及び昇降モータ61を設ける。昇降アーム43の一端には、昇降支点軸42を有する昇降支点41を設けている。昇降アーム43は昇降支点41を回動軸にして上下動する。
In the lifting and lowering unit which is the cutting blade lifting unit F, a lifting and lowering
昇降ギヤ64は、昇降モータ61の回動により、ギヤ旋回支点66を回動軸として回動する。昇降ギヤ64の回動により、昇降ピン641も上下動する。昇降ピン641の上下動により、ピン642は、上下動する。ピン642の、上下動により、昇降アーム43は上下動する。刈刃部Cは、昇降アーム43の先端に取り付ける。
そのため、回動刈刃リフト部Fは、刃昇降支点軸42を回動中心として刈刃部Cを上下に昇降駆動し、昇降アーム43の先端は昇降される。
The elevating
Therefore, the rotating cutting blade lift unit F raises and lowers the cutting blade C up and down with the blade raising and lowering
作業部Kには、機体である本体部L及び走行部Dの前方に位置させて、作業をするための複数の作業モータである刈刃モータ51を設ける。51aは右刈刃モータ、51bは左刈刃モータである。この実施例では刈刃モータ51は、右刈刃用モータと左刈刃用モータの2個をそれぞれの回転軸を垂直にして、それぞれ進行方向左右に並べて刈刃部Cに設置する。
52は、刈刃基部である。刈刃基部52は、それぞれ刈刃モータ51の回転軸周囲に設置高さを変えて設ける。隣接する刈刃基部52の設置高さが異なるため、刈刃基部52相互が干渉することは無い。53は、刈刃である。刈刃53は、この実施例では、それぞれ刈刃基部52に等間隔に4個取り付ける。
The working unit K is provided with a cutting blade motor 51, which is a plurality of working motors for working, located in front of the main body L and the traveling unit D, which are machine bodies. 51a is a right cutting blade motor, and 51b is a left cutting blade motor. In this embodiment, the cutting blade motor 51 is installed in the cutting blade C, with the rotation shafts of the right cutting blade motor and the left cutting blade motor arranged vertically in the direction of travel.
52 is a cutting blade base. The
54は接地体である。接地体54は円盤状からなり、刈刃モータ51の刈刃53よりも下方の地面側に取り付ける。
55は、刈刃ハウジングであり、両方の刈刃基部52を覆うように、刈刃部Cに取り付ける。
刈刃モータ51を駆動することで、刈刃基部52を回転させ、刈刃53を回転駆動させる。
回転駆動した刈刃53によって、走行と共に刈刃ハウジング55内に侵入した地面上の草を刈取り、刈取った草は刈刃ハウジング55の後方から排出される。また、刈刃53は、接地体54より下方に下がることが無く、安定して地面上の草を刈る作業ができる。
54 is a grounding body. The
A
By driving the cutting blade motor 51, the
The grass on the ground that has entered the
Hは、記憶部である。図7に示す記憶部Hは、変換部制御装置Eに設けられ、刈刃モータ51の負荷に応じた走行モータ15の電流、回転数、パルス数を予め設定した設定値を記憶する。
Gは、回転駆動制御部である。回転駆動制御部Gは、走行モータ15、前記刈刃モータ51、昇降モータ61の回転数、電流、パルス数を検出し検出値を変換部制御装置Eに出力すると共に、走行モータ15及び刈刃モータ15、昇降モータ61を前記変換部制御装置Eによって決定された回転数で出力させ駆動する。回転駆動制御部Gは、右走行モータ制御部G1、左走行モータ制御部G2、右刈刃モータ回転駆動制御部G3、左刈刃モータ回転駆動制御部G4、リフトモータ回転駆動制御部G5、を有し、それぞれ各モータ、走行モータ15、刈刃モータ51、昇降モータ61に近接して配置している。
回転駆動制御部Gは、変換部制御装置Eで制御する。
H is a storage unit. A storage unit H illustrated in FIG. 7 is provided in the conversion unit control device E, and stores setting values in which the current, the number of rotations, and the number of pulses of the traveling motor 15 according to the load of the cutting blade motor 51 are preset.
G is a rotational drive control unit. The rotational drive control unit G detects the number of rotations, current, and pulse number of the traveling motor 15, the cutting blade motor 51, and the elevating
The rotation drive control unit G is controlled by the conversion unit control device E.
受信機Jからの信号を受領する変換部制御装置Eは、操作部Bから送られた信号を変換し、走行モータ15及び前記刈刃モータ51の回転駆動、前記刈刃53、昇降モータ61の回転を制御するため信号を出力し上下昇降を制御する。記憶部H、変換部制御装置Eは、近接させて設置する。
変換部制御装置Eは、操作部Bから送られた信号を、走行モータ15及び作業モータ51及び昇降モータ61を動作させる出力信号に変換するパルス数変換部Mを備える。
図1、図4に図示する操作部である送信機Bでは、走行部D及び作業部K及び昇降部Fを操作する。操作部である送信機Bにおいて、71は、旋回スイッチである。旋回スイッチ71は、送信機Bの旋回スイッチの動作範囲72内で回動する。
The converter control unit E receiving the signal from the receiver J converts the signal sent from the operation unit B, and rotationally drives the traveling motor 15 and the cutting blade motor 51, and the
The conversion unit control device E includes a pulse number conversion unit M that converts the signal sent from the operation unit B into an output signal for operating the traveling motor 15, the work motor 51, and the elevating
In the transmitter B which is an operation unit illustrated in FIGS. 1 and 4, the traveling unit D, the working unit K, and the elevating unit F are operated. In the transmitter B which is the operation unit, 71 is a turning switch. The
73は、前後進スイッチである。前後進スイッチ73は、前後進スイッチの動作範囲74の範囲内で移動する。
75は、信地旋回切替スイッチである。信地旋回切替スイッチ75は、操作することで、左右のクローラ16a、クローラ16bのうち、片側のクローラを停止してもう一方のクローラだけを回転させ、停止側のクローラを軸としてその場で旋回させる通常信地旋回と、互いのクローラ16a、16bのいずれか一方を前進方向に回転させ、他方を後進方向に回転させることで、機体の中心を旋回軸として旋回させる超信地旋回とを切り換える。
73 is a forward and reverse switch. The forward and reverse
図7に図示するブロック図について変換部制御装置Eの関係を説明する。
送信機Bから操作信号が送信される。受信機Jでは、送信機Bからの操作信号を受領して前進/後退信号81、旋回信号82、刈刃ON/OFF信号83、リフト上げ/下げ信号84の各信号を、変換部制御装置Eのパルス数変換部Mに伝送する。パルス数変換部Mでは、送信機Bから操作信号として送られる周波数(パルス信号)を、モータの出力率に変換し出力する。この実施例では、送信機Bから送信される周波数は1100Hz乃至1900Hzとされ、1500Hzをモータの出力率の0%と定め、1100Hzをモータの出力率−100%、1900Hzをモータの出力率+100%と設定している。周波数と出力率は比例関係に設定している。パルス数変換部Mからは、信号を演算部Nに伝送する。
The relationship of the converter control device E will be described with reference to the block diagram shown in FIG.
An operation signal is transmitted from the transmitter B. In the receiver J, the operation signal from the transmitter B is received, and the forward /
変換部制御装置Eは、記憶部Hと演算部Nとパルス数変換部Mからなる。演算部Nは、走行指示演算部E1と刈刃指示演算部E2とリフト指示演算部E3とからなる。
演算部Nは、送信部である操作部Bから送られ、パルス数変換部Mを介して変換された走行及び旋回及び昇降の出力信号が指定された出力値であるかを判断する。
記憶部Hは、演算部Nでの判断に応じて走行モータ15の走行モータ回転信号を記憶する。
The converter control unit E includes a storage unit H, an operation unit N, and a pulse number conversion unit M. The operation unit N includes a travel instruction operation unit E1, a cutting blade instruction operation unit E2, and a lift instruction operation unit E3.
The calculation unit N is sent from the operation unit B, which is a transmission unit, and determines whether the traveling, turning, and lifting output signals converted through the pulse number conversion unit M have a designated output value.
The storage unit H stores a traveling motor rotation signal of the traveling motor 15 according to the determination in the computing unit N.
走行指示演算部E1は、右走行モータ制御部G1、左走行モータ制御部G2に接続してこれらを制御する。
刈刃指示演算部E2は、右刈刃モータ回転駆動制御部G3、左刈刃モータ回転駆動制御部G4に接続してこれらを制御する。
右走行モータ制御部G1は右走行モータ15aに、左走行モータ制御部G2は左走行モータ15bに、右刈刃モータ回転駆動制御部G3は右刈刃モータ51aに、左刈刃モータ回転駆動制御部G4は左刈刃モータ51bの各刈刃モータ51にそれぞれ接続してこれらを制御する。
The travel instruction computation unit E1 is connected to the right traveling motor control unit G1 and the left traveling motor control unit G2 to control them.
The cutting blade instruction calculation unit E2 is connected to the right cutting blade motor rotation drive control unit G3 and the left cutting blade motor rotation drive control unit G4 to control them.
The right traveling motor control unit G1 controls the
変換部制御装置Eは、右刈刃スイッチ32、左刈刃スイッチ33、非常停止スイッチ34、右刈刃運転ランプ36、左刈刃運転ランプ35、電源ランプ37、電源スイッチ23、通常信地旋回/超信地旋回切替スイッチ38にそれぞれ接続してこれらを制御する。
リフト指示演算部E3は、リフトモータ回転駆動制御部G5に接続してこれを制御する。リフトモータ回転駆動制御部G5は、昇降モータ(リフトモータ)61に接続される。
演算部Nは、記憶部H、パルス数変換部Mに接続してこれらを制御する。
Converter control unit E is a right
The lift instruction computation unit E3 is connected to the lift motor rotation drive control unit G5 to control it. The lift motor rotational drive control unit G5 is connected to a lift motor (lift motor) 61.
The calculation unit N is connected to the storage unit H and the pulse number conversion unit M to control them.
この発明の実施例に係る自走式作業機及び自走式作業機の制御の制御システム及び方法は、
機体である本体部Lの進行方向左右側に設けられ駆動走行をさせる走行モータ15を有した走行部Dと、前記機体L及び前記走行部Dの前方に位置させて作業をするための複数の作業モータ51を備えた作業部Kと、前記作業部Kを昇降自在にする昇降アーム43及び昇降モータ61を備えた昇降部Fと、前記走行部D及び前記作業部K及び前記昇降部Fを操作するための操作部Bと、該操作部Bから送られた信号を変換し、前記走行モータ15及び前記作業モータ51及び前記昇降モータ61の回転を制御するため信号を出力する変換部制御装置Eと、前記変換部制御装置Eは演算部N、記憶部H、パルス数変換部Mと、を備えた自走式作業機又は自走式作業機の制御システム又は方法である。
A control system and method of a self-propelled work machine and a control of the self-propelled work machine according to an embodiment of the present invention,
A traveling unit D provided on the left and right sides in the traveling direction of the main body unit L, which is an airframe, and having a traveling motor 15 for driving and driving, and a plurality of works for positioning in front of the airframe L and the traveling unit D A working unit K including a working motor 51, a lifting and lowering unit F including a
同自走式作業機の制御の制御システム及び方法は、更に、
前記操作部Bから送られた信号を、前記走行モータ15及び前記作業モータ51及び前記昇降モータ61を動作させる出力信号に変換する工程と、前記出力信号の値に応じて前記走行モータ15の走行モータ回転信号の値を前記演算部Nで演算させる工程と、前記演算部Nでの判断に応じて前記走行モータ15の走行モータ回転信号を前記記憶部Hに記憶させる工程と、前記記憶部Hから記憶された値を取り出し前記演算部Nで演算された値によって走行モータ15を回転させる信号を出力させる工程と、
からなる。
The control system and method of control of the self-propelled work machine are further
Converting the signal sent from the operation unit B into an output signal for operating the traveling motor 15, the work motor 51, and the elevating
It consists of
図8に図示する旋回信号の処理についてあらわすフロー図について説明する。
旋回信号の処理を開始すると、受信機Jから旋回信号を取得する。すると、パルス信号を旋回範囲(%)に変換する。次いで、「前後進直進範囲か否か」を判断する。
「前後進直進範囲内」YESの場合は、右走行モータ旋回%に0を代入し(ΔFr=0、ΔRr=0)、左走行モータ旋回%に0を代入する(ΔFl=0、ΔRl=0)。次いで、ΔFr、ΔRr、ΔFl、ΔRlを記憶部Hに記憶する。次いで、開始に戻る。
A flow chart showing processing of a turning signal shown in FIG. 8 will be described.
When processing of the turning signal is started, the turning signal is acquired from the receiver J. Then, the pulse signal is converted into the turning range (%). Next, it is determined whether or not it is in the range of forward and reverse travel straight advance.
In the case of “in forward and reverse advance straight advance range”, substitute 0 for the right traveling motor turning% (ΔFr = 0, ΔRr = 0), and substitute 0 for the left traveling motor turning% (ΔF1 = 0, ΔR1 = 0 ). Next, ΔFr, ΔRr, ΔF1, and ΔR1 are stored in the storage unit H. Then return to the start.
「前後進直進範囲内」NOの場合は、「前後進直進範囲内超過乃至右モータ15a減速での右旋回範囲内か否か」を判断する。
「前後進直進範囲内超過乃至右モータ15a減速での右旋回範囲内」YESの場合は、右走行モータ15a旋回%値を代入する(ΔFr%、ΔRr%)。次いで、ΔFr、ΔRr、ΔFl、ΔRlを記憶部Hに記憶する。次いで、開始に戻る。
In the case of "within the forward and reverse travel straight advance range", it is determined whether "within the forward and reverse travel straight ahead range or the right turn range with the
In the case of “inside forward / backward going straight advance range or right turn range at deceleration of
「前後進直進範囲内超過乃至右モータ15a減速での右旋回範囲内」NOの場合は、「右モータ15a減速での右旋回範囲超過乃至、右走行モータ15a指示逆転での右超信地旋回までか否か」を判断する。
「右モータ15a減速での右旋回範囲超過乃至、右走行モータ15a指示逆転での右超信地旋回まで」YESの場合は、「右走行モータ15a旋回%値(ΔFr%、ΔRr%)」を代入する。次いで、ΔFr、ΔRr、ΔFl、ΔRlを記憶部Hに記憶する。次いで、開始に戻る。
In the case of "preceding forward / backward straight advance range to right turn range at
If "right turn range over at
「右走行モータ15a減速での右旋回範囲超過乃至、右走行モータ15a指示逆転での右超信地旋回まで」NOの場合は、「直進範囲内未満乃至、左走行モータ15b減速での左旋回範囲内か否か」を判断する。
「直進範囲内未満乃至、左走行モータ15b減速での左旋回範囲内」YESの場合は、「左走行モータ15b減速での左旋回範囲超過乃至左走行モータ指示逆転での右超信地旋回まで」をスキップして、「左走行モータ15b旋回%値(ΔFl%、ΔRl%)」を代入する。次いで、「ΔFr、ΔRr、ΔFl、ΔRlを記憶部Hに記憶」する。次いで、開始に戻る。
In the case of "until the right turn range over at the
In the case of "within the straight advance range or within the left turn range at the deceleration of the
「直進範囲内未満乃至、左走行モータ15b減速での左旋回範囲内」がNOの場合は、「左走行モータ15b減速での左旋回範囲超過乃至左走行モータ指示逆転での右超信地旋回まで」として、「左走行モータ15b旋回%値(ΔFl%、ΔRl%)」を代入し、次いで、「ΔFr、ΔRr、ΔFl、ΔRlを記憶部Hに記憶」する。
「ΔFr、ΔRr、ΔFl、ΔRlを記憶部Hに記憶」すると、開始に戻る。
If “within the straight advance range or within the left turn range at the deceleration of the
If “ΔFr, ΔRr, ΔF1, ΔR1 are stored in the storage unit H”, the process returns to the start.
図9に図示する前後進信号の処理についてあらわすフロー図について説明する。
「前後進信号の処理を開始」する。「受信機Jから前後進信号を取得」する。次いで、「パルス数を動作範囲(%)に変換」する。
次いで、「停止範囲内か否か」を判断する。
「停止範囲内」YESの場合は、「右走行モータ15a回転制御部G1へ停止を出力」し、「右走行モータ15aを停止」する。併せて、「左走行モータ15b回転制御部G2へ停止を出力」し、「左走行モータ15bを停止」する。次いで、「終了」する。
A flow chart showing processing of the forward and reverse signals illustrated in FIG. 9 will be described.
"Start processing of forward and reverse signals". “Acquire forward and reverse signals from the receiver J”. Then, "convert the number of pulses into the operating range (%)".
Then, it is determined "whether or not it is within the stop range".
In the case of “within the stop range”, “output the stop to the
「停止範囲内?」の判断がNOの場合は、「停止範囲超過乃至前進最大まで」か否かを判断する。
「停止範囲超過乃至前進最大まで」がYESの場合は、「記憶部HからΔFr、ΔFl、(旋回範囲%値)を取得」する。次いで、「右走行モータ15a前進方向へFr%、左走行モータ15b前進方向へFl%を代入」する。次いで、「右走行モータ回転駆動制御部G1へ、前進信号:Fr−ΔFr、右走行モータ回転駆動制御部G2へ、前進信号:Fl−ΔFlを出力」する。
If the determination of "within the stop range?" Is NO, it is determined whether "stop range over or maximum advance".
If “stop range over or maximum forward” is “YES”, “ΔFr, ΔF1, (turning range% value) is acquired from the storage unit H”. Next, "Fr% is substituted in the forward direction of the
次いで、「右走行モータ15a過負荷」否かを判断する。
「右走行モータ15a過負荷」YESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として「終了」する。
「右走行モータ15a過負荷」NOの場合は、「左走行モータ15b過負荷」か否かを判断する。
「左走行モータ15b過負荷」がYESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として「終了」する。
「左走行モータ15b過負荷」NOの場合は、「右走行モータ15a、左走行モータ15bの出力値に応じて回転」し、「開始」に戻る。
Next, it is determined whether the "
In the case of “
In the case of "the
If the "left
In the case of "the
「停止範囲超過乃至前進最大まで」がNOの場合は、「停止範囲未満乃至後進最大まで」とする。次いで、「記憶部HからΔRr、ΔRl(旋回範囲%値)を取得」する。次いで、「右走行モータ15a後進方向へRr%、左走行モータ15b後進方向へRl%を代入」する。次いで、「右走行モータ回転駆動制御部G1へ、後進信号:Rr−ΔRr、左走行モータ回転駆動制御部G2へ、後進信号:Rl−ΔRlを出力」する。
If “stop range over to maximum advance” is NO, “below stop range to maximum reverse” is set. Next, “Acquire ΔRr, ΔRl (turning range% value) from the storage unit H”. Next, "Rr% in the reverse travel direction of the
次いで、「右走行モータ15a過負荷」否かを判断する。
「右走行モータ15a過負荷」YESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として「終了」する。
「右走行モータ15a過負荷」NOの場合は、「左走行モータ15b過負荷」か否かを判断する。
「左走行モータ15b過負荷」がYESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として「終了」する。
「左走行モータ15b過負荷」NOの場合は、「右走行モータ15a、左走行モータ15b出力値に応じて回転」し、「開始」に戻る。
Next, it is determined whether the "
In the case of “
In the case of "the
If the "left
In the case of "the
図10に図示する刈刃信号の処理についてあらわすフロー図について説明する。
開始すると、「受信機Jから刈刃モータ51のON/OFF信号を取得」する。次いで、「パルス数を刈刃モータ51のON/OFF範囲に変換」する。
次いで、「刈刃スイッチ32、33がON」か否かを判断する。
「刈刃スイッチ32、33がON」がNOの場合は、「全ての刈刃を停止」し、終了する。
「刈刃スイッチ32、33がON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断する。
A flow chart showing processing of the cutting blade signal shown in FIG. 10 will be described.
If it starts, "the ON / OFF signal of the cutting blade motor 51 is acquired from the receiver J". Next, “convert the number of pulses into the ON / OFF range of the cutting blade motor 51”.
Next, it is determined whether or not the "cutting blade switches 32, 33 are ON".
If the "cutting blade switches 32, 33 are ON" is NO, "stop all cutting blades" and end.
If "the cutting blade switches 32, 33 are ON" is YES, it is determined whether "a rotation instruction for the right-side cutting blade is instructed".
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断する。
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了する。
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータ51は過負荷か」否かを判断する。
「左側の刈刃モータ51は過負荷か」がYESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として終了する。
「左側の刈刃モータ51は過負荷か」がNOの場合は、「左側の刈刃モータ51を回転」し「開始」に戻る。
If "is there a rotation instruction for the right side cutting blade" is NO, it is determined whether or not "a rotation instruction for the left side cutting blade is provided".
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all the cutting blades and end.
If "is there a rotation instruction of the left cutting blade" is YES, it is determined whether "the left cutting blade motor 51 is overloaded" or not.
If “Is the left cutting blade motor 51 overloaded?” Is “YES”, the process ends as “all stoppage of the traveling motor 15, the cutting blade motor 51, and the lifting (lifting)
If “Is the left cutting blade motor 51 overloaded?” Is “NO,” the “left cutting blade motor 51 is rotated” and the process returns to “Start”.
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータ51は過負荷か」否かを判断する。
「右側の刈刃モータ51は過負荷か」がYESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として「終了」する。
「右側の刈刃モータ51は過負荷か」がNOの場合は、「右側の刈刃モータ51を回転」し、「左側刈刃の回転指示はあるか」を判断する。
If "is there a rotation instruction of the right cutting blade" is YES, it is determined whether "the right cutting blade motor 51 is overloaded" or not.
If "Is the right cutting blade motor 51 overloaded?" Is "YES", "end" is performed as "all stop of the traveling motor 15, the cutting blade motor 51, and the lifting (lifting)
If “Is the right-side cutting blade motor 51 overloaded?” Is “NO”, then “rotate the right-side cutting blade motor 51” and “is there a rotation instruction for the left-side cutting blade?”.
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返す。
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断する。
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断する。
「待機時間経過か」がYESの場合は、「左側の刈刃モータ51が過負荷か」否かを判断する。「左側の刈刃モータ51が過負荷か」がYESの場合は、「走行モータ15、刈刃モータ51、昇降(リフト)モータ61の全停止」として終了する。
「左側の刈刃モータ51が過負荷か」がNOの場合は、「左側の刈刃モータ51を回転」し、その後「開始」に戻り処理を繰り返す。
If “Is there a rotation instruction for the left cutting blade?” Is NO, then the process returns to “Start” and repeats the process.
If “is there a rotation instruction for the left cutting blade?” Is YES, it is determined whether “waiting time elapsed”.
If “wait time elapsed” is NO, it is determined again whether “wait time elapsed”.
If "whether the standby time has elapsed" is YES, it is determined whether "the left cutting blade motor 51 is overloaded" or not. If “Is the left cutting blade motor 51 overloaded?” Is “YES”, the process ends as “all stoppage of the traveling motor 15, the cutting blade motor 51, and the lifting (lifting)
If “Is the left cutting blade motor 51 overloaded?” Is “NO,” the “left cutting blade motor 51 is rotated”, and then “start” is returned to and the processing is repeated.
この発明の実施例では、機械的な部品を減らせるので、複数の信号を入力して複数のモータを同時に制御しようとした場合でもシステムが複雑にならない。
電気的な信号で全てを制御するので、より複雑な条件制御が可能である。例えば、どれか1個のモータが過負荷になった時に全システムを停止させる等である。
電気信号でのシステムであるので、複数の入出力を制御させる事が出来、機体動作の応答の俊敏性、機体の操作性、安全性をそれぞれ向上させることができる。
機械的なシステムを減らすことにより、故障となる要因を減らすことが可能である。
In the embodiment of the present invention, since mechanical parts can be reduced, the system is not complicated even if it is attempted to simultaneously control a plurality of motors by inputting a plurality of signals.
Since everything is controlled by electrical signals, more complex condition control is possible. For example, when any one motor is overloaded, the whole system is stopped.
Since this system is an electric signal system, it is possible to control a plurality of input / outputs and to improve the agility of the response of the operation of the aircraft, the operability of the aircraft, and the safety.
By reducing the mechanical system, it is possible to reduce the causes of failure.
15 走行モータ
15a 右走行モータ
15b 左走行モータ
43 昇降アーム
51 刈刃モータ(作業モータ)
51a 右刈刃モータ(作業モータ)
51b 左刈刃モータ(作業モータ)
53 刈刃
61 昇降モータ
A 自走式草刈機
B 送信機(操作部)
C 刈刃部
D 走行部
E 変換部制御装置
F 刈刃リフト部(昇降部)
G 回転駆動制御部
H 記憶部
J 受信機
K 作業部
L 本体部(機体)
M パルス数変換部
N 演算部
15
51a Right cutting blade motor (work motor)
51b Left cutting blade motor (work motor)
53
C Cutting blade part D Traveling part E Converter control device F Cutting blade lift part (lifting part)
G Rotational drive control unit H Storage unit J Receiver K Working unit L Main unit (airframe)
M pulse number conversion unit N operation unit
Claims (3)
前記機体及び前記走行部の前方に並べて位置させて作業をするための右刈刃、左刈刃と、
右刈刃と、左刈刃とをそれぞれ駆動する複数の作業モータである右刈刃モータ、左刈刃モータと、
右刈刃モータを駆動停止及び回転方向を選択するためのスイッチである右刈刃スイッチと、
左刈刃モータを駆動停止及び回転方向を選択するためのスイッチである左刈刃スイッチと、
を備えた作業部と、
前記作業部を昇降自在にする昇降アーム及び昇降モータを備えた昇降部と、
前記走行部及び前記作業部及び前記昇降部を操作するための操作部と、
該操作部から送られた信号を変換し、前記走行モータ及び前記作業モータ及び前記昇降モータの回転を制御するため信号を出力する変換部制御装置と、
を備え、
前記変換部制御装置は、前記操作部から送られた信号を、前記走行モータ及び前記作業モータ及び前記昇降モータを動作させる出力信号に変換するパルス数変換部をさらに備え、
前記操作部から送られた旋回信号を前記パルス数変換部の出力信号が指定された出力値であるか判断する演算部をさらに備え、
前記演算部での判断に応じて前記走行モータの走行モータ回転信号、刈刃モータの負荷に応じた走行モータの電流、回転数、パルス数を予め設定した設定値を記憶する記憶部をさらに備え、
刈刃信号の処理を開始すると、「刈刃モータのON/OFF信号を取得」し、次いで、「パルス数を刈刃モータのON/OFF範囲に変換」し、
次いで、「刈刃スイッチがON」か否かを判断し、
「刈刃スイッチがON」がNOの場合は、「全ての刈刃を停止」し、終了し、
「刈刃スイッチがON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断し、
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断し、
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了し、
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータは過負荷か」否かを判断し、
「左側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータは過負荷か」がNOの場合は、「左側の刈刃モータを回転」し「開始」に戻り、
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータは過負荷か」否かを判断し、
「右側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として「終了」し、
「右側の刈刃モータは過負荷か」がNOの場合は、「右側の刈刃モータを回転」し、「左側刈刃の回転指示はあるか」を判断し、
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返し、
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断し、
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断し、
「待機時間経過か」がYESの場合は、「左側の刈刃モータが過負荷か」否かを判断し、「左側の刈刃モータが過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータが過負荷か」がNOの場合は、「左側の刈刃モータを回転」し、その後「開始」に戻り処理を繰り返す、
ことを特徴とする自走式作業機。 A traveling unit provided with a traveling motor provided on the left and right sides in the traveling direction of the vehicle to drive the vehicle;
A right cutting blade, a left cutting blade, for performing work by arranging in front of the machine body and the traveling unit ;
The right cutting blade motor and the left cutting blade motor, which are a plurality of work motors that drive the right cutting blade and the left cutting blade,
A right cutting blade switch which is a switch for stopping driving the right cutting blade motor and selecting a rotation direction,
A left cutting blade switch that is a switch for stopping driving the left cutting blade motor and selecting a rotation direction;
A working unit equipped with
A lift arm including a lift arm and a lift motor that lifts and lowers the working unit;
An operating unit for operating the traveling unit, the working unit, and the elevating unit;
A converter control unit that converts a signal sent from the operation unit and outputs a signal to control rotation of the traveling motor, the work motor, and the elevating motor;
Equipped with
The conversion unit control device further includes a pulse number conversion unit that converts the signal sent from the operation unit into an output signal for operating the traveling motor, the work motor, and the elevating motor.
The computer further comprises an operation unit that determines whether the output signal of the pulse number conversion unit is a designated output value or not, the turning signal sent from the operation unit.
It further comprises a storage unit for storing a preset value in which the traveling motor rotation signal of the traveling motor, the current of the traveling motor according to the load of the cutting blade motor, the number of rotations and the number of pulses are preset according to the determination in the arithmetic unit. ,
When processing of the reaping blade signal is started, "acquire ON / OFF signal of reaping blade motor", then "convert the number of pulses into ON / OFF range of reaping blade motor",
Then, it is judged whether "the cutting blade switch is ON",
If "Mowing blade switch is ON" is "NO", "Stop all cutting blades" and complete,
If "the cutting blade switch is ON" is YES, it is determined whether "the rotation instruction of the right cutting blade is instructed",
If "Is there a rotation instruction for the right cutting blade?" Is NO, it is judged whether or not "There is a rotation instruction for the left cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all cutting blades and finish
If “Is there a rotation instruction for the left cutting blade?” Is “YES”, it is judged whether “the left cutting blade motor is overloaded” or not,
If "Is the cutting blade motor on the left overloaded?" Is YES, it ends as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Is the left cutting blade motor overloaded?" Is "NO,""Reply the left cutting blade motor" and return to "Start",
If "Is there a rotation instruction for the right cutting blade?" Is "YES", it is determined whether or not the "right cutting blade motor is overloaded",
If "Is the right cutting blade motor overloaded?" Is "YES", "End" is executed as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Does the right-side cutting blade motor overload?" Is "NO,""rotate the right-side cutting blade motor" and determine "is there a rotation instruction for the left-side cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, then return to “Start” and repeat the process,
If "Is there a rotation instruction for the left cutting blade?" Is YES, it is determined whether "waiting time has elapsed",
If "wait time elapsed" is NO, it is judged again whether "wait time elapsed",
If "Is the waiting time elapsed" is YES, it is judged whether "the left cutting blade motor is overloaded" or not, and if "the left cutting blade motor is overloaded" is YES, the "traveling motor, End as "all stop of cutting blade motor and lifting motor"
If “Is the left cutting blade motor overloaded?” Is “NO,” “Rotate the left cutting blade motor”, then return to “Start” and repeat the process,
Self-propelled work machine characterized by
前記機体及び前記走行部の前方に並べて位置させて作業をするための右刈刃、左刈刃と、
右刈刃と、左刈刃とをそれぞれ駆動する複数の作業モータである右刈刃モータ、左刈刃モータと、
右刈刃モータを駆動停止及び回転方向を選択するためのスイッチである右刈刃スイッチと、
左刈刃モータを駆動停止及び回転方向を選択するためのスイッチである左刈刃スイッチと、
を備えた作業部と、
前記作業部を昇降自在にする昇降アーム及び昇降モータを備えた昇降部と、前記走行部及び前記作業部及び前記昇降部を操作するための操作部と、該操作部から送られた信号を変換し、前記走行モータ及び前記作業モータ及び前記昇降モータの回転を制御するため信号を出力する変換部制御装置と、前記変換部制御装置は演算部、前記演算部での判断に応じて前記走行モータの走行モータ回転信号、刈刃モータの負荷に応じた走行モータの電流、回転数、パルス数を予め設定した設定値を記憶する記憶部、パルス数変換部と、を備えた自走式作業機の制御システムであって、
前記操作部から送られた信号を、前記走行モータ及び前記作業モータ及び前記昇降モータを動作させる出力信号に変換する工程と、
前記出力信号の値に応じて前記走行モータの走行モータ回転信号の値を前記演算部で演算させる工程と、
前記演算部での判断に応じて前記走行モータの走行モータ回転信号を前記記憶部に記憶させる工程と、
前記記憶部から記憶された値を取り出し前記演算部で演算された値によって走行モータを回転させる信号を出力させる工程と、
を含み、
刈刃信号の処理を開始すると、「刈刃モータのON/OFF信号を取得」し、次いで、「パルス数を刈刃モータのON/OFF範囲に変換」し、
次いで、「刈刃スイッチがON」か否かを判断し、
「刈刃スイッチがON」がNOの場合は、「全ての刈刃を停止」し、終了し、
「刈刃スイッチがON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断し、
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断し、
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了し、
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータは過負荷か」否かを判断し、
「左側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータは過負荷か」がNOの場合は、「左側の刈刃モータを回転」し「開始」に戻り、
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータは過負荷か」否かを判断し、
「右側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として「終了」し、
「右側の刈刃モータは過負荷か」がNOの場合は、「右側の刈刃モータを回転」し、「左側刈刃の回転指示はあるか」を判断し、
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返し、
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断し、
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断し、
「待機時間経過か」がYESの場合は、「左側の刈刃モータが過負荷か」否かを判断し、「左側の刈刃モータが過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータが過負荷か」がNOの場合は、「左側の刈刃モータを回転」し、その後「開始」に戻り処理を繰り返す、
ことを特徴とする自走式作業機の制御の制御システム。 A traveling unit provided with a traveling motor provided on the left and right sides in the traveling direction of the vehicle to drive the vehicle;
A right cutting blade, a left cutting blade, for performing work by arranging in front of the machine body and the traveling unit ;
The right cutting blade motor and the left cutting blade motor, which are a plurality of work motors that drive the right cutting blade and the left cutting blade,
A right cutting blade switch which is a switch for stopping driving the right cutting blade motor and selecting a rotation direction,
A left cutting blade switch that is a switch for stopping driving the left cutting blade motor and selecting a rotation direction;
A working unit equipped with
A lifting unit including a lifting arm and a lifting motor for moving the working unit up and down, an operating unit for operating the traveling unit, the working unit and the lifting unit, and a signal sent from the operating unit A converter control unit that outputs a signal to control rotation of the traveling motor, the work motor, and the elevating motor; and the traveling motor according to the judgment of the operation unit and the operation unit, the conversion unit control device Storage unit for storing a preset value in which a traveling motor rotation signal according to the current of the traveling motor, the current of the traveling motor according to the load of the cutting blade motor, the number of rotations, and the number of pulses are stored; Control system of
Converting the signal sent from the operation unit into an output signal for operating the traveling motor, the work motor, and the elevating motor;
Causing the calculation unit to calculate the value of the traveling motor rotation signal of the traveling motor according to the value of the output signal;
Storing a traveling motor rotation signal of the traveling motor in the storage unit according to the determination of the arithmetic unit;
Taking a value stored in the storage unit and outputting a signal for rotating the traveling motor according to the value calculated by the calculation unit;
Only including,
When processing of the reaping blade signal is started, "acquire ON / OFF signal of reaping blade motor", then "convert the number of pulses into ON / OFF range of reaping blade motor",
Then, it is judged whether "the cutting blade switch is ON",
If "Mowing blade switch is ON" is "NO", "Stop all cutting blades" and complete,
If "the cutting blade switch is ON" is YES, it is determined whether "the rotation instruction of the right cutting blade is instructed",
If "Is there a rotation instruction for the right cutting blade?" Is NO, it is judged whether or not "There is a rotation instruction for the left cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all cutting blades and finish
If “Is there a rotation instruction for the left cutting blade?” Is “YES”, it is judged whether “the left cutting blade motor is overloaded” or not,
If "Is the cutting blade motor on the left overloaded?" Is YES, it ends as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Is the left cutting blade motor overloaded?" Is "NO,""Reply the left cutting blade motor" and return to "Start",
If "Is there a rotation instruction for the right cutting blade?" Is "YES", it is determined whether or not the "right cutting blade motor is overloaded",
If "Is the right cutting blade motor overloaded?" Is "YES", "End" is executed as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Does the right-side cutting blade motor overload?" Is "NO,""rotate the right-side cutting blade motor" and determine "is there a rotation instruction for the left-side cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, then return to “Start” and repeat the process,
If "Is there a rotation instruction for the left cutting blade?" Is YES, it is determined whether "waiting time has elapsed",
If "wait time elapsed" is NO, it is judged again whether "wait time elapsed",
If "Is the waiting time elapsed" is YES, it is judged whether "the left cutting blade motor is overloaded" or not, and if "the left cutting blade motor is overloaded" is YES, the "traveling motor, End as "all stop of cutting blade motor and lifting motor"
If “Is the left cutting blade motor overloaded?” Is “NO,” “Rotate the left cutting blade motor”, then return to “Start” and repeat the process,
Control system of control of self-propelled work machine characterized by the above.
前記機体及び前記走行部の前方に並べて位置させて作業をするための右刈刃、左刈刃と、
右刈刃と、左刈刃とをそれぞれ駆動する複数の作業モータである右刈刃モータ、左刈刃モータと、
右刈刃モータを駆動停止及び回転方向を選択するためのスイッチである右刈刃スイッチと、
左刈刃モータを駆動停止及び回転方向を選択するためのスイッチである左刈刃スイッチと、
を備えた作業部と、
前記作業部を昇降自在にする昇降アーム及び昇降モータを備えた昇降部と、前記走行部及び前記作業部及び前記昇降部を操作するための操作部と、該操作部から送られた信号を変換し、前記走行モータ及び前記作業モータ及び前記昇降モータの回転を制御するため信号を出力する変換部制御装置と、前記変換部制御装置は演算部、前記演算部での判断に応じて前記走行モータの走行モータ回転信号、刈刃モータの負荷に応じた走行モータの電流、回転数、パルス数を予め設定した設定値を記憶する記憶部、パルス数変換部と、を備えた自走式作業機の制御システムであって、
前記操作部から送られた信号を、前記走行モータ及び前記作業モータ及び前記昇降モータを動作させる出力信号に変換する工程と、
前記出力信号の値に応じて前記走行モータの走行モータ回転信号の値を前記演算部で演算させる工程と、
前記演算部での判断に応じて前記走行モータの走行モータ回転信号を前記記憶部に記憶させる工程と、
前記記憶部から記憶された値を取り出し前記演算部で演算された値によって走行モータを回転させる信号を出力させる工程と、
を含み、
刈刃信号の処理を開始すると、「刈刃モータのON/OFF信号を取得」し、次いで、「パルス数を刈刃モータのON/OFF範囲に変換」し、
次いで、「刈刃スイッチがON」か否かを判断し、
「刈刃スイッチがON」がNOの場合は、「全ての刈刃を停止」し、終了し、
「刈刃スイッチがON」がYESの場合は、「右側刈刃の回転指示あるか」否かを判断し、
「右側刈刃の回転指示あるか」がNOの場合は、「左側刈刃の回転指示があるか」否かを判断し、
「左側刈刃の回転指示があるか」がNOの場合は、全ての刈刃を停止し、終了し、
「左側刈刃の回転指示があるか」がYESの場合は、「左側の刈刃モータは過負荷か」否かを判断し、
「左側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータは過負荷か」がNOの場合は、「左側の刈刃モータを回転」し「開始」に戻り、
「右側刈刃の回転指示あるか」がYESの場合は、「右側の刈刃モータは過負荷か」否かを判断し、
「右側の刈刃モータは過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として「終了」し、
「右側の刈刃モータは過負荷か」がNOの場合は、「右側の刈刃モータを回転」し、「左側刈刃の回転指示はあるか」を判断し、
「左側刈刃の回転指示はあるか」がNOの場合は、その後「開始」に戻り処理を繰り返し、
「左側刈刃の回転指示はあるか」がYESの場合は、「待機時間経過か」否かを判断し、
「待機時間経過か」がNOの場合は、再度「待機時間経過か」否かを判断し、
「待機時間経過か」がYESの場合は、「左側の刈刃モータが過負荷か」否かを判断し、「左側の刈刃モータが過負荷か」がYESの場合は、「走行モータ、刈刃モータ、昇降モータの全停止」として終了し、
「左側の刈刃モータが過負荷か」がNOの場合は、「左側の刈刃モータを回転」し、その後「開始」に戻り処理を繰り返す、
ことを特徴とする自走式作業機の制御の制御方法。 A traveling unit provided with a traveling motor provided on the left and right sides in the traveling direction of the vehicle to drive the vehicle;
A right cutting blade, a left cutting blade, for performing work by arranging in front of the machine body and the traveling unit ;
The right cutting blade motor and the left cutting blade motor, which are a plurality of work motors that drive the right cutting blade and the left cutting blade,
A right cutting blade switch which is a switch for stopping driving the right cutting blade motor and selecting a rotation direction,
A left cutting blade switch that is a switch for stopping driving the left cutting blade motor and selecting a rotation direction;
A working unit equipped with
A lifting unit including a lifting arm and a lifting motor for moving the working unit up and down, an operating unit for operating the traveling unit, the working unit and the lifting unit, and a signal sent from the operating unit A converter control unit that outputs a signal to control rotation of the traveling motor, the work motor, and the elevating motor; and the traveling motor according to the judgment of the operation unit and the operation unit, the conversion unit control device travel motor rotation signal, the current of the running motor in accordance with the load of the cutting blade motor, rotational speed, storage unit for storing a set value set in advance the number of pulses, the self-propelled working machine comprising: a pulse number conversion unit, the Control system of
Converting the signal sent from the operation unit into an output signal for operating the traveling motor, the work motor, and the elevating motor;
Causing the calculation unit to calculate the value of the traveling motor rotation signal of the traveling motor according to the value of the output signal;
Storing a traveling motor rotation signal of the traveling motor in the storage unit according to the determination of the arithmetic unit;
Taking a value stored in the storage unit and outputting a signal for rotating the traveling motor according to the value calculated by the calculation unit;
Only including,
When processing of the reaping blade signal is started, "acquire ON / OFF signal of reaping blade motor", then "convert the number of pulses into ON / OFF range of reaping blade motor",
Then, it is judged whether "the cutting blade switch is ON",
If "Mowing blade switch is ON" is "NO", "Stop all cutting blades" and complete,
If "the cutting blade switch is ON" is YES, it is determined whether "the rotation instruction of the right cutting blade is instructed",
If "Is there a rotation instruction for the right cutting blade?" Is NO, it is judged whether or not "There is a rotation instruction for the left cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, stop all cutting blades and finish
If “Is there a rotation instruction for the left cutting blade?” Is “YES”, it is judged whether “the left cutting blade motor is overloaded” or not,
If "Is the cutting blade motor on the left overloaded?" Is YES, it ends as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Is the left cutting blade motor overloaded?" Is "NO,""Reply the left cutting blade motor" and return to "Start",
If "Is there a rotation instruction for the right cutting blade?" Is "YES", it is determined whether or not the "right cutting blade motor is overloaded",
If "Is the right cutting blade motor overloaded?" Is "YES", "End" is executed as "all stop of the traveling motor, cutting blade motor and lifting motor",
If "Does the right-side cutting blade motor overload?" Is "NO,""rotate the right-side cutting blade motor" and determine "is there a rotation instruction for the left-side cutting blade",
If “Is there a rotation instruction for the left cutting blade?” Is NO, then return to “Start” and repeat the process,
If "Is there a rotation instruction for the left cutting blade?" Is YES, it is determined whether "waiting time has elapsed",
If "wait time elapsed" is NO, it is judged again whether "wait time elapsed",
If "Is the waiting time elapsed" is YES, it is judged whether "the left cutting blade motor is overloaded" or not, and if "the left cutting blade motor is overloaded" is YES, the "traveling motor, End as "all stop of cutting blade motor and lifting motor"
If “Is the left cutting blade motor overloaded?” Is “NO,” “Rotate the left cutting blade motor”, then return to “Start” and repeat the process,
Control method of control of self-propelled work machine characterized by things.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018112624A JP6546682B1 (en) | 2018-06-13 | 2018-06-13 | Self-propelled work machine and control system and control method of self-propelled work machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018112624A JP6546682B1 (en) | 2018-06-13 | 2018-06-13 | Self-propelled work machine and control system and control method of self-propelled work machine |
Related Child Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019115188A Division JP7117008B2 (en) | 2019-06-21 | 2019-06-21 | SELF-PROPELLED WORK MACHINE AND CONTROL SYSTEM AND CONTROL METHOD OF SELF-PROPELLED WORK MACHINE |
JP2019115189A Division JP7141715B2 (en) | 2019-06-21 | 2019-06-21 | SELF-PROPELLED WORK MACHINE AND CONTROL SYSTEM AND CONTROL METHOD OF SELF-PROPELLED WORK MACHINE |
Publications (2)
Publication Number | Publication Date |
---|---|
JP6546682B1 true JP6546682B1 (en) | 2019-07-17 |
JP2019213493A JP2019213493A (en) | 2019-12-19 |
Family
ID=67297631
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018112624A Active JP6546682B1 (en) | 2018-06-13 | 2018-06-13 | Self-propelled work machine and control system and control method of self-propelled work machine |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6546682B1 (en) |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5376749U (en) * | 1976-11-30 | 1978-06-27 | ||
JPS6369650A (en) * | 1986-09-11 | 1988-03-29 | J P Ii Kk | Ink fountain arrangement of press |
US7318493B2 (en) * | 2003-08-05 | 2008-01-15 | Luis Marcial Medina | Hybrid remote control lawn mower |
JP6240384B2 (en) * | 2012-11-29 | 2017-11-29 | ヤンマー株式会社 | Autonomous traveling work system |
-
2018
- 2018-06-13 JP JP2018112624A patent/JP6546682B1/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2019213493A (en) | 2019-12-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2818590B2 (en) | Drive system for vertical mast worker lift | |
US10602659B2 (en) | Lawn mower with independent blade control during energy-saving control mode | |
JP6080458B2 (en) | Crawler type traveling vehicle | |
JP5580783B2 (en) | Work vehicle | |
EP1325883A1 (en) | Forklift with transverse travel system | |
JP7080481B2 (en) | Control system for self-propelled work machines and self-propelled work machines | |
JP6449081B2 (en) | Unmanned work vehicle | |
JP6546682B1 (en) | Self-propelled work machine and control system and control method of self-propelled work machine | |
US6854552B2 (en) | Fork lift with traverse motion system | |
JP2019213525A (en) | Self-propelled working machine, and control system and control method for self-propelled working machine | |
JP2019213524A (en) | Self-propelled working machine, and control system and control method for self-propelled working machine | |
JP5963633B2 (en) | Work vehicle | |
JP7323957B2 (en) | Self-propelled work machine and control system for self-propelled work machine | |
JP2016185132A (en) | Working vehicle | |
JP3654275B2 (en) | Boom lifting control device for control sprayer | |
JP7201203B2 (en) | Self-propelled work machine and control system for self-propelled work machine | |
CN211364760U (en) | Multifunctional orchard four-wheel transport vehicle | |
JP2020000191A (en) | Self-travelling work machine and control system of self-travelling work machine | |
JP6262327B1 (en) | Helicopter moving device | |
CN220830826U (en) | Standing mower and standing working machine | |
JPH11268900A (en) | Lift truck | |
JPH05162580A (en) | Self-traveling type light load carrying vehicle | |
JP2018027741A (en) | Helicopter moving device | |
JP2016185133A (en) | Unmanned working vehicle | |
GB2383984A (en) | Articulated lift truck |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A80 | Written request to apply exceptions to lack of novelty of invention |
Free format text: JAPANESE INTERMEDIATE CODE: A80 Effective date: 20180625 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190201 |
|
A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20190201 |
|
A975 | Report on accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A971005 Effective date: 20190220 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190416 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190528 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20190611 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190621 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6546682 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 |