JPH11304904A - 移動体位置計測システム - Google Patents

移動体位置計測システム

Info

Publication number
JPH11304904A
JPH11304904A JP10110310A JP11031098A JPH11304904A JP H11304904 A JPH11304904 A JP H11304904A JP 10110310 A JP10110310 A JP 10110310A JP 11031098 A JP11031098 A JP 11031098A JP H11304904 A JPH11304904 A JP H11304904A
Authority
JP
Japan
Prior art keywords
moving object
positioning
measuring
object position
interface
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
JP10110310A
Other languages
English (en)
Inventor
Shintaro Hatsumoto
慎太郎 初本
Noriyuki Kamiya
敬之 神谷
Toshihiro Aono
俊宏 青野
Kenjiro Fujii
健二郎 藤井
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.)
Hitachi Ltd
Original Assignee
Hitachi 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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP10110310A priority Critical patent/JPH11304904A/ja
Publication of JPH11304904A publication Critical patent/JPH11304904A/ja
Pending legal-status Critical Current

Links

Abstract

(57)【要約】 【課題】 従来は、アプリケーションに依存の移動体位
置計測部がアプリケーション毎の専用コントローラの中
に組み込まれているため、任意の機械の挙動計測に移動
体位置計測部を利用しようとしても、挙動計測専用のシ
ステムを新規に創る必要があり、着脱性に乏しい構成と
なっている。またDGPSの状態が専用ディスプレイを
接続しないとわからない構成となっているため、使い勝
手が悪く、また必要な部品構成点数が増えることからコ
スト高となる。 【解決手段】 本発明は、アプリケーションに非依存の
独立パッケージモジュール1として構成された移動体位
置計測システムを提供し、位置計測が必要な各種アプリ
ケーションに対し容易な適用を実現するものである。ま
た、LED3やソフトウェアによりDGPSの状態を確
認する事を実現することで、専用のモニタなしにDGP
S状態が確認可能となり、使い勝手の向上とコストダウ
ンを実現するものである。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、慣性航法による自
律走行制御または慣性航法とDGPSにより取得する絶
対位置データを融合した自律走行制御、移動体の挙動を
計測するための移動体位置計測に係わり、特に芝刈り機
やトラクタ等の移動作業機械の自律走行制御用センサフ
ージョンシステムに関する。
【0002】
【従来の技術】自動芝刈り機や自律走行トラクタ等の移
動作業機械の自律走行制御を行なう場合、移動体の位置
計測演算部と位置計測結果による軌道シーケンスの解釈
実行やサーボ制御などの自律走行制御部が、ハードウェ
ア、ソフトウェア共に各々独立しておらず1つのコント
ローラの中で計測と制御の総合システムとして成り立っ
ている。このため、アプリケーション毎の専用コントロ
ーラとして構成されている。また、GPSの状態は専用
ディスプレイをコントローラに接続して初めて確認でき
るものである。
【0003】関連する技術は、例えば特開平9−128
043号公報、特開平9−134217号公報、特開平
7−230315号公報、特開平5−187879号公
報に開示されている。
【0004】
【発明が解決しようとする課題】上記従来技術は、アプ
リケーションに依存の移動体位置計測部がアプリケーシ
ョン毎の専用コントローラの中に組み込まれているた
め、任意の機械の挙動計測に移動体位置計測部を利用し
ようとしても、挙動計測専用のシステムを新規に創る必
要があり、着脱性に乏しい構成となっている。またDG
PSの状態が専用ディスプレイを接続しないとわからな
い構成となっているため、使い勝手が悪く、また必要な
部品構成点数が増えることからコスト高となる。本発明
により、アプリケーションに非依存の移動体位置計測部
の着脱性の向上を実現し、ランプまたはソフトウェアプ
ログラムによりDGPSの状態を確認する機能を実現す
るものである。
【0005】
【課題を解決するための手段】本発明にあっては、移動
体の位置計測部分をハードウェア、ソフトウェア共に独
立のシステム構成とした。具体的には、1枚のプリント
基板上に、ヨー角を計測するジャイロセンサ用インタフ
ェースとしてアナログ入力とシリアル通信入力を、ロー
ル角・ピッチ角を計測する姿勢センサ用インタフェース
としてアナログ入力を、絶対位置を計測するDGPS用
インタフェースとしてシリアル通信入力を、車速を計測
するエンコーダ用インタフェースとしてカウンタ入力
を、位置計測結果を利用するユーザシステム用インタフ
ェースとしてシリアル通信入出力を装備し、また各セン
サ、GPS,エンコーダのデータから自己位置推定演算
を行なうシステムソフトウェアプログラムを同一プリン
ト基板上の不揮発メモリ内に格納し、そのシステムソフ
トウェアプログラムを実行演算処理するCPU,メモリ
等のマイコンを装備する構成とした。
【0006】このプリント基板と、ジャイロセンサ、姿
勢センサ、GPSを同一パッケージに納め、また車速セ
ンサとカウンタインタフェースはコネクタにより簡単に
着脱可能とした。これにより、アプリケーションに依存
することのない独立した、移動体位置計測システムを実
現することが可能となる。
【0007】また、LEDランプやシリアル通信を介し
たユーザシステムからのソフトウェアアクセスにより、
DGPSの4つの状態(位置未測位、単独測位中、デフ
ァレンシャル測位中、衛星配置不良)を確認できるよう
にしたことにより、使い勝手の向上とコストダウンを実
現する。
【0008】
【発明の実施の形態】図1は本発明を適用する移動体位
置計測システムのハードウェアシステム構成図、図2は
処理のフロー図である。移動体位置計測に必要なセンサ
のインタフェースを1枚のプリント基板1上に装備され
ている。ヨー角を計測するジャイロセンサ用インタフェ
ースとしてアナログ入力15とRS−232Cシリアル
通信入力14を、ロール角・ピッチ角を計測する姿勢セ
ンサ用インタフェースとしてアナログ入力インタフェー
ス16を、絶対位置を計測するDGPS用インタフェー
スとしてRS−232Cシリアル通信入力13を、車速
を計測するエンコーダ用インタフェースとしてカウンタ
入力12を、位置計測結果を利用するユーザシステム用
インタフェースとしてRS−232Cシリアル通信入出
力17を装備している。
【0009】また各センサ、GPS,エンコーダのデー
タから自己位置推定演算を行なうシステムソフトウェア
プログラムを同一プリント基板上1の不揮発メモリRO
M11内に格納し、そのシステムソフトウェアプログラ
ムを実行演算処理するCPU,メモリ等のマイコン10
を装備する構成とした。このプリント基板と、ジャイロ
センサ、姿勢センサ、GPSを同一パッケージカバー2
に納め、また車速センサとカウンタインタフェースはコ
ネクタにより簡単に着脱可能とした。これにより、アプ
リケーションに依存することのない独立した、移動体位
置計測システムを実現することが可能となる。
【0010】また、LEDランプ3を4個プリント基板
上に装備し、パッケージカバー2外側から確認できる構
成とした。LEDランプの意味付けは、通電中、GPS
単独測位中、デファレンシャル測位中、衛星配置不良と
した。電源は移動体がDC12V仕様が多いことを考慮
して、DC12Vとした。
【0011】図2のフロー図において、本システムに通
電されると、ROM11内のシステムソフトウェアがR
AMにロードされるなどの初期化処理100が行なわれ
る。また、各センサへの通電も開始する。まず、ユーザ
システム4から通信コマンド形式で設定されるユーザI
/Fの出力形式を確認するために、ユーザI/F受信確
認処理101を行なう。その内容によりユーザI/Fの
出力形式を確認102する。その後、システムソフトが
センサインタフェースからのデータの定時スキャン処理
を始める。スキャン処理としては、ジャイロデータ取得
処理103を行なう。次に、姿勢センサデータ取得処理
104を行なう。次に、カウンタデータの取得処理10
5を行なう。
【0012】次にGPSデータ取得処理106を行な
う。この時、取得したNMEA(National Marine Elec
tronics Association)フォーマットのGPGGA(Gro
bal Position System Fix Data)データの属性データの
内容により単独測位中、デファレンシャル測位中、衛星
配置不良の其々どの状態であるかを確認する。そして単
独測位中であれば、単独測位中ランプ点灯処理114を
行なう。また、デファレンシャル測位中であれば、デフ
ァレンシャル測位中ランプ点灯処理115を行なう。ま
た、衛星配置不良状態であれば、衛星配置不良ランプ点
灯処理116を行なう。
【0013】衛星配置の状態はDOP(Position Dilut
ion of Precision)データを確認することによりわか
る。これらの処理を経て位置推定計算処理111を行な
う。この処理で、移動体の自己位置が算出される。ま
た、102で指定されたユーザI/Fへの指定形式にデ
ータをあわせる処理112も行なう。具体的には、東京
測地系のXYZ座標形式で出力するか、GPSの緯度経
度データを出力するか等の指定が行なえる。そしてシリ
アル通信にてユーザシステムに対してデータ出力113
を行なう。
【0014】
【発明の効果】本発明は、アプリケーションに非依存の
独立パッケージ化された移動体位置計測システムを提供
し、位置計測が必要な各種アプリケーションに対し容易
な適用を実現するものである。また、DGPSの状態が
専用のモニタなしに確認可能となり、使い勝手の向上と
コストダウンを実現するものである。
【図面の簡単な説明】
【図1】本発明の適用する移動体位置計測システムのハ
ードウェア構成図。
【図2】本発明の適用する移動体位置計測システムのソ
フトウェア構成図。
【符号の説明】
1 位置計測システム基板 2 パッケージモジュール 3 GPS状態表示ランプ 4 ユーザシステム 11 ROM 12 カウンタ入力部 13 シリアルチャネルインタフェース
フロントページの続き (51)Int.Cl.6 識別記号 FI B62D 137:00 (72)発明者 藤井 健二郎 千葉県習志野市東習志野7丁目1番1号 株式会社日立製作所産業機器事業部内

