TWI702851B - 座標系整合方法、及具備柱狀體之裝置 - Google Patents

座標系整合方法、及具備柱狀體之裝置 Download PDF

Info

Publication number
TWI702851B
TWI702851B TW108104205A TW108104205A TWI702851B TW I702851 B TWI702851 B TW I702851B TW 108104205 A TW108104205 A TW 108104205A TW 108104205 A TW108104205 A TW 108104205A TW I702851 B TWI702851 B TW I702851B
Authority
TW
Taiwan
Prior art keywords
coordinate system
sensor
calibration
marker
markers
Prior art date
Application number
TW108104205A
Other languages
English (en)
Other versions
TW201937920A (zh
Inventor
久保諒太郎
坂野肇
林俊寛
Original Assignee
日商Ｉｈｉ股份有限公司
日商Ｉｈｉ運搬機械股份有限公司
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 日商Ｉｈｉ股份有限公司, 日商Ｉｈｉ運搬機械股份有限公司 filed Critical 日商Ｉｈｉ股份有限公司
Publication of TW201937920A publication Critical patent/TW201937920A/zh
Application granted granted Critical
Publication of TWI702851B publication Critical patent/TWI702851B/zh

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00—Measuring arrangements characterised by the use of optical techniques
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00—Measuring arrangements characterised by the use of optical techniques
    • G01B11/26—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • G01C15/02—Means for marking measuring points
    • G01C15/06—Surveyors' staffs; Movable markers

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本發明係一種將物體檢測感測器110A之感測器座標系與預先設定之基準座標系建立對應之座標系整合方法，其包括：測量步驟，其係藉由第2測量裝置305對設置於將物體檢測感測器110A安裝至支臂13之安裝治具120A並定義感測器座標系之校準用標記物131A、及設置於支臂13並定義基準座標系之基準標記物201進行測量；及整合步驟，其係基於測量步驟之測量結果，將由校準用標記物部130A所定義之感測器座標系與由基準標記物201所定義之基準座標系建立對應。

Description

座標系整合方法、及具備柱狀體之裝置
本發明係關於一種座標系整合方法、及具備柱狀體之裝置。
例如，業界係於建設機械等安裝物體檢測感測器，而使用物體檢測感測器檢測建設機械等周圍之物體。於使用物體檢測感測器檢測物體之情形時，將對建設機械等預先設定之基準座標系與物體檢測感測器之設置位置及姿勢對應，即，將基準座標系與物體檢測感測器之感測器座標系建立對應。
例如，於專利文獻(日本專利3897984號)中記載，於監視在道路上行駛之車輛之監視相機中，將道路平面與監視相機之設置位置及姿勢對應。
於上述專利文獻所記載之方法中係藉由監視相機檢測特徵點，並基於特徵點之檢測結果將道路平面與監視相機之設置位置及姿勢對應。考慮與此同樣地，基於安裝於建設機械等之物體檢測感測器之檢測結果將基準座標系與物體檢測感測器之設置位置及姿勢對應。
然而，於使用成為要進行設置位置及姿勢之對應建立之對象的物體檢測感測器之檢測結果之情形時，基準座標系與感測器座標系之對應建立之精度依賴於物體檢測感測器之檢測精度。
對此，本發明說明一種可不依賴於物體檢測感測器之檢測精度而將對象裝置之基準座標系與物體檢測感測器之感測器座標系建立對應的座標系整合方法、及具備柱狀體之裝置。
本發明之一態樣係一種座標系整合方法，其將安裝於對象裝置並檢測對象裝置周圍之物體之物體檢測感測器之感測器座標系與對於對象裝置預先設定之基準座標系建立對應，且包括：測量步驟，其係藉由測量裝置對設置於將物體檢測感測器安裝至對象裝置之安裝治具並定義感測器座標系之3個以上之校準用標記物、及設置於對象裝置並定義基準座標系之3個以上之基準標記物進行測量；及整合步驟，其係基於測量步驟之測量結果，將由校準用標記物所定義之感測器座標系與由基準標記物所定義之基準座標系建立對應。
於該座標系整合方法中係於測量步驟中，藉由測量裝置對校準用標記物及基準標記物進行測量。並且，於整合步驟中，基於測量步驟之測量結果，將感測器座標系與基準座標系建立對應。即，基於測量裝置之測量結果特定出感測器座標系及基準座標系並將感測器座標系與基準座標系建立對應，不使用物體檢測感測器之檢測結果。因此，於該座標系整合方法中，可不依賴於物體檢測感測器之檢測精度而將對象裝置之基準座標系與物體檢測感測器之感測器座標系建立對應。
亦可為，物體檢測感測器包括第1物體檢測感測器、及第2物體檢測感測器；安裝治具包括將第1物體檢測感測器安裝至對象裝置之第1安裝治具、及將第2物體檢測感測器安裝至對象裝置之第2安裝治具；校準用標記物包括設置於第1安裝治具並定義第1物體檢測感測器之第1感測器座標系之3個以上之第1校準用標記物、及設置於第2安裝治具並定義第2物體檢測感測器之第2感測器座標系之3個以上之第2校準用標記物；基準標記物係於對象裝置設置3個以上，測量裝置對3個以上之第1校準用標記物進行測量時，至少3個以上之基準標記物朝向與第1校準用標記物一起被測量之方向，測量裝置對3個以上之第2校準用標記物進行測量時，至少3個以上之基準標記物朝向與第2校準用標記物一起被測量之方向；於測量步驟中，藉由測量裝置對3個以上之第1校準用標記物及3個以上之基準標記物進行測量，並藉由測量裝置對3個以上之第2校準用標記物及3個以上之基準標記物進行測量；於整合步驟中，將由第1校準用標記物所定義之第1感測器座標系與基準座標系建立對應，並將由第2校準用標記物所定義之第2感測器座標系與基準座標系建立對應。於此情形時，即便第1物體檢測感測器及第2物體檢測感測器設於不同位置，亦可於測量步驟中對第1校準用標記物及基準標記物進行測量，並可對第2校準用標記物及基準標記物進行測量。又，即便設有複數個物體檢測感測器，亦可將各物體檢測感測器之感測器座標系與基準座標系建立對應。
本發明之另一態樣係一種座標系整合方法，其將安裝於對象裝置並檢測對象裝置周圍之物體之物體檢測感測器之感測器座標系與對於對象裝置預先設定之基準座標系建立對應，且包括：第1測量步驟，其係藉由第1測量裝置對設於將物體檢測感測器安裝至對象裝置之安裝治具或物體檢測感測器並定義感測器座標系之感測器座標特定部、及設置於安裝治具並定義校準用標記物座標系之3個以上之校準用標記物進行測量；第1對應建立步驟，其係基於第1測量步驟之測量結果，將由感測器座標特定部所定義之感測器座標系與由校準用標記物所定義之校準用標記物座標系建立對應；第2測量步驟，其係藉由第2測量裝置對3個以上之校準用標記物、及設置於對象裝置並定義基準座標系之3個以上之基準標記物進行測量；第2對應建立步驟，其係基於第2測量步驟之測量結果，將由校準用標記物所定義之校準用標記物座標系與由基準標記物所定義之基準座標系建立對應；及整合步驟，其係基於第1對應建立步驟中建立了對應之感測器座標系及校準用標記物座標系、以及第2對應建立步驟中建立了對應之校準用標記物座標系及基準座標系，將感測器座標系與基準座標系建立對應。
於該座標系整合方法中係於第1測量步驟中藉由第1測量裝置對感測器座標特定部及校準用標記物進行測量，於第2測量步驟中藉由第2測量裝置對校準用標記物及基準標記物進行測量。於第1對應建立步驟中將感測器座標系與校準用標記物座標系建立對應，於第2對應建立步驟中將校準用標記物座標系與基準座標系建立對應。並且，於整合步驟中，將感測器座標系與基準座標系建立對應。即，基於第1測量裝置及第2測量裝置之測量結果進行各座標系之對應建立，不使用物體檢測感測器之檢測結果。因此，於該座標系整合方法中，可不依賴於物體檢測感測器之檢測精度而將對象裝置之基準座標系與物體檢測感測器之感測器座標系建立對應。
亦可為，物體檢測感測器包括第1物體檢測感測器、及第2物體檢測感測器；安裝治具包括將第1物體檢測感測器安裝至對象裝置之第1安裝治具、及將第2物體檢測感測器安裝至對象裝置之第2安裝治具；感測器座標特定部包括設於第1安裝治具或第1物體檢測感測器並定義第1物體檢測感測器之第1感測器座標系之第1感測器座標特定部、及設於第2安裝治具或第2物體檢測感測器並定義第2物體檢測感測器之第2感測器座標系之第2感測器座標特定部；校準用標記物包括設置於第1安裝治具並定義第1校準用標記物座標系之3個以上之第1校準用標記物、及設置於第2安裝治具並定義第2校準用標記物座標系之3個以上之第2校準用標記物；基準標記物係於對象裝置設置3個以上，第2測量裝置對3個以上之第1校準用標記物進行測量時，至少3個以上之基準標記物朝向與第1校準用標記物一起被測量之方向，第2測量裝置對3個以上之第2校準用標記物進行測量時，至少3個以上之基準標記物朝向與第2校準用標記物一起被測量之方向；於第1測量步驟中，藉由第1測量裝置對第1感測器座標特定部及3個以上之第1校準用標記物進行測量，並藉由第1測量裝置對第2感測器座標特定部及3個以上之第2校準用標記物進行測量；於第1對應建立步驟中，將由第1感測器座標特定部所定義之第1感測器座標系與由第1校準用標記物所定義之第1校準用標記物座標系建立對應，並將由第2感測器座標特定部所定義之第2感測器座標系與由第2校準用標記物所定義之第2校準用標記物座標系建立對應；於第2測量步驟中，藉由第2測量裝置對3個以上之第1校準用標記物及3個以上之基準標記物進行測量，並藉由第2測量裝置對3個以上之第2校準用標記物及3個以上之基準標記物進行測量；於第2對應建立步驟中，將由第1校準用標記物所定義之第1校準用標記物座標系與由基準標記物所定義之基準座標系建立對應，並將由第2校準用標記物所定義之第2校準用標記物座標系與由基準標記物所定義之基準座標系建立對應；於整合步驟中，基於第1對應建立步驟中建立了對應之第1感測器座標系及第1校準用標記物座標系、以及第2對應建立步驟中建立了對應之第1校準用標記物座標系及基準座標系，將第1感測器座標系與基準座標系建立對應，並基於第1對應建立步驟中建立了對應之第2感測器座標系及第2校準用標記物座標系、以及第2對應建立步驟中建立了對應之第2校準用標記物座標系及基準座標系，將第2感測器座標系與基準座標系建立對應。於此情形時，即便第1物體檢測感測器及第2物體檢測感測器設於不同位置，亦可於第2測量步驟中對第1校準用標記物及基準標記物進行測量，並可對第2校準用標記物及基準標記物進行測量。又，即便設有複數個物體檢測感測器，亦可將各物體檢測感測器之感測器座標系與基準座標系建立對應。
物體檢測感測器亦可為藉由向對象裝置之周圍照射複數束雷射光而檢測物體者。例如，考慮於藉由該物體檢測感測器檢測基準標記物之情形時，因雷射光之照射間隔不同而檢測不到基準標記物之情況。然而，於該座標系整合方法中，因可不使用物體檢測感測器之檢測結果，而將感測器座標系與基準座標系建立對應，故可不依賴於物體檢測感測器之檢測精度而進行座標系之對應建立。
本發明之又一態樣之具備柱狀體之裝置具備：可移動柱狀體；3個以上之基準標記物，其等係設於柱狀體，並定義對柱狀體預先設定之基準座標系；物體檢測感測器，其係隨柱狀體一起移動；及3個以上之校準用標記物，其等係設於物體檢測感測器或安裝於物體檢測感測器之安裝治具，並定義物體檢測感測器之感測器座標系；且3個以上之基準標記物及3個以上之校準用標記物以可自1個地點視認之方式設置。
於該具備柱狀體之裝置中，可自1個地點視認3個以上之基準標記物及3個以上之校準用標記物。藉此，藉由對校準用標記物及基準標記物進行測量，可將感測器座標系與基準座標系建立對應。即，可不使用物體檢測感測器之檢測結果，而將感測器座標系與基準座標系建立對應。因此，於該具備柱狀體之裝置中，可不依賴於物體檢測感測器之檢測精度而將對柱狀體設定之基準座標系與物體檢測感測器之感測器座標系建立對應。
根據本發明之各種態樣，可不依賴於物體檢測感測器之檢測精度，而將對象裝置之基準座標系與物體檢測感測器之感測器座標系建立對應。
以下，一面參照圖式，一面對本發明之實施形態進行說明。再者，於圖示之說明中，對同一要素標註同一符號，省略重複說明。
於本實施形態中，針對將對圖1所示之油壓挖掘機(對象裝置、裝置)1預先設定之基準座標系與安裝於油壓挖掘機1之物體檢測感測器110A~110D(參照圖3(a)~圖3(d))之各感測器座標系建立對應之座標系整合方法進行說明。此處，將2個座標系建立對應係指，掌握相對於一座標系之另一座標系之位置及姿勢。即，將2個座標系建立對應係指，設為能獲得基於自一座標系向另一座標系之平移及旋轉之座標轉換參數，並將由一座標系所得之座標轉換成另一座標系之座標的狀態。
油壓挖掘機1具備：移行體11，其用以使自身移行；回轉體10，其設於移行體11上；起重臂12，其安裝於回轉體10之前方；支臂(柱狀體)13，其安裝於起重臂12之前端；鏟鬥14，其安裝於支臂13之前端。藉由油壓，起重臂12相對於回轉體10擺動，支臂13相對於起重臂12擺動，鏟鬥14相對於支臂13擺動。
如圖1及圖2所示，支臂13形成為四角柱狀。於本實施形態中，以支臂13之軸作為第1軸，以與第1軸正交之軸作為第2軸，以與第1軸及第2軸正交之軸作為第3軸時，以由第1軸、第2軸及第3軸所定義之座標系作為對油壓挖掘機1(支臂13)預先設定之基準座標系。基準座標系之原點係設為支臂13之軸向之特定位置。
於支臂13之外周面之各面分別安裝有感測器單元100A~100D。如圖3(a)所示，於支臂13之安裝有感測器單元100A之面，設置有基準標記物部200A。基準標記物部200A包含3個基準標記物201A。基準標記物201A定義基準座標系。即，基準標記物201A以表示基準座標系之方式設置於支臂13之外周面。藉由對3個基準標記物201A進行測量，導出基準座標系。例如，於由3個基準標記物201A導出之三維座標系與基準座標系有偏差之情形時，亦可基於用以使所導出之三維座標系與基準座標系吻合之轉換資訊，而根據基準標記物201A之測量結果導出基準座標系。
作為基於3個基準標記物201A導出三維座標系之方法，可使用周知方法。例如，藉由2個基準標記物201A決定第1個軸。藉由3個基準標記物201A定義三角形之面，以面之法線作為第2個軸。以與該等2個軸正交之線作為第3個軸。再者，作為一例，基準標記物201A亦可為帶有十字之銀色平板。於各基準標記物201A中亦可附有識別資訊，使用識別資訊導出基準座標系。
如圖3(b)所示，於支臂13之安裝有感測器單元100B之面，設置有包含3個基準標記物201B之基準標記物部200B。如圖3(c)所示，於支臂13之安裝有感測器單元100C之面，設置有包含3個基準標記物201C之基準標記物部200C。如圖3(d)所示，於支臂13之安裝有感測器單元100D之面，設置有包含3個基準標記物201D之基準標記物部200D。3個基準標記物201B、3個基準標記物201C、及3個基準標記物201D係與3個基準標記物201A同樣地定義基準座標系。即，3個基準標記物201A、3個基準標記物201B、3個基準標記物201C、及3個基準標記物201D定義同一座標系(對油壓挖掘機1預先設定之基準座標系)。
感測器單元100A係如圖4(a)及圖4(b)所示，具有物體檢測感測器(第1物體檢測感測器)110A、及安裝治具(第1安裝治具)120A。物體檢測感測器110A係檢測支臂13周圍之物體之感測器。於本實施形態中，物體檢測感測器110A係藉由向支臂13之周圍照射複數束雷射光而檢測物體之感測器(例如LIDAR(Light Detection And Ranging，光雷達))。
安裝治具120A係將物體檢測感測器110A安裝至支臂13之治具。安裝治具120A具有感測器安裝板121A、及4個標記安裝板122A。於感測器安裝板121A之上表面安裝有物體檢測感測器110A。標記安裝板122A形成為剖面大致L字形。標記安裝板122A安裝於感測器安裝板121A之下表面。於標記安裝板122A設置有校準用標記物部130A。於本實施形態中，校準用標記物部130A包含8個校準用標記物(第1校準用標記物)131A。校準用標記物131A以2個一組之方式設置於各標記安裝板122A。
校準用標記物部130A定義校準用標記物座標系(第1校準用標記物座標系)。藉由對校準用標記物部130A進行測量，而導出校準用標記物座標系。作為基於校準用標記物部130A導出校準用標記物座標系之方法，可使用周知之方法。例如，於基於3個校準用標記物131A之測量結果導出校準用標記物座標系之情形時，首先，藉由2個校準用標記物131A決定第1個軸。藉由3個校準用標記物131A定義面，以面之法線作為第2個軸。以與該等2個軸正交之線作為第3個軸。例如，能以設置於左端等特定位置之校準用標記物131A之位置作為校準用標記物座標系之原點。再者，作為一例，校準用標記物131A亦可為帶有十字之銀色平板。於各校準用標記物部130A中亦可附有識別資訊，使用識別資訊導出校準用標記物座標系。
如圖4(c)所示，於感測器安裝板121A之上表面(感測器設置面)設有2個將物體檢測感測器110A進行定位之銷123A。物體檢測感測器110A藉由銷123A決定在感測器安裝板121A上之位置及朝向。即，物體檢測感測器110A之設置位置及姿勢係由感測器安裝板121A之上表面及銷123A決定。如此，感測器安裝板121A之上表面及銷123A作為表示物體檢測感測器110A之感測器座標系(第1感測器座標系)之感測器座標特定部(第1感測器座標特定部)而發揮功能。
感測器單元100B具備與感測器單元100A相同之構成。具體而言，如圖4(a)及圖4(b)所示，感測器單元100B具有物體檢測感測器(第2物體檢測感測器)110B、及安裝治具(第2安裝治具)120B。安裝治具120B具有感測器安裝板121B、及4個標記安裝板122B。於感測器安裝板121B之上表面安裝物體檢測感測器110B。於標記安裝板122B設置有校準用標記物部130B。與校準用標記物部130A同樣，校準用標記物部130B包含8個校準用標記物(第2校準用標記物)131B。校準用標記物131B以2個一組之方式設置於各標記安裝板122B。
校準用標記物部130B定義校準用標記物座標系(第2校準用標記物座標系)。藉由對校準用標記物部130B進行測量，而與校準用標記物部130A同樣地，導出校準用標記物座標系。校準用標記物部130B具備與校準用標記物部130A相同之構成。再者，校準用標記物部130A所定義之校準用標記物座標系與校準用標記物部130B所定義之校準用標記物座標系互不相同。
如圖4(c)所示，於感測器安裝板121B之上表面設有2個將物體檢測感測器110B進行定位之銷123B。物體檢測感測器110B藉由銷123B決定在感測器安裝板121B上之位置及朝向。即，物體檢測感測器110B之設置位置及姿勢由感測器安裝板121B之上表面及銷123B決定。如此，感測器安裝板121B之上表面及銷123B作為表示物體檢測感測器110B之感測器座標系(第2感測器座標系)之感測器座標特定部(第2感測器座標特定部)而發揮功能。
感測器單元100C及100D具備與感測器單元100A相同之構成。具體而言，如圖3(c)所示，感測器單元100C具備物體檢測感測器110C、及校準用標記物部130C。進而，感測器單元100C與感測器單元100A同樣，具有安裝治具，該安裝治具包含設有銷之感測器安裝板及標記安裝板。如圖3(d)所示，感測器單元100D具備物體檢測感測器110D、及校準用標記物部130D。進而，感測器單元100D與感測器單元100A同樣，具有安裝治具，該安裝治具包含設有銷之感測器安裝板及標記安裝板。
如圖5所示，油壓挖掘機1具備監視裝置20。監視裝置20基於物體檢測感測器110A~110D之檢測結果，對支臂13周圍之障礙物等進行監視。具體而言，監視裝置20基於物體檢測感測器110A~110D之檢測結果，掌握相對於基準座標系何處存在障礙物等。監視裝置20基於所掌握之障礙物等，進行障礙物之有無之報告等。
此處，為了掌握相對於基準座標系而言障礙物等之位置，需事先將基準座標系與物體檢測感測器110A~110D之各者之感測器座標系建立對應。以下，對將基準座標系與感測器座標系建立對應之座標系整合方法進行說明。
基準座標系與感測器座標系之對應建立係藉由圖5所示之座標對應建立裝置300而進行。座標對應建立裝置300可配備於油壓挖掘機1以外之場所，亦可搭載於油壓挖掘機1。
於座標對應建立裝置300連接有第1測量裝置304、及第2測量裝置(測量裝置)305。第1測量裝置304對感測器單元100A之校準用標記物部130A、及感測器單元100A中之物體檢測感測器110A之設置位置及姿勢進行測量。具體而言，第1測量裝置304係將3個以上之校準用標記物131A作為校準用標記物部130A進行測量。第1測量裝置304係將感測器安裝板121A之上表面、及銷123A作為物體檢測感測器110A之設置位置及姿勢進行測量。再者，校準用標記物131A係至少3個校準用標記物131A設於與感測器安裝板121A之上表面及銷123A同時被測量之位置及朝向。
第1測量裝置304對其他感測器單元100B~100D亦同樣地，分別對校準用標記物部130B~130D、及物體檢測感測器110B~110D之設置位置及姿勢進行測量。第1測量裝置304將測量結果輸入至座標對應建立裝置300。第1測量裝置304之測量可由操作員進行，亦可由第1測量裝置304自動進行。作為第1測量裝置304，例如，可使用三維雷射測量器。
此處，第1測量裝置304之測量係於物體檢測感測器110A等未安裝於感測器安裝板121A等之狀態下進行。又，第1測量裝置304之測量可於安裝治具120A等未安裝於支臂13之狀態下進行，亦可於安裝治具120A等安裝於支臂13之狀態下進行。
第2測量裝置305對感測器單元100A之校準用標記物部130A、及設置於支臂13之基準標記物部200A進行測量。具體而言，第2測量裝置305係將3個以上之校準用標記物131A作為校準用標記物部130A進行測量。第2測量裝置305係將3個以上之基準標記物201A作為基準標記物部200A進行測量。再者，於本實施形態中，因基準標記物部200A包含3個基準標記物201A，故第2測量裝置305對3個基準標記物201A均進行測量。
又，關於基準標記物部200A，第2測量裝置305對校準用標記物部130A進行測量時，至少3個以上之基準標記物201A朝向與校準用標記物部130A一起被測量之方向。再者，於本實施形態中，因基準標記物部200A包含3個基準標記物201A，故3個基準標記物201A均朝向與校準用標記物部130A一起被測量之方向。即，3個基準標記物201A及3個以上之校準用標記物131A係以可自1個視點視認之方式設置。
第2測量裝置305對其他感測器單元100B~100D亦同樣地，分別對校準用標記物部130B~130D、及設於支臂13之基準標記物部200B~200D進行測量。第2測量裝置305係將3個基準標記物201B均作為基準標記物部200B進行測量，將3個基準標記物201C均作為基準標記物部200C進行測量，並將3個基準標記物201D均作為基準標記物部200D進行測量。
又，關於基準標記物部200B，第2測量裝置305對校準用標記物部130B進行測量時，3個基準標記物201B均朝向與校準用標記物部130B一起被測量之方向。關於基準標記物部200C，第2測量裝置305對校準用標記物部130C進行測量時，3個基準標記物201C均朝向與校準用標記物部130C一起被測量之方向。關於基準標記物部200D，第2測量裝置305對校準用標記物部130D進行測量時，3個基準標記物201D均朝向與校準用標記物部130D一起被測量之方向。
如此，於支臂13設置有3個基準標記物201A、3個基準標記物201B、3個基準標記物201C、及3個基準標記物201D共12個基準標記物。該等基準標記物之中，3個基準標記物201A朝向藉由第2測量裝置305而與校準用標記物部130A一起被測量之方向。同樣，該等基準標記物201A~201D之中，3個基準標記物201B朝向藉由第2測量裝置305而與校準用標記物部130B一起被測量之方向。該等基準標記物201A~201D之中，3個基準標記物201C朝向藉由第2測量裝置305而與校準用標記物部130C一起被測量之方向。該等基準標記物201A~201D之中，3個基準標記物201D朝向藉由第2測量裝置305而與校準用標記物部130D一起被測量之方向。
第2測量裝置305將測量結果輸入至座標對應建立裝置300。第2測量裝置305之測量可由操作員進行，亦可由第2測量裝置305自動進行。作為第2測量裝置305，例如可使用全能測量儀等測量設備。
第2測量裝置305可移動，例如，可自與對校準用標記物部130A及基準標記物部200A進行測量時之位置不同之位置對校準用標記物部130B及基準標記物部200B進行測量。於第2測量裝置305固定於地面上之情形時，亦可例如使油壓挖掘機1移動或使支臂13等擺動，以使作為測量對象之校準用標記物部及基準標記物部進入測量範圍內。
座標對應建立裝置300物理上構成為具備CPU(Central Processing Unit，中央處理單元)、作為主記憶裝置之RAM(Random Access Memory，隨機存取記憶體)及ROM(Read Only Memory，唯讀記憶體)、與其他設備進行通信之通信模組、以及硬碟等輔助記憶裝置等硬體的電腦。座標對應建立裝置300亦可包含複數個電腦單元。
座標對應建立裝置300功能上具有第1對應建立部301、第2對應建立部302、及整合部303。第1對應建立部301基於第1測量裝置304之測量結果，如圖6所示，分別將物體檢測感測器110A~110D之感測器座標系與由校準用標記物部130A~130D所定義之校準用標記物座標系建立對應。
具體而言，第1對應建立部301係基於感測器安裝板121A之上表面及銷123A之測量結果，對物體檢測感測器110A之感測器座標系進行運算。第1對應建立部301係基於校準用標記物部130A之測量結果，算出由校準用標記物部130A所定義之校準用標記物座標系。第1對應建立部301將算出之物體檢測感測器110A之感測器座標系與由校準用標記物部130A所定義之校準用標記物座標系建立對應。
又，第1對應建立部301係基於感測器安裝板121B之上表面及銷123B之測量結果，算出物體檢測感測器110B之感測器座標系。第1對應建立部301係基於校準用標記物部130B之測量結果，算出由校準用標記物部130B所定義之校準用標記物座標系。第1對應建立部301將算出之物體檢測感測器110B之感測器座標系與由校準用標記物部130B所定義之校準用標記物座標系建立對應。
同樣，第1對應建立部301算出物體檢測感測器110C之感測器座標系及校準用標記物部130C之校準用標記物座標系，並將算出之座標系彼此建立對應。第1對應建立部301算出物體檢測感測器110D之感測器座標系及校準用標記物部130D之校準用標記物座標系，並將算出之座標系彼此建立對應。
第2對應建立部302基於第2測量裝置305之測量結果，如圖6所示，分別將由校準用標記物部130A~130D所定義之校準用標記物座標系與由基準標記物部200A~200D所定義之基準座標系建立對應。
具體而言，第2對應建立部302係基於校準用標記物部130A之測量結果，算出由校準用標記物部130A所定義之校準用標記物座標系。第2對應建立部302係基於基準標記物部200A之測量結果算出基準座標系。第2對應建立部302將算出之由校準用標記物部130A所定義之校準用標記物座標系與基準座標系建立對應。
又，第2對應建立部302係基於校準用標記物部130B之測量結果，算出由校準用標記物部130B所定義之校準用標記物座標系。第2對應建立部302係基於基準標記物部200B之測量結果算出基準座標系。第2對應建立部302將算出之由校準用標記物部130B所定義之校準用標記物座標系與基準座標系建立對應。
同樣，第2對應建立部302算出校準用標記物部130C之校準用標記物座標系及基準座標系，並將算出之座標系彼此建立對應。第2對應建立部302算出校準用標記物部130D之校準用標記物座標系及基準座標系，並將算出之座標系彼此建立對應。
此處，由第1對應建立部301建立對應後之對應建立結果與由第2對應建立部302建立對應後之對應建立結果，校準用標記物座標系與之共通。因此，整合部303藉由將由第1對應建立部301建立了對應之感測器座標系及校準用標記物座標系、與由第2對應建立部302建立了對應之校準用標記物座標系及基準座標系整合，而將感測器座標系與基準座標系建立對應。
具體而言，整合部303係藉由將物體檢測感測器110A之感測器座標系及由校準用標記物部130A所定義之校準用標記物座標系之對應建立結果、與由校準用標記物部130A所定義之校準用標記物座標系及基準座標系之對應建立結果整合，而將物體檢測感測器110A之感測器座標系與基準座標系建立對應。又，整合部303係藉由將物體檢測感測器110B之感測器座標系及由校準用標記物部130B所定義之校準用標記物座標系之對應建立結果、與由校準用標記物部130B所定義之校準用標記物座標系及基準座標系之對應建立結果整合，而將物體檢測感測器110B之感測器座標系與基準座標系建立對應。
同樣，整合部303將物體檢測感測器110C之感測器座標系與基準座標系建立對應，並將物體檢測感測器110D之感測器座標系與基準座標系建立對應。
由座標對應建立裝置300所進行之基準座標系與感測器座標系之對應建立結果輸入至監視裝置20，並用於監視裝置20中之障礙物等之監視。
繼而，對使用座標對應建立裝置300、第1測量裝置304、及第2測量裝置305進行之座標系整合方法之處理流程進行說明。如圖7所示，第1測量裝置304分別對校準用標記物部130A~130D、及物體檢測感測器110A~110D之設置位置及姿勢進行測量(S101：第1測量步驟)。第1對應建立部301基於第1測量步驟之測量結果，分別將物體檢測感測器110A~110D之感測器座標系與由校準用標記物部130A~130D所定義之校準用標記物座標系建立對應(S102：第1對應建立步驟)。
第2測量裝置305分別對校準用標記物部130A~130D、及基準標記物部200A~200D進行測量(S103：第2測量步驟)。第2對應建立部302基於第2測量步驟之測量結果，分別將由校準用標記物部130A~130D所定義之校準用標記物座標系與由基準標記物部200A~200D所定義之基準座標系建立對應(S104：第2對應建立步驟)。整合部303將第1對應建立步驟中之對應建立結果與第2對應建立步驟中之對應建立結果整合，分別將物體檢測感測器110A~110D之感測器座標系與基準座標系建立對應(S105：整合步驟)。
如上所述，根據本實施形態之座標系整合方法，於第1測量步驟中使用第1測量裝置304，分別對校準用標記物部130A~130D及物體檢測感測器110A~110D之設置位置及姿勢進行測量。於第2測量步驟中使用第2測量裝置305，分別對校準用標記物部130A~130D及基準標記物部200A~200D進行測量。即，基於第1測量裝置304及第2測量裝置305之測量結果，將物體檢測感測器110A~110D之感測器座標系與基準座標系建立對應，不使用物體檢測感測器110A~110D之檢測結果。因此，於該座標系整合方法中，可不依賴於物體檢測感測器110A~110D之檢測精度而分別將油壓挖掘機1之基準座標系與物體檢測感測器110A~110D之感測器座標系建立對應。
基準標記物201A係朝向與校準用標記物部130A一起由第2測量裝置305測量之方向。同樣地，基準標記物201B~201D分別朝向與校準用標記物部130B~130D一起由第2測量裝置305測量之方向。於此情形時，例如，即便物體檢測感測器110A及物體檢測感測器110B設於不同位置，亦可於第2測量步驟中對校準用標記物部130A及基準標記物201A進行測量，並可對校準用標記物部130B及基準標記物201B進行測量。又，於本實施形態之座標系整合方法中，即便如物體檢測感測器110A~110D般設有複數個物體檢測感測器，亦可將各物體檢測感測器110A~110D之感測器座標系與基準座標系建立對應。
物體檢測感測器110A~110D係藉由向支臂13之周圍照射複數束雷射光而檢測物體之感測器。考慮於此情形時，例如於藉由該物體檢測感測器110A~110D檢測基準標記物201A~201D之情形時，因雷射光之照射間隔不同而檢測不到201A~201D之情況。然而，於本實施形態之座標系整合方法中，因可不使用物體檢測感測器110A~110D之檢測結果，而將感測器座標系與基準座標系建立對應，故可不依賴於物體檢測感測器110A~110D之檢測精度而進行座標系之對應建立。
於油壓挖掘機1中，例如，可自1個地點視認3個基準標記物201A及3個以上之校準用標記物131A。藉此，藉由對校準用標記物131A及基準標記物201A進行測量，可將感測器座標系與基準座標系建立對應。即，可不使用物體檢測感測器110A~110D之檢測結果而將感測器座標系與基準座標系建立對應。因此，於該油壓挖掘機1中，可不依賴於物體檢測感測器110A~110D之檢測精度而將設定於支臂13之基準座標系與物體檢測感測器110A~110D之感測器座標系建立對應。
以上，對本發明之實施形態進行了說明，但本發明並不限定於上述實施形態。例如，雖於形成為四角柱狀之支臂13設置了基準標記物201A等，但如圖8所示，亦可於圓柱形狀之支臂15設置基準標記物部200。於此情形時，構成基準標記物部200之複數個基準標記物201於支臂15之外周面按特定之角度分別設置。按特定之角度設置之複數個基準標記物201之組於支臂15之軸向上設置複數組。基準標記物201定義基準座標系。作為基於3個基準標記物201導出三維座標系之方法，可使用周知之方法。例如，於按特定之角度設置之基準標記物201之組中，根據3個基準標記物201定義圓形面，並以面之法線作為第1個軸。以通過圓形面之中心及特定基準標記物201之直線作為第2個軸。並且，可以與該等2個軸正交之線作為第3個軸。即，複數個基準標記物201之中，排列於周向之至少3個基準標記物201以可藉由第2測量裝置305測量之方式配置即可。
於實施形態中，雖係以基於支臂13之軸設定基準座標系之情形為例進行說明，但基準座標系並不限定於基於支臂13之軸而設定。基準座標系定於油壓挖掘機1之適當位置即可。
圖7中係於第1測量步驟(S101)及第1對應建立步驟(S102)之後進行第2測量步驟(S103)及第2對應建立步驟(S104)，但亦可於第2測量步驟及第2對應建立步驟之後進行第1測量步驟及第1對應建立步驟。
又，例如，有時已知物體檢測感測器110A之設置位置及姿勢與校準用標記物131A之位置關係由加工之精度決定等。或者，亦可因校準用標記物131A直接設置於物體檢測感測器110A，而已知物體檢測感測器110A之設置位置及姿勢與校準用標記物131A之位置關係。即，由校準用標記物部130A所定義之座標系成為物體檢測感測器110A之感測器座標系。於此情形時，無需使用第1測量裝置304之第1測量步驟。因此，只需使用第2測量裝置305對校準用標記物部130A及基準標記物部200A進行測量(測量步驟)，並由整合部303對該測量結果進行整合(整合步驟)，便可將由校準用標記物部130A所定義之物體檢測感測器110A之感測器座標系與由基準標記物部200A所定義之基準座標系建立對應。關於物體檢測感測器110B~110D，亦係於已知物體檢測感測器110B~110D之設置位置及姿勢與構成校準用標記物部130B之校準用標記物131B及構成校準用標記物部130C、130D之各校準用標記物之位置關係之情形時，無需使用第1測量裝置304之第1測量步驟。於此情形時，可不進行第1測量步驟，而將物體檢測感測器110A~110D之感測器座標系與基準座標系建立對應。
雖將感測器單元100A等安裝至支臂13，但感測器單元100A等亦可安裝於支臂13以外之其他部位。又，雖使用油壓挖掘機1作為將物體檢測感測器110A等之感測器座標系建立對應之對象裝置，但並不限定於油壓挖掘機1。例如，亦可以卸載機、油壓挖掘機1以外之建設機械、進行特定作業等之重型機械等作為對象裝置。
例如，雖藉由感測器安裝板121A之上表面及銷123A而特定出物體檢測感測器110A之感測器座標系，但亦可基於設置於物體檢測感測器110A之表面之標記(感測器座標特定部)等特定出感測器座標系。
雖基準標記物部200A包含3個基準標記物201A，但亦可包含4個以上之基準標記物201A。於此情形時，4個以上之基準標記物201A中至少3個以上之基準標記物201A以可藉由第2測量裝置305測量之方式配置即可。並且，可使用由第2測量裝置305所測量之3個基準標記物201A而導出基準座標系，亦可使用4個以上之基準標記物201A並藉由周知之方法而導出基準座標系。基準標記物部200B~200D亦同樣，可分別包含4個以上之基準標記物201B~201D。
於實施形態中，雖示出了基於3個校準用標記物131A導出校準用標記物座標系之例，但亦可基於4個以上之校準用標記物131A導出校準用標記物座標系。構成校準用標記物部130B之校準用標記物131B及構成校準用標記物部130C、130D之各校準用標記物亦同樣，可基於4個以上之校準用標記物分別導出校準用標記物座標系。
1‧‧‧油壓挖掘機(對象裝置、具備柱狀體之裝置) 10‧‧‧回轉體 11‧‧‧移行體 12‧‧‧起重臂 13‧‧‧支臂(柱狀體) 14‧‧‧鏟鬥 15‧‧‧支臂 20‧‧‧監視裝置 100A‧‧‧感測器單元 100B‧‧‧感測器單元 100C‧‧‧感測器單元 100D‧‧‧感測器單元 110A‧‧‧物體檢測感測器(第1物體檢測感測器) 110B‧‧‧物體檢測感測器(第2物體檢測感測器) 110C‧‧‧物體檢測感測器 110D‧‧‧物體檢測感測器 120A‧‧‧安裝治具(第1安裝治具) 120B‧‧‧安裝治具(第2安裝治具) 121A‧‧‧感測器安裝板(感測器座標特定部、第1感測器座標特定部) 121B‧‧‧感測器安裝板(感測器座標特定部、第2感測器座標特定部) 122A‧‧‧標記安裝板 122B‧‧‧標記安裝板 123A‧‧‧銷(感測器座標特定部、第1感測器座標特定部) 123B‧‧‧銷(感測器座標特定部、第2感測器座標特定部) 130A‧‧‧校準用標記物部 130B‧‧‧校準用標記物部 130C‧‧‧校準用標記物部 130D‧‧‧校準用標記物部 131A‧‧‧校準用標記物(第1校準用標記物) 131B‧‧‧校準用標記物(第2校準用標記物) 200‧‧‧基準標記物部 200A‧‧‧基準標記物部 200B‧‧‧基準標記物部 200C‧‧‧基準標記物部 200D‧‧‧基準標記物部 201‧‧‧基準標記物 201A‧‧‧基準標記物 201B‧‧‧基準標記物 201C‧‧‧基準標記物 201D‧‧‧基準標記物 300‧‧‧座標對應建立裝置 301‧‧‧第1對應建立部 302‧‧‧第2對應建立部 303‧‧‧整合部 304‧‧‧第1測量裝置 305‧‧‧第2測量裝置(測量裝置) S101‧‧‧第1測量步驟 S102‧‧‧第1對應建立步驟 S103‧‧‧第2測量步驟 S104‧‧‧第2對應建立步驟 S105‧‧‧整合步驟
圖1係表示實施形態之油壓挖掘機之概略構成之圖。 圖2係沿圖1之II-II線之剖視圖。 圖3(a)~圖3(d)係模式性表示安裝於支臂之外周面之感測器單元及基準標記物之圖。 圖4(a)係表示感測器單元之上表面之立體圖。圖4(b)係表示感測器單元之下表面之立體圖。圖4(c)係表示物體檢測感測器之安裝面之立體圖。 圖5係表示座標對應建立裝置周圍之構成之方塊圖。 圖6係表示座標系之對應關係之概念圖。 圖7係表示座標系整合方法之處理流程之流程圖。 圖8係表示基準標記物部之其他例之側視圖。
20‧‧‧監視裝置
110A‧‧‧物體檢測感測器(第1物體檢測感測器)
110B‧‧‧物體檢測感測器(第2物體檢測感測器)
110C‧‧‧物體檢測感測器
110D‧‧‧物體檢測感測器
300‧‧‧座標對應建立裝置
301‧‧‧第1對應建立部
302‧‧‧第2對應建立部
303‧‧‧整合部
304‧‧‧第1測量裝置
305‧‧‧第2測量裝置(測量裝置)

Claims (5)

  1. 一種座標系整合方法，其係將安裝於對象裝置並檢測上述對象裝置周圍之物體之物體檢測感測器之感測器座標系與對上述對象裝置預先設定之基準座標系建立對應，且包括：測量步驟，其係藉由測量裝置對設置於將上述物體檢測感測器安裝至上述對象裝置之安裝治具並定義上述感測器座標系之3個以上之校準用標記物、及設置於上述對象裝置並定義上述基準座標系之3個以上之基準標記物進行測量；及整合步驟，其係基於上述測量步驟之測量結果，將由上述校準用標記物所定義之上述感測器座標系與由上述基準標記物所定義之上述基準座標系建立對應，其中上述物體檢測感測器包括第1物體檢測感測器、及第2物體檢測感測器；上述安裝治具包括將上述第1物體檢測感測器安裝至上述對象裝置之第1安裝治具、及將上述第2物體檢測感測器安裝至上述對象裝置之第2安裝治具；上述校準用標記物包括設置於上述第1安裝治具並定義上述第1物體檢測感測器之第1感測器座標系之3個以上之第1校準用標記物、及設置於上述第2安裝治具並定義上述第2物體檢測感測器之第2感測器座標系之3個以上之第2校準用標記物；上述基準標記物係於上述對象裝置設置3個以上，上述測量裝置對3個以上之上述第1校準用標記物進行測量時，至少3個以上之上述基準標記 物朝向與上述第1校準用標記物一起被測量之方向，上述測量裝置對3個以上之上述第2校準用標記物進行測量時，至少3個以上之上述基準標記物朝向與上述第2校準用標記物一起被測量之方向；於上述測量步驟中，藉由上述測量裝置對3個以上之上述第1校準用標記物及3個以上之基準標記物進行測量，並藉由上述測量裝置對3個以上之上述第2校準用標記物及3個以上之基準標記物進行測量；於上述整合步驟中，將由上述第1校準用標記物所定義之上述第1感測器座標系與上述基準座標系建立對應，並將由上述第2校準用標記物所定義之上述第2感測器座標系與上述基準座標系建立對應。
  2. 一種座標系整合方法，其係將安裝於對象裝置並檢測上述對象裝置周圍之物體之物體檢測感測器之感測器座標系與對上述對象裝置預先設定之基準座標系建立對應，且包括：第1測量步驟，其係藉由第1測量裝置對設於將上述物體檢測感測器安裝至上述對象裝置之安裝治具或上述物體檢測感測器並定義上述感測器座標系之感測器座標特定部、及設置於上述安裝治具並定義校準用標記物座標系之3個以上之校準用標記物進行測量；第1對應建立步驟，其係基於上述第1測量步驟之測量結果，將由上述感測器座標特定部所定義之上述感測器座標系與由上述校準用標記物所定義之校準用標記物座標系建立對應；第2測量步驟，其係藉由第2測量裝置對3個以上之上述校準用標記物、及設置於上述對象裝置並定義上述基準座標系之3個以上之基準標記物進行測量； 第2對應建立步驟，其係基於上述第2測量步驟之測量結果，將由上述校準用標記物所定義之上述校準用標記物座標系與由上述基準標記物所定義之上述基準座標系建立對應；及整合步驟，其係基於上述第1對應建立步驟中建立了對應之上述感測器座標系及上述校準用標記物座標系、以及上述第2對應建立步驟中建立了對應之上述校準用標記物座標系及上述基準座標系，將上述感測器座標系與上述基準座標系建立對應。
  3. 如請求項2之座標系整合方法，其中上述物體檢測感測器包括第1物體檢測感測器、及第2物體檢測感測器；上述安裝治具包括將上述第1物體檢測感測器安裝至上述對象裝置之第1安裝治具、及將上述第2物體檢測感測器安裝至上述對象裝置之第2安裝治具；上述感測器座標特定部包括設於上述第1安裝治具或上述第1物體檢測感測器並定義上述第1物體檢測感測器之第1感測器座標系之第1感測器座標特定部、及設於上述第2安裝治具或上述第2物體檢測感測器並定義上述第2物體檢測感測器之第2感測器座標系之第2感測器座標特定部；上述校準用標記物包括設置於上述第1安裝治具並定義第1校準用標記物座標系之3個以上之第1校準用標記物、及設置於上述第2安裝治具並定義第2校準用標記物座標系之3個以上之第2校準用標記物；上述基準標記物係於上述對象裝置設置3個以上，上述第2測量裝置對3個以上之上述第1校準用標記物進行測量時，至少3個以上之上述基準標記物朝向與上述第1校準用標記物一起被測量之方向，上述第2測量裝置 對3個以上之上述第2校準用標記物進行測量時，至少3個以上之上述基準標記物朝向與上述第2校準用標記物一起被測量之方向；於上述第1測量步驟中，藉由上述第1測量裝置對上述第1感測器座標特定部及3個以上之上述第1校準用標記物進行測量，並藉由上述第1測量裝置對上述第2感測器座標特定部及3個以上之上述第2校準用標記物進行測量；於上述第1對應建立步驟中，將由上述第1感測器座標特定部所定義之上述第1感測器座標系與由上述第1校準用標記物所定義之上述第1校準用標記物座標系建立對應，並將由上述第2感測器座標特定部所定義之上述第2感測器座標系與由上述第2校準用標記物所定義之上述第2校準用標記物座標系建立對應；於上述第2測量步驟中，藉由上述第2測量裝置對3個以上之上述第1校準用標記物及3個以上之上述基準標記物進行測量，並藉由上述第2測量裝置對3個以上之上述第2校準用標記物及3個以上之上述基準標記物進行測量；於上述第2對應建立步驟中，將由上述第1校準用標記物所定義之上述第1校準用標記物座標系與由上述基準標記物所定義之上述基準座標系建立對應，並將由上述第2校準用標記物所定義之上述第2校準用標記物座標系與由上述基準標記物所定義之上述基準座標系建立對應；於上述整合步驟中，基於上述第1對應建立步驟中建立了對應之上述第1感測器座標系及上述第1校準用標記物座標系、以及第2對應建立步驟中建立了對應之上述第1校準用標記物座標系及上述基準座標系，將上述第1感測器座標系與上 述基準座標系建立對應，並基於上述第1對應建立步驟中建立了對應之上述第2感測器座標系及上述第2校準用標記物座標系、以及第2對應建立步驟中建立了對應之上述第2校準用標記物座標系及上述基準座標系，將上述第2感測器座標系與上述基準座標系建立對應。
  4. 如請求項1至3中任一項之座標系整合方法，其中上述物體檢測感測器係藉由向上述對象裝置之周圍照射複數束雷射光而檢測物體者。
  5. 一種具備柱狀體之裝置，其具備：可移動柱狀體；3個以上之基準標記物，其等係設於上述柱狀體，並定義對上述柱狀體預先設定之基準座標系；物體檢測感測器，其係與上述柱狀體一起移動；及3個以上之校準用標記物，其等係設於上述物體檢測感測器或安裝於上述物體檢測感測器之安裝治具，並定義上述物體檢測感測器之感測器座標系；且3個以上之上述基準標記物及3個以上之上述校準用標記物係以可自1個地點視認之方式設置。
TW108104205A 2018-02-02 2019-02-01 座標系整合方法、及具備柱狀體之裝置 TWI702851B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018-017053 2018-02-02
JP2018017053 2018-02-02

Publications (2)

Publication Number Publication Date
TW201937920A TW201937920A (zh) 2019-09-16
TWI702851B true TWI702851B (zh) 2020-08-21

Family

ID=67478111

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108104205A TWI702851B (zh) 2018-02-02 2019-02-01 座標系整合方法、及具備柱狀體之裝置

Country Status (3)

Country Link
JP (1) JP6912604B2 (zh)
TW (1) TWI702851B (zh)
WO (1) WO2019151238A1 (zh)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100153061A1 (en) * 2008-12-17 2010-06-17 Gerhard Hietmann Hand-held device and method for detecting the spatial position of a working point of a manipulator
US8170329B2 (en) * 2008-07-18 2012-05-01 Fuji Xerox Co., Ltd. Position measuring system, position measuring method and computer readable medium
US20160063704A1 (en) * 2014-08-27 2016-03-03 Kabushiki Kaisha Topcon Image processing device, image processing method, and program therefor

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5764511A (en) * 1995-06-20 1998-06-09 Caterpillar Inc. System and method for controlling slope of cut of work implement
JP4284765B2 (ja) * 1999-07-27 2009-06-24 株式会社豊田中央研究所 ロボットハンド位置計測装置
JP2002107128A (ja) * 2000-10-02 2002-04-10 Sanyo Electric Co Ltd 形状測定装置
JP2003282238A (ja) * 2002-03-25 2003-10-03 Pioneer Electronic Corp 有機エレクトロルミネッセンス表示パネル及び製造方法
KR101477481B1 (ko) * 2007-03-05 2014-12-30 이노스 오토메이션스소프트웨어 게엠베하 위치 결정 장치 및 방법
JP2009199247A (ja) * 2008-02-20 2009-09-03 Fuji Xerox Co Ltd 対象物認識装置、指示装置およびプログラム
JP5843531B2 (ja) * 2010-09-27 2016-01-13 株式会社ミツトヨ 座標測定用ヘッドユニット及び座標測定機
US9168654B2 (en) * 2010-11-16 2015-10-27 Faro Technologies, Inc. Coordinate measuring machines with dual layer arm
JP2012233353A (ja) * 2011-05-02 2012-11-29 Komatsu Ltd 油圧ショベルの較正システム及び油圧ショベルの較正方法
WO2015089403A1 (en) * 2013-12-12 2015-06-18 The Regents Of The University Of Michigan Estimating three-dimensional position and orientation of articulated machine using one or more image-capturing devices and one or more markers
JP5736622B1 (ja) * 2014-05-01 2015-06-17 機械設計中畑株式会社 検出装置およびこの装置を具えたマニプレータの動作制御
WO2016044658A1 (en) * 2014-09-19 2016-03-24 Hexagon Metrology, Inc. Multi-mode portable coordinate measuring machine
JP6126067B2 (ja) * 2014-11-28 2017-05-10 ファナック株式会社 工作機械及びロボットを備えた協働システム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8170329B2 (en) * 2008-07-18 2012-05-01 Fuji Xerox Co., Ltd. Position measuring system, position measuring method and computer readable medium
US20100153061A1 (en) * 2008-12-17 2010-06-17 Gerhard Hietmann Hand-held device and method for detecting the spatial position of a working point of a manipulator
US20160063704A1 (en) * 2014-08-27 2016-03-03 Kabushiki Kaisha Topcon Image processing device, image processing method, and program therefor

Also Published As

Publication number Publication date
WO2019151238A1 (ja) 2019-08-08
JP6912604B2 (ja) 2021-08-04
JPWO2019151238A1 (ja) 2020-12-03
TW201937920A (zh) 2019-09-16

Similar Documents

Publication Publication Date Title
EP2381214B1 (en) Optical measurement system
CN101322071B (zh) 投影缺陷和检查位置的系统及相关方法
CN110954067B (zh) 一种基于靶标的单目视觉挖掘机位姿测量系统及测量方法
US8812257B2 (en) Method for determining a virtual tool center point
US6323776B1 (en) Method and apparatus of automatically identifying faults in a machine vision measuring system
US9580885B2 (en) Swing operating machine and method of controlling swing operating machine
JP4218449B2 (ja) クレーンの動作監視システム及び方法
US9996931B2 (en) Method for calibrating camera measurement system
WO2019130831A1 (ja) 建設機械の障害物検出装置
JP2007276996A (ja) 建設機械のジブ動作監視装置、建設機械のジブ動作監視方法、建設機械の動作監視システム
EP1236029A1 (en) Procedure for determining the dynamic behaviour of a vehicle on a test bench
JP2009204532A (ja) 距離画像センサの校正装置及び校正方法
WO2012041687A1 (en) A method, means, and system for acquiring location parameters
US20180202128A1 (en) Work machine control system and work machine control method
JP7023813B2 (ja) 作業機械
US11454498B2 (en) Coordinate measuring system
CN208968469U (zh) 工业机器人重复定位精度分析系统
CN110740841A (zh) 作业系统
KR20170087996A (ko) 로봇의 캘리브레이션 장치 및 그 방법
CN111278608A (zh) 用于3d视觉机器人系统的校准物品
TWI702851B (zh) 座標系整合方法、及具備柱狀體之裝置
JP2002181538A (ja) Ｇｐｓを用いた施工端部位置検出装置
JP3511551B2 (ja) ロボットアームの状態検出方法および検出システム
JP5483554B2 (ja) ツール座標系の較正装置及び較正方法
CN114343848A (zh) 一种标记块的长度测量系统及手术机器人系统