JPH0889011A - 移動農機の傾斜検出装置 - Google Patents

移動農機の傾斜検出装置

Info

Publication number
JPH0889011A
JPH0889011A JP25873194A JP25873194A JPH0889011A JP H0889011 A JPH0889011 A JP H0889011A JP 25873194 A JP25873194 A JP 25873194A JP 25873194 A JP25873194 A JP 25873194A JP H0889011 A JPH0889011 A JP H0889011A
Authority
JP
Japan
Prior art keywords
angle
gyro
detection
tilt
gravity
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP25873194A
Other languages
English (en)
Other versions
JP3568597B2 (ja
Inventor
Hiroaki Yamazaki
弘章 山崎
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.)
Mitsubishi Agricultural Machinery Co Ltd
Original Assignee
Mitsubishi Agricultural Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Agricultural Machinery Co Ltd filed Critical Mitsubishi Agricultural Machinery Co Ltd
Priority to JP25873194A priority Critical patent/JP3568597B2/ja
Publication of JPH0889011A publication Critical patent/JPH0889011A/ja
Application granted granted Critical
Publication of JP3568597B2 publication Critical patent/JP3568597B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Transplanting Machines (AREA)
  • Harvester Elements (AREA)
  • Lifting Devices For Agricultural Implements (AREA)
  • Gyroscopes (AREA)

Abstract