Claims (5)

    【特許請求の範囲】
  1. 【請求項1】 ヨー角を計測するジャイロと、ロール
    角、ピッチ角を計測する姿勢センサと、絶対位置を計測
    するDGPSと、車速を計測するエンコーダからデータ
    を取得するインタフェースを備え、これらのインタフェ
    ースから取得したデータを基に自己位置を算出するため
    のソフトウェアと、そのソフトウェアを実行処理するC
    PU、メモリを含むマイコンを備えた移動体位置計測シ
    ステム。
  2. 【請求項2】 DGPSの状態を、位置未測位、単独測
    位中、デファレンシャル測位中、衛星配置不良、の4種
    類のステータス情報として表示する手段を備える請求項
    1記載の移動体位置計測システム。
  3. 【請求項3】 DGPSの状態を、位置未測位、単独測
    位中、デファレンシャル測位中、衛星配置不良、の4種
    類のステータス情報としてソフトウェアで解釈できる機
    能を備える請求項1記載の移動体位置計測システム。
  4. 【請求項4】 シリアル通信による汎用インタフェース
    を備え、移動体位置計測結果を出力する機能を備える請
    求項1記載の移動体位置計測システム。
  5. 【請求項5】 多機能を1つのパッケージモジュールに
    統合した構成を備える請求項1乃至4のいずれかに記載
    の移動体位置計測システム。
