JP2008035752A - Rolling controller of agricultural working machine - Google Patents

Rolling controller of agricultural working machine Download PDF

Info

Publication number
JP2008035752A
JP2008035752A JP2006212394A JP2006212394A JP2008035752A JP 2008035752 A JP2008035752 A JP 2008035752A JP 2006212394 A JP2006212394 A JP 2006212394A JP 2006212394 A JP2006212394 A JP 2006212394A JP 2008035752 A JP2008035752 A JP 2008035752A
Authority
JP
Japan
Prior art keywords
electric motor
rolling
tilt angle
detected
load
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2006212394A
Other languages
Japanese (ja)
Inventor
Koji Yoshikawa
浩司 吉川
Shigeki Hayashi
繁樹 林
Toru Tsukamoto
徹 塚本
Kenichi Iwami
憲一 石見
Hiroaki Kitai
浩昭 北井
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.)
Kubota Corp
Original Assignee
Kubota 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 Kubota Corp filed Critical Kubota Corp
Priority to JP2006212394A priority Critical patent/JP2008035752A/en
Priority to KR1020070027993A priority patent/KR100871738B1/en
Priority to CN2007100919675A priority patent/CN101044813B/en
Publication of JP2008035752A publication Critical patent/JP2008035752A/en
Priority to KR1020080060100A priority patent/KR101276976B1/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Lifting Devices For Agricultural Implements (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To carry out protection of an electric motor or a driver therefor from heat and protection thereof from an overload and to rapidly perform rolling control without a delay after reduction of the load in a rolling controller of an agricultural working machine composed so as to connect an implement to a traveling machine body for performing free driving and rolling with the electric motor, detect the tilt angle in the right and the left directions in the implement by a tilt detecting means, energize and operate the electric motor on the basis of the detected tilt angle and bring the right and left tilt angle of the implement close to the target tilt angle. <P>SOLUTION: The rolling controller of the agricultural working machine is composed so as to control a driving current of the electric motor 53 on the basis of a deviation of a detected tilt angle θ from the target tilt angle θ0 and is equipped with a load detecting means for detecting the driving load on the electric motor 53. A protecting means for controlling the driving current of the electric motor 53 is installed so as to maintain the detected driving load within the set range. <P>COPYRIGHT: (C)2008,JPO&INPIT

Description

本発明は、田植機や農用トラクタなどの農作業機に利用されるローリング制御装置に関する。   The present invention relates to a rolling control device used for farm work machines such as rice transplanters and agricultural tractors.

農作業機の一例である乗用型の田植機では、例えば特許文献1に示されているように、作業装置として苗植付け装置を走行機体の後部に駆動ローリング自在に連結し、苗植付け装置の傾斜角検出情報に基づいてローリング用の電動モータ14を通電制御して、苗植付け装置3の左右方向での傾斜角度を目標傾斜角度に安定維持するよう構成するとともに、電動モータによって強制ローリング駆動される中間フレーム11の左右ローリング限界位置をリミットスイッチ21R,21Lで検出するよう構成したものが知られている。
特開平9−9748号公報
In a riding-type rice transplanter that is an example of a farm work machine, for example, as shown in Patent Document 1, a seedling planting device is connected to a rear portion of a traveling machine body as a working device so as to be capable of driving rolling, and an inclination angle of the seedling planting device. Based on the detection information, the energization control of the electric motor 14 for rolling is performed to stably maintain the tilt angle in the left-right direction of the seedling planting device 3 at the target tilt angle, and an intermediate that is forcibly rolled by the electric motor. A configuration in which the left and right rolling limit positions of the frame 11 are detected by limit switches 21R and 21L is known.
Japanese Patent Laid-Open No. 9-9748

リミットスイッチなどで左右ローリング限界位置を検出する構造においては、ローリング限界位置に到達したことが検出されたり、電動モータに設定以上の電流が流れたことが検知されると、自動的に電動モータへの通電が遮断されて、電動モータやそのドライバーの熱保護や過負荷保護がなされるのが一般的である。この場合、電動モータへの通電が遮断されることでローリング方向での保持力がなくなり、ローリング駆動される作業装置(苗植付け装置)が重量バランスの崩れによって傾斜したり、負荷が軽減してローリング制御が復帰された場合の作動遅れが発生することがあった。   In a structure that detects the left and right rolling limit positions with a limit switch, etc., when it is detected that the rolling limit position has been reached, or when a current exceeding the set value has been detected in the electric motor, it is automatically sent to the electric motor. In general, the electric current is cut off, and the electric motor and its driver are protected against heat and overload. In this case, the energization of the electric motor is cut off, so that the holding force in the rolling direction is lost, and the rolling-driven work device (seed planting device) is tilted due to the loss of weight balance, and the load is reduced to reduce the rolling. There was a case that an operation delay occurs when the control is restored.

本発明は、このような点に着目してなされたものであって、電動モータやそのドライバーの熱保護や過負荷保護を図るとともに、負荷が軽減した後のローリング制御を遅れなく速やかに行えるようにすることを目的としている。   The present invention has been made paying attention to such points, and is intended to provide thermal protection and overload protection for the electric motor and its driver, and to perform rolling control immediately after the load is reduced without delay. The purpose is to be.

第1の発明は、走行機体に作業装置を電動モータにより駆動ローリング自在に連結し、傾斜検出手段によって作業装置における左右方向の傾斜角度を検出し、その検出傾斜角度に基づいて電動モータを通電作動させて、作業装置の左右傾斜角度を目標傾斜角度に近づけるよう構成した農作業機のローリング制御装置であって、
前記検出傾斜角度と目標傾斜角度との偏差に基づいて前記電動モータの駆動電流を制御するよう構成するとともに、電動モータの駆動負荷を検知する負荷検知手段を備え、検知された駆動負荷が設定範囲内に維持されるように電動モータを通電制御する保護手段を備えてあることを特徴とする。
According to a first aspect of the present invention, a work device is connected to a traveling machine body by an electric motor so as to be capable of being driven and rolled, and a tilt angle detecting means detects a tilt angle in the left-right direction of the work device and energizes the electric motor based on the detected tilt angle. A rolling control device for a farm machine configured to bring the right and left tilt angle of the work device closer to the target tilt angle,
The driving current of the electric motor is controlled based on the deviation between the detected inclination angle and the target inclination angle, and load detecting means for detecting the driving load of the electric motor is provided, and the detected driving load is within a set range. It is characterized by having a protection means for controlling energization of the electric motor so as to be maintained inside.

上記構成によると、作業装置のローリング作動抵抗が大きくなる、等して電動モータの駆動負荷が設定範囲の限界に到達したことが検出されると、その時点の電流量以上の電流が電動モータに流されることが抑制され、電動モータの駆動負荷が設定範囲から外れることがないように電動モータの駆動電流が抑制制御される。つまり、電動モータには駆動電が供給され続けられることになり、通電遮断された場合のように自由ローリング状態になることはなく、作業装置が検出傾斜角度に関係なく重量バランスの崩れなどによって勝手に傾斜してしまうことはない。   According to the above configuration, when it is detected that the driving load of the electric motor has reached the limit of the setting range, for example, the rolling operation resistance of the work device is increased, a current greater than the current amount is supplied to the electric motor. The driving current of the electric motor is suppressed and controlled so that the driving load of the electric motor is not deviated from the set range. In other words, the electric motor continues to be supplied with drive power, and does not enter the free rolling state as when the power supply is cut off. It will never tilt.

駆動負荷が軽減されて設定範囲内に戻ったことが検知されると、通常の制御状態に復帰し、検出傾斜角度に基づいて割り出された電流量で電動モータが通電制御され、作業装置の傾斜角度が速やかに目標傾斜角度に近づけられる。   When it is detected that the driving load has been reduced and returned to the set range, the normal control state is restored, and the electric motor is energized and controlled with the amount of current determined based on the detected inclination angle. The inclination angle is quickly brought close to the target inclination angle.

従って、第1の発明によると、電動モータやそのドライバーの熱保護や過負荷保護を図りながら、通電遮断によって作業装置が勝手に傾斜してしまうようなことがないために、次に負荷が軽減した後のローリング制御を遅れなく速やかに行うことが可能となる。   Therefore, according to the first aspect of the present invention, the work device is not tilted spontaneously by cutting off the power supply while protecting the electric motor and its driver against heat and overload. After that, the rolling control can be performed promptly without delay.

第2の発明は、上記第1の発明において、
前記電動モータの駆動電流をデューティ制御するよう構成するとともに、電動モータによって作動されるローリング駆動部材の作動位置を検出するセンサを備え、電動モータの駆動電流を制御する駆動出力デューティと前記ローリング駆動部材の位置変動に基づいて電動モータの駆動負荷を推定するよう前記負荷検知手段を構成してあるものである。
According to a second invention, in the first invention,
The drive current of the electric motor is configured to perform duty control, and includes a sensor that detects an operating position of a rolling drive member that is operated by the electric motor, and a drive output duty that controls the drive current of the electric motor and the rolling drive member The load detecting means is configured to estimate the driving load of the electric motor based on the position fluctuation.

上記構成によると、或る電流量に対してローリング駆動部材の位置変動速度が小さいほど駆動負荷が大きいものとなるので、電流量を決める駆動出力デューティとローリング駆動部材の位置変動の速度とを予め入力したマップデータ等に基づいて対比することで電動モータの駆動負荷を推定することができる。この場合、ローリング駆動部材の位置はポテンショメータなどの安価なセンサで簡単に検出できるので、トルクセンサなどの負荷検出センサを用いない安価な構成で電動モータの駆動負荷を取得して、過負荷を防止した好適な通電制御を行うことができる。   According to the above configuration, the smaller the position fluctuation speed of the rolling drive member with respect to a certain amount of current, the greater the driving load. The drive load of the electric motor can be estimated by comparison based on the input map data and the like. In this case, the position of the rolling drive member can be easily detected by an inexpensive sensor such as a potentiometer. Therefore, an overload can be prevented by acquiring the drive load of the electric motor with an inexpensive configuration that does not use a load detection sensor such as a torque sensor. The suitable energization control can be performed.

第3の発明は、上記第2の発明において、
前記ローリング駆動部材の作動範囲を設定し、ローリング駆動部材が前記作動範囲の限界に到達したことが前記センサで検出されると、作動範囲内に戻す方向のローリング作動指令が出されるまでローリング駆動部材を限界位置に維持するよう電動モータを通電制御するよう構成してあるものである。
According to a third invention, in the second invention,
The operation range of the rolling drive member is set, and when the sensor detects that the rolling drive member has reached the limit of the operation range, the rolling drive member is issued until a rolling operation command is issued to return the operation range to the operation range. Is configured to control the energization of the electric motor so as to be maintained at the limit position.

上記構成によると、駆動負荷を推定するデータとしてのローリング駆動部材の位置情報を利用してローリング駆動部材の作動範囲を制限することができ、ローリング駆動部材の作動範囲を決めるリミットスイッチなどが不要となり、センサ類の数を少なくして安価に実施することができる。   According to the above configuration, the operating range of the rolling drive member can be limited by using the position information of the rolling drive member as data for estimating the drive load, and a limit switch for determining the operating range of the rolling drive member becomes unnecessary. Therefore, the number of sensors can be reduced and implemented at low cost.

第4の発明は、上記第2または3の発明において、
前記駆動出力デューティの最大値を制限するよう構成してあるものである。
4th invention is the said 2nd or 3rd invention,
The maximum value of the drive output duty is limited.

上記構成によると、検出傾斜角度と目標傾斜角度との偏差が大きくなるに連れて、電動モータへの電流量を増すために駆動出力デューティが大きいものとなるが、駆動出力デューティの最大値が制限されることで電動モータへ過大な電流がながされることがなく、電動モータやそのドライバーの熱保護が図られる。   According to the above configuration, as the deviation between the detected tilt angle and the target tilt angle increases, the drive output duty increases to increase the amount of current to the electric motor, but the maximum value of the drive output duty is limited. As a result, an excessive current is not applied to the electric motor, and the electric motor and its driver can be protected from heat.

図1に、本発明に係る農作業機の一例として施肥装置付きの乗用型田植機の側面図が、図2にその平面図が示されている。この乗用型田植機は、前輪1および後輪2を備えて4輪駆動走行可能に構成された走行機体3の後部に、平行四連リンク構造のリンク機構4を介して8条植え仕様の苗植付け装置(作業装置)5が昇降自在に連結され、機体後部に施肥装置6が装備されるとともに機体前部の左右に予備苗のせ台7を備えた構造となっており、前記リンク機構4を油圧シリンダ8で上下に駆動揺動することで苗植付け装置5を昇降制御することができるようになっている。苗植付け装置5は、リンク機構4の後端部に前後方向支点X周りにローリング自在に連結されるとともに、リンク機構4の後端上部に備えたローリング駆動機構9によって苗植付け装置5が後述のようにローリング制御される。   FIG. 1 shows a side view of a riding type rice transplanter with a fertilizer device as an example of a farm working machine according to the present invention, and FIG. 2 shows a plan view thereof. This riding type rice transplanter has a front-wheel 1 and a rear-wheel 2 and a seedling of an eight-row planting specification via a link mechanism 4 having a parallel quadruple link structure at the rear of a traveling machine body 3 configured to be capable of four-wheel drive traveling. A planting device (working device) 5 is connected to be movable up and down, a fertilizer device 6 is provided at the rear of the machine body, and a structure is provided with reserve seedling platforms 7 on the left and right of the front part of the machine body. The seedling planting device 5 can be controlled to move up and down by driving and swinging up and down by the hydraulic cylinder 8. The seedling planting device 5 is connected to the rear end portion of the link mechanism 4 so as to be capable of rolling around the fulcrum X in the front-rear direction, and the seedling planting device 5 is described later by a rolling drive mechanism 9 provided at the upper rear end of the link mechanism 4. So that it is rolling controlled.

前記走行機体3の前部にはエンジン10が搭載され、その出力が前後進の無段変速が可能な油圧式無段変速装置(HST)11に伝達され、その変速出力がミッションケース12に入力され、図示されない副変速装置でギヤ変速された後、ミッションケース12に支持された左右の前輪1に伝達されるとともに、ミッションケース12から後方に取出された走行系動力が伝動軸13を介して後部伝動ケース14に伝達され、後部伝動ケース14に支持された左右の後輪2に伝達されるようになっている。油圧式無段変速装置11からミッションケース12に伝達された変速出力の内の正転動力が作業用動力として分岐され、ミッションケース12に内装された図示されない株間変速装置でギヤ変速された後、ミッションケース12の後方から取り出され、伝動軸15および伸縮伝動軸16を介して苗植付け装置5に伝達されるようになっている。   An engine 10 is mounted on the front of the traveling body 3, and its output is transmitted to a hydraulic continuously variable transmission (HST) 11 capable of forward / reverse continuously variable transmission, and the transmission output is input to the mission case 12. Then, after being gear-shifted by a sub-transmission device (not shown), it is transmitted to the left and right front wheels 1 supported by the mission case 12, and the traveling system power taken rearward from the mission case 12 is transmitted via the transmission shaft 13. It is transmitted to the rear transmission case 14 and is transmitted to the left and right rear wheels 2 supported by the rear transmission case 14. After the forward rotation power of the shift output transmitted from the hydraulic continuously variable transmission 11 to the transmission case 12 is branched as working power, and gear-shifted by a stock transmission (not shown) incorporated in the transmission case 12, It is taken out from the rear of the mission case 12 and transmitted to the seedling planting device 5 via the transmission shaft 15 and the telescopic transmission shaft 16.

図2,図3に示すように、前記苗植付け装置5は、横長角筒状の植付けフレーム21、走行機体3から取り出された作業用動力を受けるフィードケース22、一定ストロークで左右に往復横移動する苗のせ台23、8組の回転式の植付け機構24、および、後部左右に2条分づつの前記植付け機構24を備えた4個の植付けケース25、田面Tの植付け箇所を均平整地する5個の整地フロート26、等を備えている。   As shown in FIGS. 2 and 3, the seedling planting device 5 includes a horizontally long rectangular tubular planting frame 21, a feed case 22 that receives working power taken out from the traveling machine body 3, and a reciprocating lateral movement left and right with a constant stroke. The seedling platform 23, eight sets of rotary planting mechanisms 24, four planting cases 25 provided with two planting mechanisms 24 on the left and right of the rear, and the planting location of the rice field T are leveled. Five leveling floats 26 are provided.

並列配備された5個の整地フロート26のうちの中央のものは、苗植付け装置5の田面Tに対する高さを検知する接地センサSFとして利用されている。図5に示すように、前記接地センサSFの後部部支点q周りの上下揺動変位がポテンショメータ27によって電気的に検知され、その検知情報が制御装置28に入力されて演算処理され、接地センサSFの上下揺動姿勢が設定姿勢となるように前記油圧シリンダ8の作動を司る電磁式の制御弁29を作動させることで、苗植付け装置5の田面Tに対する高さを一定に維持して、植付け深さを安定維持する自動植付け深さ制御が実行されるようになている。   The central one of the five leveling floats 26 arranged in parallel is used as a ground contact sensor SF that detects the height of the seedling planting device 5 with respect to the field surface T. As shown in FIG. 5, the vertical swinging displacement around the rear portion fulcrum q of the ground sensor SF is electrically detected by the potentiometer 27, and the detected information is input to the control device 28 for arithmetic processing, and the ground sensor SF. By operating the electromagnetic control valve 29 that controls the operation of the hydraulic cylinder 8 so that the vertical swinging position of the seedling becomes the set posture, the height of the seedling planting device 5 with respect to the field surface T is maintained constant, and planting Automatic planting depth control is performed to maintain the depth stably.

図4に示すように、ローリング駆動機構9は、リンク機構4の後端上部に連結したブラケット50に前後向き支点a周りに左右揺動可能に支持されたローリング駆動部材51と、これをギヤ減速機構52を介して揺動駆動する電動モータ53とから構成されている。図3に示すように、前記植付けフレーム21の左右から立設された支柱54の上端に亘って支持枠55が横架され、この支持枠55の左右箇所に装着されたガイド部材56が、苗のせ台23の背部に補強枠を兼ねて横架連結された案内レール57に係合されて、苗のせ台23の上部が左右移動可能に係合案内されている。前記ローリング駆動部材51の上方遊端部と前記支持枠55の左右箇所とが融通バネ58を介して連結されている。   As shown in FIG. 4, the rolling drive mechanism 9 includes a rolling drive member 51 supported on a bracket 50 connected to the upper rear end of the link mechanism 4 so as to be able to swing left and right around a fulcrum fulcrum a and a gear reduction mechanism. An electric motor 53 that swings through a mechanism 52 is configured. As shown in FIG. 3, a support frame 55 is laid across the upper ends of columns 54 erected from the left and right of the planting frame 21, and guide members 56 mounted on the left and right portions of the support frame 55 are used as seedlings. The upper part of the seedling base 23 is engaged and guided so as to be movable in the left-right direction by being engaged with a guide rail 57 horizontally connected to the back portion of the mounting base 23 as a reinforcing frame. The upper free end portion of the rolling drive member 51 and the left and right portions of the support frame 55 are connected via an accommodation spring 58.

この構成によると、苗植付け装置5はローリング駆動部材51に対して融通バネ58を介して所定小範囲で自由ローリング可能に弾性支持されることになり、苗植付け装置5が整地フロート26を介して田面Tに接地している状態では、走行機体3が多少左右傾斜しても弾性融通の範囲内で苗植付け装置5は田面Tに接地追従するようになっている。   According to this configuration, the seedling planting device 5 is elastically supported by the rolling drive member 51 via the interchange spring 58 so that it can freely roll in a predetermined small range, and the seedling planting device 5 is supported via the leveling float 26. In a state where the ground plane T is in contact with the ground surface T, the seedling planting device 5 follows the ground surface T within the range of elastic accommodation even if the traveling machine body 3 is slightly inclined to the left and right.

ローリング駆動機構9の電動モータ53は、苗植付け装置5に装備された後述する傾斜角検出手段からの検出情報に基づいて作動制御され、走行機体3が耕盤の凹凸等によって左右に傾斜して苗植付け装置5が傾斜しかかっても、その傾斜を復元させる方向に苗植付け装置5がローリング制御されて、常に設定されたローリング姿勢(一般に水平)に安定維持され、もって、各植付け機構24による植付け深さに差異の少ない植付けが行われるようになっている。前記ローリング駆動部材51の揺動位置がポテンショメータ60で検出され、ローリング駆動部材51が設定された揺動位置に至ると、その揺動位置に維持されるように電動モータ53が通電制御されて、ローリング駆動部材51の揺動範囲が制限されるようになっている。   The electric motor 53 of the rolling drive mechanism 9 is controlled to operate based on detection information from an inclination angle detection means (described later) installed in the seedling planting device 5, and the traveling machine body 3 is inclined to the left and right by unevenness of the tillage board. Even if the seedling planting device 5 is about to tilt, the seedling planting device 5 is controlled to roll in a direction to restore the tilting, and is always stably maintained in the set rolling posture (generally horizontal). Planting with little difference in depth has been carried out. When the swinging position of the rolling drive member 51 is detected by the potentiometer 60 and the rolling drive member 51 reaches the set swinging position, the electric motor 53 is energized and controlled so that the swinging position is maintained. The swing range of the rolling drive member 51 is limited.

リンク機構4の後端上部に連結した前記ブラケット50と苗のせ台23の背面における前記案内レール57の左右箇所とに亘って復帰用バネ59が張設されており、苗のせ台23の横移動によって移動方向側の復帰用バネ59が伸ばされることで、苗のせ台横移動に伴うローリング用の支点X周りの重量バランスの崩れを是正する方向の回動力が、伸長された復帰用バネ59によってもたらされるようになっている。   A return spring 59 is stretched across the bracket 50 connected to the upper rear end of the link mechanism 4 and the left and right portions of the guide rail 57 on the rear surface of the seedling platform 23, and the lateral movement of the seedling platform 23. As a result, the return spring 59 on the moving direction side is extended, so that the rotational force in the direction to correct the collapse of the weight balance around the fulcrum X for rolling accompanying the lateral movement of the seedling bed is caused by the extended return spring 59. Has come to be brought.

苗植付け装置5の左右方向の傾斜角度を検知する手段としては、重力式の角度センサ61と、左右方向の角速度を検知する振動ジャイロ型の角速度センサ62とが利用されて、ローリング用の支点X近くにおいて植付けフレーム21に取付けられている。図6の制御ブロック図に示すように、両センサ61,62からの検出信号は前記制御装置28に入力され、苗植付け装置5をローリング制御するための検出傾斜角度θが以下のようにして算出され、ローリング制御が実行される。   As means for detecting the lateral inclination angle of the seedling planting device 5, a gravity type angle sensor 61 and a vibrating gyroscopic angular velocity sensor 62 for detecting the angular velocity in the lateral direction are used, and a fulcrum X for rolling is used. It is attached to the planting frame 21 in the vicinity. As shown in the control block diagram of FIG. 6, the detection signals from both sensors 61 and 62 are input to the control device 28, and the detected inclination angle θ for rolling control of the seedling planting device 5 is calculated as follows. And rolling control is executed.

前記角度センサ61の検出値θgは、ローパスフィルタ63に通されてその低周波成分だけが取得され、また、角速度センサ62の検出値eは、ローカットフィルタ64を通されたのち積分処理されて傾斜角が算出され、この演算値が更にローカットフィルタ65に通されてその高周波成分だけが取得され、次に角度センサ61の検出値θgに基づいて取得された低周波成分の傾斜角度θ1と、角速度センサ62からの検出値eに基づいて取得された高周波成分の傾斜角度θ2とが加算されて、この値が検出傾斜角度θとされる。   The detected value θg of the angle sensor 61 is passed through the low-pass filter 63 to obtain only its low frequency component, and the detected value e of the angular velocity sensor 62 is subjected to integration processing after passing through the low-cut filter 64 and is then tilted. The angle is calculated, and the calculated value is further passed through the low-cut filter 65 to acquire only the high-frequency component. Next, the inclination angle θ1 of the low-frequency component acquired based on the detected value θg of the angle sensor 61, and the angular velocity The inclination angle θ2 of the high-frequency component acquired based on the detection value e from the sensor 62 is added, and this value is set as the detection inclination angle θ.

なお、角度センサ61からの検出値θgは重力式センサ自体の平滑特性によって検出信号の高周波成分の一部が外乱とともに除去されているので、この除去された高周波成分を補うために角度センサ61の特性に対応した特性のローカットフィルタ64が導入されている。また、ローパスフィルタ63で除去された高周波成分を補うようにローカットフィルタ65の特性が設定される。   Note that the detected value θg from the angle sensor 61 has a part of the high-frequency component of the detection signal removed together with the disturbance due to the smoothness characteristic of the gravity sensor itself. Therefore, in order to compensate for this removed high-frequency component, A low cut filter 64 having characteristics corresponding to the characteristics is introduced. Further, the characteristics of the low cut filter 65 are set so as to compensate for the high frequency components removed by the low pass filter 63.

つまり、苗植付け装置5が急速に傾斜すると、角度センサ61からの検出値θgには振動等による外乱が含まれるとともに、慣性の影響で逆方向の信号が出力されることがあるので、これらを含む高周波成分を除去した値が基本的な傾斜角度θ1として取得される。そして、傾斜角変動の除去された高周波成分を補うために、角速度センサ62の検出値eに基づいて演算取得された高周波成分の傾斜角度θ2が加算され、全体として優れた応答性および高い精度で検出傾斜角度θが算出されるのである。   That is, when the seedling planting device 5 is rapidly tilted, the detected value θg from the angle sensor 61 includes disturbance due to vibration and the like, and a signal in the reverse direction may be output due to the influence of inertia. A value obtained by removing the high frequency component included is acquired as the basic inclination angle θ1. Then, in order to compensate for the high-frequency component from which the inclination angle fluctuation has been removed, the inclination angle θ2 of the high-frequency component calculated and acquired based on the detection value e of the angular velocity sensor 62 is added, and the overall response is excellent and the accuracy is high. The detected inclination angle θ is calculated.

上記のようにして算出された検出傾斜角度θは、傾斜角度設定器66によって設定された目標傾斜角度θ0と比較演算され、両者の偏差|θ0-θ|が予め入力設定されている不感帯εより大きいと、その偏差が不感帯内に収まる方向に電動モータ53が通電制御されることで、苗植付け装置5が目標傾斜角度θ0に安定維持されるのである。   The detected tilt angle θ calculated as described above is compared with the target tilt angle θ0 set by the tilt angle setting unit 66, and the deviation | θ0−θ | between the two is calculated based on the dead zone ε set in advance. If it is larger, the electric motor 53 is energized and controlled so that the deviation falls within the dead zone, so that the seedling planting device 5 is stably maintained at the target inclination angle θ0.

なお、田植機においては、ほとんどの田面Tが水平であるので、前記目標傾斜角度θ0を水平に設定することで、苗植付け装置5を田面Tと平行な水平姿勢に維持して全条での植付け深さを均一にすることができるが、畦際において田面Tが左右に傾斜しているような水田における畦際での植付け作業においては、傾斜角度設定器66を調節して目標傾斜角度θ0を田面Tの傾斜に合わせて調整することで、傾斜した田面Tと平行な植付けを行って植付け深さを均一化を図ることができるものとなる。   Since most of the rice field T is horizontal in the rice transplanter, the seedling planting device 5 is maintained in a horizontal posture parallel to the rice field T by setting the target inclination angle θ0 to be horizontal. Although the planting depth can be made uniform, in the planting operation at the paddy field where the field surface T is tilted to the left and right at the paddy field, the target tilt angle θ0 is adjusted by adjusting the tilt angle setting unit 66. Is adjusted in accordance with the inclination of the field surface T, so that the planting depth can be made uniform by performing planting parallel to the inclined field surface T.

前記電動モータ53のドライバー70は、制御装置28からの指令に基づいて電動モータ53の駆動電流をデューティ制御するよう構成されている。図7のフロー図に示すように、上記のようにして演算された検出傾斜角度θと目標傾斜角度θ0との偏差|θ0-θ|の大きさに応じて駆動出力デューティDが演算され(♯01,♯02)、駆動出力デューティDが大きいほど電動モータ53に流す電流量が大きくなる。ただし、駆動出力デューティDの最大値が予め制限設定されており、電動モータ53やドライバー70に過大な電流が流れないようになっている。   The driver 70 of the electric motor 53 is configured to duty-control the drive current of the electric motor 53 based on a command from the control device 28. As shown in the flowchart of FIG. 7, the drive output duty D is calculated according to the magnitude of the deviation | θ0−θ | between the detected inclination angle θ and the target inclination angle θ0 calculated as described above (# 01, # 02), the greater the drive output duty D, the greater the amount of current flowing through the electric motor 53. However, the maximum value of the drive output duty D is set in advance so that an excessive current does not flow through the electric motor 53 and the driver 70.

演算された駆動出力デューティDに対する前記ポテンシュメータ60からの検出値の変動速度から電動モータ53の駆動負荷(負荷トルク)が推定される(♯03)。つまり、或る電流量での駆動においてローリング駆動部材51の移動速度が小さいほど駆動負荷が大きいものであり、ポテンショメータ60からの検出値の変動速度と駆動出力デューティDとをマップデータに基づいて対比することで電動モータ53の駆動負荷を推定するのである。   The drive load (load torque) of the electric motor 53 is estimated from the fluctuation speed of the detected value from the potentiometer 60 with respect to the calculated drive output duty D (# 03). That is, the driving load increases as the moving speed of the rolling driving member 51 decreases in driving with a certain amount of current, and the fluctuation speed of the detected value from the potentiometer 60 and the driving output duty D are compared based on the map data. Thus, the driving load of the electric motor 53 is estimated.

推定された駆動負荷が予め設定された許容範囲にあるか否かが判別され(♯04)、許容範囲の限界に到達すると、目標傾斜角度θ0と検出傾斜角度θとの偏差|θ0-θ|の大きさに応じて演算された前記駆動出力デューティDに優先して、駆動負荷の限界値を維持する駆動出力デューティD’で電動モータ53が通電制御される(♯05,♯06)。推定された駆動負荷が許容範囲の限界より所定量(ヒステリシス量)を下回ったことが認識されると(♯07)、目標傾斜角度θ0と検出傾斜角度θとの偏差|θ0-θ|の大きさに応じて演算された駆動出力デューティDで電動モータ53が通電される通常の制御状態に復帰する。   It is determined whether or not the estimated driving load is within a preset allowable range (# 04). When the limit of the allowable range is reached, the deviation | θ0−θ | between the target inclination angle θ0 and the detected inclination angle θ The electric motor 53 is energized and controlled with the drive output duty D ′ that maintains the limit value of the drive load in preference to the drive output duty D calculated in accordance with the magnitude of (# 05, # 06). When it is recognized that the estimated driving load has fallen below a predetermined amount (hysteresis amount) from the limit of the allowable range (# 07), the deviation | θ0−θ | of the target inclination angle θ0 and the detected inclination angle θ is large. Returning to the normal control state in which the electric motor 53 is energized with the drive output duty D calculated accordingly.

図8のフロー図に示すように、ローリング駆動部材51が予め設定されている作動範囲における左方あるいは右方の限界に到達すると、これがポテンショメータ60からの情報に基づいて検知され、作動範囲内に戻す方向のローリング作動指令が出されるまでローリング駆動部材51を限界位置に維持するよう電動モータ53が通電制御される。   As shown in the flowchart of FIG. 8, when the rolling drive member 51 reaches the left or right limit in the preset operating range, this is detected based on information from the potentiometer 60 and is within the operating range. The electric motor 53 is energized to maintain the rolling drive member 51 at the limit position until a rolling operation command in the returning direction is issued.

図9のフロー図に示すように、上限まで上昇されている苗植付け装置5を田面Tまで下降させる場合、運転作業者によって下降指令が出されて下降が開始されてもローリング制御が直ちに実行されることはなく、接地センサSFが田面Tに接触したことがポテンショメータ27の出力変化によって検知されるまでは、ローリング駆動部材51が下降開始時の位置に維持され、苗植付け装置5が下降開始時の姿勢に維持されながら下降される。接地センサSFが田面Tに接触してポテンショメータ27に出力変化が発生すると、苗植付け装置5が接地したとが判断され、これ以降は通常のローリング制御が行われる。   As shown in the flowchart of FIG. 9, when the seedling planting device 5 that has been raised to the upper limit is lowered to the surface T, the rolling control is immediately executed even if the descent command is issued by the operator and the descent is started. The rolling drive member 51 is maintained at the lowering start position until the contact of the ground sensor SF with the surface T is detected by the output change of the potentiometer 27, and the seedling planting device 5 is at the lowering start time. It is lowered while maintaining the posture. When the ground sensor SF comes into contact with the rice field T and an output change occurs in the potentiometer 27, it is determined that the seedling planting device 5 is grounded, and thereafter normal rolling control is performed.

畦際での機体方向転換などにおいて、運転作業者によってだされた上昇指令に基づいて苗植付け装置5が強制上昇される際、リンク機構4が上限まで上昇して上限リミットスイッチ30がオン操作されるまではローリング制御が実行され、苗のせ台23に載置された苗の消費具合などによって苗植付け装置5の左右重量バランスが崩れていても、苗植付け装置5は水平姿勢に維持されながら上昇されることになる。上限に到達したことが上限リミットスイッチ30によって検知されると、制御弁29が自動的に中立復帰制御されて苗植付け装置5の上昇が停止されるとともに、ローリング制御も停止される。なお、上限に到達した苗植付け装置5は、リンク機構4との接当によって機械的に走行機体3に対して平行な姿勢に固定され、走行中に勝手にローリングすることが阻止される。   When the seedling planting device 5 is forcibly raised based on the ascent command issued by the operator, such as when turning the aircraft at the shore, the link mechanism 4 rises to the upper limit and the upper limit switch 30 is turned on. Rolling control is executed until the seedling planting device 5 is maintained in a horizontal posture even if the right and left weight balance of the seedling planting device 5 is lost due to the consumption of seedlings placed on the seedling table 23, etc. Will be. When it is detected by the upper limit switch 30 that the upper limit has been reached, the control valve 29 is automatically neutrally controlled to stop the raising of the seedling planting device 5 and the rolling control is also stopped. In addition, the seedling planting device 5 that has reached the upper limit is mechanically fixed in a posture parallel to the traveling machine body 3 by contact with the link mechanism 4, and is prevented from rolling freely during traveling.

〔他の実施例〕
(1)電動モータ53の駆動負荷を検出する手段としては、電動モータ53の出力軸などにトルクセンサを装備して、直接に駆動負荷トルクを検出することもできる。
(3)本発明は、乗用型の田植機の他に、走行機体に水田直播装置や水田除草装置などの作業装置を昇降およびローリング自在に連結した農作業機や、ロータリ耕耘装置を昇降およびローリング自在に連結した農用トラクタに適用することもできる。
[Other Examples]
(1) As a means for detecting the driving load of the electric motor 53, a torque sensor can be provided on the output shaft of the electric motor 53 and the driving load torque can be directly detected.
(3) In addition to the riding-type rice transplanter, the present invention is a farming machine in which working devices such as a paddy direct sowing device and a paddy weeding device are connected to a traveling machine body so as to be able to move up and down freely and a rotary tiller device can be raised and lowered freely. It can also be applied to agricultural tractors connected to the

田植機の全体側面図Whole side view of rice transplanter 田植機の全体平面図Overall plan view of rice transplanter 苗植付け装置を機体前方から見た背面図Rear view of the seedling planting device as seen from the front ローリング駆動機構の縦断側面図Vertical side view of rolling drive mechanism 制御系全体の概略を示すブロック図Block diagram showing the outline of the entire control system ローリング制御系のブロック図Block diagram of rolling control system ローリング制御系のフロー図Rolling control system flow diagram ローリング限界制御のフロー図Flow chart of rolling limit control 昇降とローリング制御との関連作動を示すフロー図Flow chart showing operations related to lifting and rolling control

符号の説明Explanation of symbols

1 走行機体
3 作業装置(苗植付け装置)
51 ローリング駆動部材
53 電動モータ
θ0 目標傾斜角度
D 駆動出力デューティ
θ 検出傾斜角度
1 traveling machine 3 working device (seedling planting device)
51 Rolling drive member 53 Electric motor θ0 Target tilt angle D Drive output duty θ Detection tilt angle

Claims (4)

走行機体に作業装置を電動モータにより駆動ローリング自在に連結し、傾斜検出手段によって作業装置における左右方向の傾斜角度を検出し、その検出傾斜角度に基づいて前記電動モータを通電作動させて、作業装置の左右傾斜角度を目標傾斜角度に近づけるよう構成した農作業機のローリング制御装置であって、
前記検出傾斜角度と目標傾斜角度との偏差に基づいて前記電動モータの駆動電流を制御するよう構成するとともに、電動モータの駆動負荷を検知する負荷検知手段を備え、検知された駆動負荷が設定範囲内に維持されるように電動モータを通電制御する保護手段を備えてあることを特徴とする農作業機のローリング制御装置。
A work device is connected to the traveling machine body by an electric motor so as to be capable of being driven and rolled, a tilt angle detecting means detects a tilt angle in the left-right direction of the work device, and energizes the electric motor on the basis of the detected tilt angle. A rolling control device for a farm machine configured to bring the right and left tilt angle closer to the target tilt angle,
The driving current of the electric motor is controlled based on the deviation between the detected inclination angle and the target inclination angle, and load detecting means for detecting the driving load of the electric motor is provided, and the detected driving load is within a set range. A rolling control device for a farm working machine, comprising a protection means for controlling energization of an electric motor so as to be maintained inside.
前記電動モータの駆動電流をデューティ制御するよう構成するとともに、電動モータによって作動されるローリング駆動部材の作動位置を検出するセンサを備え、電動モータの駆動電流を制御する駆動出力デューティと前記ローリング駆動部材の位置変動に基づいて電動モータの駆動負荷を推定するよう前記負荷検知手段を構成してある請求項1記載の農作業機のローリング制御装置。   The drive current of the electric motor is configured to perform duty control, and includes a sensor that detects an operating position of a rolling drive member that is operated by the electric motor, and a drive output duty that controls the drive current of the electric motor and the rolling drive member The rolling control device for an agricultural working machine according to claim 1, wherein the load detecting means is configured to estimate a driving load of the electric motor based on a positional fluctuation of the agricultural machine. 前記ローリング駆動部材の作動範囲を設定し、ローリング駆動部材が前記作動範囲の限界に到達したことが前記センサで検出されると、作動範囲内に戻す方向のローリング作動指令が出されるまでローリング駆動部材を限界位置に維持するよう電動モータを通電制御するよう構成してある請求項2記載の農作業機のローリング制御装置。   The operation range of the rolling drive member is set, and when the sensor detects that the rolling drive member has reached the limit of the operation range, the rolling drive member is issued until a rolling operation command is issued to return the operation range to the operation range. The rolling control device for an agricultural working machine according to claim 2, wherein the electric motor is energized and controlled so as to maintain the position at a limit position. 前記駆動出力デューティの最大値を制限するよう構成してある請求項2または3に記載の農作業機のローリング制御装置。   The rolling control device for an agricultural machine according to claim 2 or 3, wherein a maximum value of the drive output duty is limited.
JP2006212394A 2006-03-31 2006-08-03 Rolling controller of agricultural working machine Pending JP2008035752A (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2006212394A JP2008035752A (en) 2006-08-03 2006-08-03 Rolling controller of agricultural working machine
KR1020070027993A KR100871738B1 (en) 2006-03-31 2007-03-22 Rolling control system of work vehicle
CN2007100919675A CN101044813B (en) 2006-03-31 2007-03-30 Swing controlling device for working machine
KR1020080060100A KR101276976B1 (en) 2006-03-31 2008-06-25 Agricultural work vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006212394A JP2008035752A (en) 2006-08-03 2006-08-03 Rolling controller of agricultural working machine

Publications (1)

Publication Number Publication Date
JP2008035752A true JP2008035752A (en) 2008-02-21

Family

ID=39171516

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006212394A Pending JP2008035752A (en) 2006-03-31 2006-08-03 Rolling controller of agricultural working machine

Country Status (1)

Country Link
JP (1) JP2008035752A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013017436A (en) * 2011-07-12 2013-01-31 Yanmar Co Ltd Mobile electric work machine

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013017436A (en) * 2011-07-12 2013-01-31 Yanmar Co Ltd Mobile electric work machine

Similar Documents

Publication Publication Date Title
JP2016042857A (en) Work vehicle
JP4718256B2 (en) Rolling control device for paddy field machine
JP4624969B2 (en) Agricultural machine rolling control device
JP3960405B2 (en) Rice transplanter
JP2008035752A (en) Rolling controller of agricultural working machine
JP2005341809A (en) Agricultural working machine
JP2004187584A (en) Implement
JP2001245511A (en) Farm work machine
JP4041255B2 (en) Rice transplanter
JP2606992Y2 (en) Agricultural work vehicle attitude control device
JP3372465B2 (en) Lifting and lowering control device for farm equipment
JP3838320B2 (en) Horizontal control device
JP4718393B2 (en) Agricultural machine rolling control device
JP3659034B2 (en) Seedling transplanter
JP4183693B2 (en) Inclination control device for work equipment
JP3690187B2 (en) Horizontal control device
JP2006262800A (en) Slope regulating device for working machine
JP7142596B2 (en) transplanter
JP3838111B2 (en) Paddy field machine
JP4589175B2 (en) Rotary tillage device
JP4241738B2 (en) Agricultural machine
JP3720506B2 (en) Farm work vehicle
JP3721855B2 (en) Horizontal control device
JP2011147418A (en) Seedling transplanter
JP2001231318A (en) Seedling transplanter