(57)【要約】 【目的】 傾斜角検出の応答性および検出精度を向上さ
せる。 【構成】 重力式傾斜センサ7およびジャイロ8を併設
し、ジャイロ8の検出角が安定状態である場合には、重
力式傾斜センサ7の検出角を最終的な検出角とする一
方、ジャイロ8の検出角が変動状態である場合には、ジ
ャイロ安定時に格納した重力式傾斜センサ7の検出角
(基準値)にジャイロ8の検出角を加算して最終的な検
出角とする。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、トラクタ、移植機、管
理機、収穫機等の移動農機の傾斜検出装置に関するもの
である。
【0002】
【従来技術及び発明が解決しようとする課題】一般に、
この種移動農機のなかには、走行機体もしくは作業部の
傾斜角検出に基づいて傾斜姿勢制御を行うものがある
が、従来、傾斜角検出用センサとしては振子センサ等の
重力式傾斜センサが用いられていた。しかるに、重力式
傾斜センサにおいては、振子等の検出体に慣性力が作用
するため、急激な傾斜変動に追随することができず、応
答性に劣るのが実状であった。そこで、高速応答性を具
備するジャイロを用いて傾斜角検出を行うことが提案さ
れるが、ジャイロにおいては、アンプ等を構成する電子
部品の温度変化等に伴って特性変化が生じる許りか、ジ
ャイロ出力から検出角を演算する際にも誤差が生じるた
め、長時間に亘って傾斜角検出を継続した場合には、誤
差が累積されて検出精度が低下するという不都合があ
る。
【0003】
【課題を解決するための手段】本発明は、上記の如き実
情に鑑みこれらの欠点を一掃することができる移動農機
の傾斜検出装置を提供することを目的として創案された
ものであって、走行機体もしくは作業部の傾斜角検出に
基づいて傾斜姿勢制御を行う移動農機であって、該移動
農機に、走行機体もしくは作業部の絶対傾斜角を検出す
る重力式傾斜センサと、走行機体もしくは作業部の相対
傾斜角を検出するジャイロと、ジャイロの検出角が安定
状態である場合に、重力式傾斜センサの検出角を最終的
な検出角とし、かつ重力式傾斜センサの検出角を基準値
として格納する安定時検出手段と、ジャイロの検出角が
変動状態である場合に、前記基準値にジャイロの検出角
を加算して最終的な検出角とする変動時検出手段とを設
けたことを特徴とするものである。そして本発明は、こ
の構成によって、傾斜角検出の応答性および検出精度を
向上させることができるようにしたものである。
【0004】
【実施例】次に、本発明の一実施例を図面に基づいて説
明する。図面において、1はトラクタの走行機体であっ
て、該走行機体1の後部には、昇降リンク機構2を介し
てロータリ等の作業部3が昇降自在に連結されている。
そして作業部3は、リフトシリンダ4の伸縮に伴うリフ
トアーム5の上下揺動に連動して昇降する一方、リフト
ロッドシリンダ6の伸縮に基づいて左右傾斜するが、こ
れらの基本構成は何れも従来通りである。
【0005】7は前記走行機体1に設けられる重力式傾
斜センサであって、該重力式傾斜センサ7は、機体左右
方向(ローリング方向)の絶対傾斜角を検出すべく取付
けられているが、さらに走行機体1には、重力式傾斜セ
ンサ7と同一方向の相対傾斜角を検出するジャイロ8
(角速度出力タイプ)が併設されている。
【0006】さらに、前記走行機体1には、マイクロコ
ンピュータ等を用いて構成される制御部9が設けられる
が、該制御部9は、前述した重力式傾斜センサ7および
ジャイロ8に加え、傾斜自動制御をON−OFFするた
めの傾斜自動スイッチ10、傾斜自動制御の目標傾斜を
設定するための傾斜設定ボリューム11、リフトロッド
シリンダ6の作動長を検出するためのロッド長センサ1
2、走行状態を検出するための車軸回転センサ13(走
行クラッチの断続検出スイッチでも可)等から信号を入
力する一方、リフトロッドシリンダ6を作動させる電磁
バルブの伸長用ソレノイド14、縮小用ソレノイド15
等に対して作動指令を出力すべく構成されている。即
ち、制御部9は、前記重力式傾斜センサ7およびジャイ
ロ8の出力に基づいて走行機体1の左右傾斜角を検出す
る傾斜角検出制御、前記検出角と目標傾斜角との比較に
基づいて作業部3を自動的に傾斜制御する傾斜自動制御
等の各種制御を行うが、以下、本発明が要旨とする傾斜
角検出制御をフローチャートに基づいて詳述する。
【0007】さて、傾斜角検出制御においては、まず、
所定時間毎にサンプリングされる重力式傾斜センサ7の
検出データに基づいて傾斜角(絶対傾斜角)Sを演算し
た後、走行状態を判断するが、走行停止中である場合に
は、ジャイロ8の中立値(角速度が「0」のときのジャ
イロデータ)を格納すると共に、最終的な検出傾斜角
(傾斜自動制御の参照データ)を格納する「傾斜角」変
数に前記傾斜角Sを格納するようになっている。
【0008】一方、機体が走行中である場合には、ジャ
イロ8が出力した角速度が略「0」であるか否かを判断
し、該判断がYESの場合には、所定のタイマ時間(重
力式傾斜センサ7の応答時間に略対応)が経過したか否
かを判断する。つまり、角速度が略「0」である状態が
所定時間継続したか否かを判断するが、該判断がYES
の場合には、前記傾斜角Sを「基準値」変数および「傾
斜角」変数に格納するようになっている。
【0009】また、角速度が略「0」の状態でない場
合、もしくは略「0」の状態が所定時間未満である場合
には、ジャイロ8の検出データに基づいて傾斜角(相対
傾斜角)Gを演算する。即ち、ジャイロ8の検出データ
から前記中立値を減算すると共に、その差分データをサ
ンプリング時間毎に積算して前記傾斜角Gを得るが、傾
斜角Gを演算した後は、傾斜角Gに前記基準値を加算し
て「傾斜角」変数に格納するようになっている。
【0010】叙述の如く構成された本発明の実施例にお
いて、走行機体1の傾斜角を重力式傾斜センサ7および
ジャイロ8を用いて検出し、検出した傾斜角に基づいて
作業部3を自動的に傾斜制御することになるが、ジャイ
ロ8が検出した角速度が略「0」の状態では、重力式傾
斜センサ7の検出データに基づいて演算される傾斜角S
を適用するため、誤差の小さい絶対傾斜角が得られるこ
とになる。一方、前記角速度が略「0」でない状態で
は、ジャイロ8の検出データに基づいて傾斜角Gを演算
すると共に、演算した傾斜角Gに基準値を加算して傾斜
角を得るため、応答性に優れた傾斜角検出を行うことが
可能になり、しかも、前記基準値は、角速度が略「0」
になる毎に格納される絶対傾斜角(傾斜角S)であるた
め、特性変化による誤差や演算による誤差が累積される
不都合も解消することができる。従って、重力式傾斜セ
ンサ7およびジャイロ8の長所を有効利用することが可
能になり、その結果、傾斜角検出の応答性および検出精
度を同時に向上させることができる。
【0011】尚、本発明は、前記実施例に限定されない
ものであることは勿論であって、例えば前記実施例で
は、角速度出力タイプのジャイロを用い、角速度が略
「0」である状態を基準として検出角の演算方式を切換
えているが、角加速度出力タイプのジャイロを用い、角
加速度が略「0」である状態を基準として検出角の演算
方式を切換えることも可能である。
【0012】
【作用効果】以上要するに、本発明は叙述の如く構成さ
れたものであるから、走行機体もしくは作業部の傾斜角
検出に基づいて傾斜姿勢制御を行うものでありながら、
重力式傾斜センサおよびジャイロを備えており、そし
て、ジャイロの検出角が安定状態である場合には、重力
式傾斜センサの検出角を最終的な検出角とする一方、ジ
ャイロの検出角が変動状態である場合には、ジャイロ安
定時に格納した重力式傾斜センサの検出角(基準値)に
ジャイロの検出角を加算して最終的な検出角とするた
め、それぞれの長所を生かした傾斜角検出が可能にな
る。即ち、ジャイロ安定時には、誤差の少ない絶対傾斜
角を検出できる一方、ジャイロ変動時には、応答性に優
れた傾斜角検出を行うことができ、しかも、ジャイロの
基準値は、ジャイロの検出角が安定する毎に更新される
ため、特性変化による誤差や演算による誤差が累積され
る不都合も解消することができる。
【図面の簡単な説明】
【図1】トラクタの側面図である。
【図2】制御部の入出力を示すブロック図である。
【図3】傾斜角検出制御のフローチャートである。
【符号の説明】
1 走行機体 3 作業部 7 重力式傾斜センサ 8 ジャイロ 9 制御部