JP10110310A 1998-04-21 1998-04-21 移動体位置計測システム Pending JPH11304904A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP10110310A JPH11304904A (ja) 1998-04-21 1998-04-21 移動体位置計測システム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP10110310A JPH11304904A (ja) 1998-04-21 1998-04-21 移動体位置計測システム

Publications (1)

Publication Number Publication Date
JPH11304904A true JPH11304904A (ja) 1999-11-05

Family

ID=14532477

Family Applications (1)

Application Number Title Priority Date Filing Date
JP10110310A Pending JPH11304904A (ja) 1998-04-21 1998-04-21 移動体位置計測システム

Country Status (1)

Country Link
JP (1) JPH11304904A (ja)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002296336A (ja) * 2001-03-29 2002-10-09 Clarion Co Ltd 複数のメッセージを選択可能なgpsレシーバ
US6907347B2 (en) 2002-11-21 2005-06-14 Ford Global Technologies, Llc Systems and method for estimating speed and pitch sensor errors
JP2008210378A (ja) * 2007-01-30 2008-09-11 Komatsu Ltd 無人車両の誘導走行制御装置
JP2011257418A (ja) * 2011-08-01 2011-12-22 Nokia Corp 衛星による測位の支援
US8760345B2 (en) 2005-02-28 2014-06-24 Nokia Corporation Supporting a satellite based positioning
CN106325271A (zh) * 2016-08-19 2017-01-11 深圳市银星智能科技股份有限公司 智能割草装置及智能割草装置定位方法
JP2017175637A (ja) * 2017-05-01 2017-09-28 Kddi株式会社 装置、位置取得方法、及び、位置取得制御用プログラム
US9851450B2 (en) 2000-06-30 2017-12-26 Nokia Technologies Oy Portable terminal and method for position determination

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9851450B2 (en) 2000-06-30 2017-12-26 Nokia Technologies Oy Portable terminal and method for position determination
JP2002296336A (ja) * 2001-03-29 2002-10-09 Clarion Co Ltd 複数のメッセージを選択可能なgpsレシーバ
US6907347B2 (en) 2002-11-21 2005-06-14 Ford Global Technologies, Llc Systems and method for estimating speed and pitch sensor errors
US8760345B2 (en) 2005-02-28 2014-06-24 Nokia Corporation Supporting a satellite based positioning
JP2008210378A (ja) * 2007-01-30 2008-09-11 Komatsu Ltd 無人車両の誘導走行制御装置
US8437900B2 (en) 2007-01-30 2013-05-07 Komatsu Ltd. Control device for guided travel of unmanned vehicle
JP2011257418A (ja) * 2011-08-01 2011-12-22 Nokia Corp 衛星による測位の支援
CN106325271A (zh) * 2016-08-19 2017-01-11 深圳市银星智能科技股份有限公司 智能割草装置及智能割草装置定位方法
JP2017175637A (ja) * 2017-05-01 2017-09-28 Kddi株式会社 装置、位置取得方法、及び、位置取得制御用プログラム

Similar Documents

Publication Publication Date Title
US11650599B2 (en) Positioning detection device and working machine having positioning detection device
US6178379B1 (en) Method and apparatus of monitoring a navigation system using deviation signals from navigation sensors
US20080071476A1 (en) Vehicle dynamics conditioning method on MEMS based integrated INS/GPS vehicle navigation system
US8346475B2 (en) Integrated positioning apparatus and implementation method thereof
JP2006105598A (ja) 加速度・角速度センサユニット
JPH11304904A (ja) 移動体位置計測システム
CN112964260A (zh) 自动驾驶定位方法、装置、设备及存储介质
KR20190040818A (ko) 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템
JP2009073386A (ja) ナビゲーション利用自動車制御装置および制御方法
CN115727843A (zh) 用于航位推算的轮速确定方法、装置及设备
US20140039753A1 (en) Method and system for the determination of a steering angle
CN113825390A (zh) 自主行驶系统
JP7421396B2 (ja) 自律飛行体及び飛行制御方法
EP1852681A1 (en) Method for elaborating navigation parameters and vertical of a place
CN112605987B (zh) 机器人导航工作方法、装置及机器人
US6734803B1 (en) Locating device for vehicles
JP6945353B2 (ja) 自動走行作業車
CN112731317A (zh) 车辆雷达标定方法、装置、设备、介质和自动驾驶车辆
CN116135648A (zh) 车辆行为估计系统及车辆行为估计方法
US20230055083A1 (en) System for drone calibration and method therefor
CN113030504B (zh) 车辆测速方法、装置、车载计算机设备和存储介质
US11968917B2 (en) Working vehicle and working machine having the working vehicle
JP7388522B1 (ja) ヨーレート制御装置、ヨーレート制御方法及びプログラム
US20210307231A1 (en) Working vehicle and working machine having the working vehicle
CN115857786B (zh) 用于实现触控交互的方法和触控交互设备

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040730

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A712

Effective date: 20040730

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20040730

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20050623

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050628

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20051025