Claims (1)

    【特許請求の範囲】
  1. 【請求項1】 走行機体もしくは作業部の傾斜角検出に
    基づいて傾斜姿勢制御を行う移動農機であって、該移動
    農機に、走行機体もしくは作業部の絶対傾斜角を検出す
    る重力式傾斜センサと、走行機体もしくは作業部の相対
    傾斜角を検出するジャイロと、ジャイロの検出角が安定
    状態である場合に、重力式傾斜センサの検出角を最終的
    な検出角とし、かつ重力式傾斜センサの検出角を基準値
    として格納する安定時検出手段と、ジャイロの検出角が
    変動状態である場合に、前記基準値にジャイロの検出角
    を加算して最終的な検出角とする変動時検出手段とを設
    けたことを特徴とする移動農機の傾斜検出装置。
JP25873194A 1994-09-28 1994-09-28 移動農機の傾斜検出装置 Expired - Fee Related JP3568597B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP25873194A JP3568597B2 (ja) 1994-09-28 1994-09-28 移動農機の傾斜検出装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP25873194A JP3568597B2 (ja) 1994-09-28 1994-09-28 移動農機の傾斜検出装置

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2004102749A Division JP3763835B2 (ja) 2004-03-31 2004-03-31 移動農機の傾斜検出装置

Publications (2)

Publication Number Publication Date
JPH0889011A true JPH0889011A (ja) 1996-04-09
JP3568597B2 JP3568597B2 (ja) 2004-09-22

Family

ID=17324312

Family Applications (1)

Application Number Title Priority Date Filing Date
JP25873194A Expired - Fee Related JP3568597B2 (ja) 1994-09-28 1994-09-28 移動農機の傾斜検出装置

Country Status (1)

Country Link
JP (1) JP3568597B2 (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11123021A (ja) * 1997-10-22 1999-05-11 Yanmar Agricult Equip Co Ltd コンバインの水平制御装置
WO2004020946A1 (ja) * 2002-08-28 2004-03-11 Sony Corporation ヘッドトラッキング方法及び装置
JP2006101736A (ja) * 2004-10-01 2006-04-20 Mitsubishi Agricult Mach Co Ltd 作業車輌における傾斜自動制御装置
JP2006166713A (ja) * 2004-12-13 2006-06-29 Mitsubishi Agricult Mach Co Ltd 移動農機
JP2007238057A (ja) * 2006-03-13 2007-09-20 Kubota Corp 作業車の姿勢制御装置
JP2007238056A (ja) * 2006-03-13 2007-09-20 Kubota Corp 作業車の姿勢制御装置
JP2011030464A (ja) * 2009-07-30 2011-02-17 Iseki & Co Ltd 農作業機の対地作業機自動ローリング制御装置

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
BRPI0806559B1 (pt) 2007-01-08 2018-04-10 Precision Planting, Inc. Sistema de monitor para semeadeira de sementes agrícolas
JP5229038B2 (ja) * 2009-03-23 2013-07-03 井関農機株式会社 農作業車の姿勢制御装置

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11123021A (ja) * 1997-10-22 1999-05-11 Yanmar Agricult Equip Co Ltd コンバインの水平制御装置
WO2004020946A1 (ja) * 2002-08-28 2004-03-11 Sony Corporation ヘッドトラッキング方法及び装置
JP2006101736A (ja) * 2004-10-01 2006-04-20 Mitsubishi Agricult Mach Co Ltd 作業車輌における傾斜自動制御装置
JP2006166713A (ja) * 2004-12-13 2006-06-29 Mitsubishi Agricult Mach Co Ltd 移動農機
JP4500659B2 (ja) * 2004-12-13 2010-07-14 三菱農機株式会社 移動農機
JP2007238057A (ja) * 2006-03-13 2007-09-20 Kubota Corp 作業車の姿勢制御装置
JP2007238056A (ja) * 2006-03-13 2007-09-20 Kubota Corp 作業車の姿勢制御装置
JP2011030464A (ja) * 2009-07-30 2011-02-17 Iseki & Co Ltd 農作業機の対地作業機自動ローリング制御装置

Also Published As

Publication number Publication date
JP3568597B2 (ja) 2004-09-22

Similar Documents

Publication Publication Date Title
JP2632916B2 (ja) 車両かじ取システムの中心位置を決定するための方法及び装置
JPH0889011A (ja) 移動農機の傾斜検出装置
JP3763835B2 (ja) 移動農機の傾斜検出装置
JP3797881B2 (ja) 作業機のローリング制御装置
JP3838319B2 (ja) 水平制御装置
JP3236414B2 (ja) 乗用型水田作業車の操向制御装置
KR100436641B1 (ko) 작업기의 롤링제어장치
JP3949078B2 (ja) 農作業機のローリング制御装置
JP2000211896A (ja) 角度制御方法及び角度制御装置
JP3717411B2 (ja) 作業機のセンサ零点補正装置
JP3838959B2 (ja) 農作業機のローリング制御装置
JP3838320B2 (ja) 水平制御装置
JP3688211B2 (ja) 作業機のローリング制御装置
JPH0222Y2 (ja)
JP2525780Y2 (ja) エアーサスペンション装置
WO2021075400A1 (ja) 加速度検出装置、作業機械および加速度検出方法
JP2775073B2 (ja) 作業用走行機体における作業部の傾斜制御装置
JPS6352330B2 (ja)
JP2854658B2 (ja) 作業用走行機体における作業部の傾斜制御装置
JP3721855B2 (ja) 水平制御装置
JP3916555B2 (ja) 農作業機のローリング制御装置
JPH0644957Y2 (ja) 高所作業車のレベリング装置
JP2000324906A (ja) 水平制御装置
JP2000232803A (ja) 作業車両のローリング制御装置
JP2000253706A (ja) トラクタの対地作業機ローリング制御装置

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20040204

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20040325

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20040405

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: 20040603

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20040616

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080625

Year of fee payment: 4

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090625

Year of fee payment: 5

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100625

Year of fee payment: 6

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110625

Year of fee payment: 7

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120625

Year of fee payment: 8

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130625

Year of fee payment: 9

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130625

Year of fee payment: 9

LAPS Cancellation because of no payment of annual fees