TWI514101B - 無人駕駛裝置及其控制方法 - Google Patents
無人駕駛裝置及其控制方法 Download PDFInfo
- Publication number
- TWI514101B TWI514101B TW100103792A TW100103792A TWI514101B TW I514101 B TWI514101 B TW I514101B TW 100103792 A TW100103792 A TW 100103792A TW 100103792 A TW100103792 A TW 100103792A TW I514101 B TWI514101 B TW I514101B
- Authority
- TW
- Taiwan
- Prior art keywords
- light
- unit
- sensing
- unmanned device
- signal
- Prior art date
Links
Description
本發明係有關於一種無人駕駛裝置,尤指一種可以按照預先規劃路徑行進,而且避免於相同路徑重覆來回行進之無人駕駛裝置。
由於人力成本的提升,為有效地節省人力成本,無人駕駛的設備或機台係被廣泛地應用於日常生活及工業的傳輸或清潔作業上,如:吸塵器、洗地機或人、物運送車等……,加上透過無人駕駛或操作之平台,皆可以透過適當工具的輔助,如預先架設好的軌道或感測器,即可以輕易的達到所要的目的。
目前市面上所見之無人駕駛設備係大致可區分為兩大類,其一為有軌式的無人駕駛設備,另一則為無軌式的無人駕駛設備。有軌式的無人駕駛設備必須於設備操作前於所需範圍預先設置有軌道,但由於設置軌道唯一大工程,且軌道安裝後不易進行路徑的修改。又,加上安裝軌道必須佔用極大的安裝空間,且為顧及行駛安全,該安裝空間不能做其他使用,實造成極多的浪費。
無軌式的無人駕駛設備係透過設置於該設備上之感應器,以驅使該無人駕駛設備於一空間內移動,例如一吸塵器或一掃地機係於該空間內漫無目的的移動,以拾起行經路徑之髒污,碰撞到牆壁或感之將碰到物體,而改變形進方向,但由於其無法有效地判斷以行走過的路徑,係容易造成於相同的行走路徑上來回行走。另外,機器人的行走亦為一無軌式的無人駕駛設備,但為
使得機器人能順利的依照預定的路徑行走,其必須裝設多數個感測器及一具有強大運算功能的運算模組以針對該等感測器的回傳數據以達到控制該機器人達到行走功能,但其係無疑的必須耗費大量的資金,實不適用於吸塵器、洗地機或人、物運送車等日常生活或工業領域所需無人駕駛設備。
鑒於先前技術所述,本發明之一目的在於提供一種無人駕駛裝置,該無人駕駛裝置可以按照預先規劃路徑行進,而且避免於相同路徑重覆來回行進之無人駕駛裝置,並可大幅地降低製作成本。
為改善先前技術的缺點,本發明之又一目的在於提供一種無人駕駛裝置的操作方法,可以按照預先規劃路徑行進,而且避免於相同路徑重覆來回行進之無人駕駛裝置,並可大幅地降低製作成本。
為改善先前技術的缺點,本發明之再一目的在於提供一種無人駕駛裝置的操作方法,可以按照預先規劃路徑行進,而且避免於相同路徑重覆來回行進之無人駕駛裝置,並可大幅地降低製作成本,並且其空間可做其他利用。
為達成本發明之上述目的,本發明之無人駕駛裝置包含一載具、一掃描模組及一控制模組。該掃瞄模組設置於該載具,該掃瞄模組包含一發光單元、一聚光單元及一感測單元,該發光單元係出射一光線,該感測單元係透過該聚光單元接收一反射影像光線,並將該反射影像光線轉換為對應之一感測信號,該控制模組設置於該載具並電連接於該掃瞄模組;其中,該感測信號係傳送至該控制模組,該控制模組係依據該感測信號以使該無人駕駛裝置前進。
又,本發明更提供一種無人駕駛裝置之操作方法,包含:
提供一發光單元,該發光單元具有一出光角,且朝向一預定方向出射一線型光線;提供一感測單元,朝向該預定方向,該感測單元係透過該聚光單元具有一視角;使該出光角與該視角重疊,產生一重疊區域;該感測單元係感測位於該重疊區域內之物體,並產生一對應的反射影像信號,並將該反射影像信號轉換為一感測信號,其中該感測信號包含有一感測信號寬度及一感測信號深度;該控制模組係接收該感測信號,並藉由該感測信號寬度及該感測信號深度判斷該物體與該無人駕駛裝置的空間距離,並記錄於一記憶體內,接著該掃描模組按著預定的角度旋轉,並記錄不同角度的空間距離於記憶體內,當旋轉一周(360度)後,控制模組則可以定出整個空間平面;該控制模組藉由該空間平面以規劃該無人駕駛裝置的行進路徑。
為達到本發明之上述的再一目的,本發明更提供一種無人駕駛裝置之操作方法,該無人駕駛裝置係位於一操作平面,且該操作平面上設置有複數個條碼路徑,該無人駕駛裝置之操作方法包含:該無人駕駛裝置設於一條碼路徑上,其掃描模組之利用一發光單元出射一光線,且該光線出射置其中之一條碼路徑;利用一感測單元透過一聚光單元接收一經由該條碼路徑之反射影像光線,並將該反射影像光線轉換為對應該條碼路徑之一感測信號;利用一控制模組接收由一設定單元提供的指令資料,其中該指令資料包含一預定控制信號及一預定路徑信號;該控制模組判斷如果該感測信號與該預定路徑信號不相符,且該控制模組判斷如果該預定控制信號為停止行進,則該控制模組送出一控制信號以停止該無人駕駛裝置;該控制模組判斷如果該預定控制信號為不停止行進,則該控制模組送出一控制信號以使該無人駕駛裝置尋找一新條碼路徑。
本發明之功效在於避免於該無人駕駛裝置於相同的路徑重覆來回行進,並降低其製作成本。
10、20、30、40‧‧‧無人駕駛裝置
12、32、42‧‧‧載具
120‧‧‧滾輪
14、24、34、44‧‧‧掃瞄模組
140、240、340、440‧‧‧發光單元
142、342、442‧‧‧導光單元
1420、3420、4420‧‧‧導光本體
1422、3422、4422‧‧‧入光面
1424、3424、4424‧‧‧出光面
144、244、344、444‧‧‧感測單元
146、346、446‧‧‧聚光單元
16、36、46‧‧‧控制模組
18‧‧‧設定單元
248‧‧‧反射單元
249‧‧‧微機電模組
38、48‧‧‧記憶單元
α‧‧‧光出射角度
θ‧‧‧視角
φ‧‧‧出光角
D‧‧‧感測信號深度
D1~D4‧‧‧第一~第四感測信號深度
L‧‧‧出光距離
H‧‧‧設置高度
I‧‧‧光強度
Ia~Id‧‧‧第一~第四光強度
M‧‧‧同步信號寬度
N‧‧‧感測信號寬度
N1~N4‧‧‧第一~第四感測信號寬度
n1‧‧‧感測信號起始點
n2‧‧‧感測信號終止點
P‧‧‧交會點
Q1‧‧‧條碼起始點
Q2‧‧‧條碼終止點
R‧‧‧條碼路徑
r~4r‧‧‧第一距離~第四距離
S‧‧‧操作平面
SD1‧‧‧第一空間距離
SD2‧‧‧第二空間距離
W‧‧‧感測條碼寬度
S400~S422、S500~S518 S600~S618‧‧‧步驟
第一圖(A)為本發明第一實施例之無人駕駛裝置之上視架構圖。
第一圖(B)為本發明第一實施力之無人駕駛裝置之側視架構圖。
第二圖為本發明第一實施例之掃瞄模組之上視圖。
第三圖為感測單元之感測信號示意圖。
第四圖為本發明第一實施例之無人駕駛裝置之操作流程圖。
第五圖為本發明第二實施例之掃描模組之上視圖。
第六圖為本發明第三實施例之無人駕駛裝置之上視圖。
第七圖為本發明第三實施例之發光單元之上視圖。
第八圖為本發明第三實施例之感測單元之上視圖。
第九圖為感測信號感測深度之示意圖。
第十圖為本發明第三實施例之無人駕駛裝置之操作流程圖
第十一圖為本發明第四實施例之無人駕駛裝置之上視圖
第十二圖為感測信號感測深度之示意圖。
第十三圖為本發明第四實施例之無人駕駛裝置之操作流程圖。
配合參閱第一圖(a)及第一圖(b),分別為本發明第一實施例之無人駕駛裝置之上視架構圖及側視架構圖。該無人駕駛裝置10包含有一載具12、一掃瞄模組14及一控制模組16,該載具12之底部裝設有滾輪120,使該無人駕駛
裝置10能順利地於一操作平面S(如:地面)行進。該操作平面S係預先佈設有複數個條碼路徑R,且該等條碼路徑R之交會處設置有一交會點P。
該掃瞄模組14係設置於該載具12,且該掃瞄模組14的設置於距離該操作平面S一設置高度H的位置。該控制模組16設置於該載具12且電連接於該掃瞄模組14。
配合參閱第二圖,為本發明第一實施例之掃瞄模組之上視圖。該掃瞄模組14包含一發光單元140、一導光單元142、一感測單元144及一聚光單元146。該發光單元140係提供該掃描模組14所需之一光源輸出,該發光單元140係朝向Y軸方向出光;於本實施例中,該發光單元140可以為雷射二極體(laser diode,LD)或一發光二極體(light emitting diode,LED),並朝向Y軸方向出射一光線。
另外,要特別說明的是:只要是具有一視角、有掃描寬度的掃描模組,不論其一維的線型的掃描模組,或是二維的面型掃描模組皆應包含於本發明之範疇中。並且,該發光單元係可以為發光二極體、雷射二極體,且其他可達到相等功效之均等元件皆應包含於本發明之範疇中。又,只要有一視角以及影像感測輸出的感測單元皆應包含於本發明之範疇中。為了便於描述,本實施例的解說,均以一維的雷射掃描模組為解說應用。
該導光單元142設置鄰近於該發光單元140的出光側,該導光單元142具有一透光本體1420,該透光本體1420包含一入光面1422及一出光面1424。該入光面1422係面對該發光單元140之出光側,以接收由該發光單元140出射之光線,並使該光線進入該透光本體1420。該出光面1424相對於該入光面1422,且該出光面1424係設計為一朝著相反於該入光面1422方向凸伸之凸面。
該出光面1424係供進入該透光本體1420之光線出射,且該凸面係可以於一一維方向(如圖中所示之Z軸方向)有效地展開出射之光線的出光角度,致使通過該導光單元142之該光線具有一出光角φ,其中該出光角φ的展開角度係隨著該出光面1424之曲率而改變。
該感測單元144係面對於Y軸方向,以接收由該發光單元140及該導光單元142而朝向Y軸出光而經由一物體(如第二圖所示之壁面)反射之反射影像光線。該感測單元144透過該聚光單元146具有一視角θ,其係指該感測單元140所能感測光線的最大範圍,其中該感測單元140為電荷耦合元件(Charge Couple Device,CCD)、互補性氧化物半導體(Complementary Metal-Oxide Semiconductor,CMOS)或其他具有光電轉換特性的元件。該聚光單元146設置鄰近於該感測單元144,以將由該物體反射之反射影像光線準確地聚焦成像於該感測單元144。於本實施例中,該聚光單元146為一雙凸透鏡,但不以此為限,其他可達到相等功效之均等元件皆應包含於本發明之範疇中。
配合參閱第三圖,為感測單元之感測信號示意圖。該感測單元144係供接收經物體反射該發光單元140出射之光線的反射影像光線,該感測單元144係設置有一感測同步信號,如第三圖(a)所示,該同步信號具有一同步信號寬度M,其代表該感測單元144感測物體所需的時間。當該感測單元144感測到經由物體反射之光線後,係對應該物體設置位置的不同產生一如第三圖(b)所示之感測信號,其中該感測信號具有一感測信號寬度N及一感測信號深度D,其中該感測信號寬度N係指感測信號的總寬度,其具有一感測信號起始點n1及一感測信號終止點n2;該感測信號深度D係指物體與該感測單元144的距離,且物體距離該感測單元144愈近,則感測信號深度D愈深,反之,則愈淺。當
被感測物體為一條碼時,該感測單元144產生的感測信號係對應該條碼的條紋分佈而有不同的深度,如第三圖(c)所示,且該感測信號係呈連續分佈;其中該感測信號具有一感測信號寬度N,及一對應該條碼的分佈寬度之感測條碼寬度W。
該感測信號係需經由信號處理過程後再輸出,以便於連接於該感測單元144後端之電子元件能夠輕易且準確地的辨識該感測信號所提供的資訊。如第三圖(d)所示為經信號處理後之感測信號,該感測信號具有一感測信號寬度N、一對應該條碼分佈寬度之感測條碼寬度W、分別位於該感測條碼寬度W兩端點之一條碼起始點Q1及一條碼終止點Q2、一第一空間距離SD1及一第二空間距離SD2,其中該第一空間距離SD1係指由該感測信號之感測信號起始點n1(如第三圖b所示)至該條碼起始點Q1的距離,該第二空間距離SD2係指由該條碼終止點Q2至該感測信號終止點n2的距離。
復參閱第二圖,該控制模組16電連接於掃描模組14,並接收由該感測單元144輸出之一經信號處理後的感測信號;該控制模組16係經由運算該感測信號,並藉由其運算結果以控制該載具12的行動,如:停止、行進或行進方向。
復參閱第一圖(b),於實際操作時,該掃瞄模組14之該發光單元140係於距離該操作平面S該設置高度H的位置以一光出射角度α朝向該操作平面S之其中之一條碼路徑R的條碼持續地出射光線;另外,依實際應用狀態不同,該掃描模組14可於操作平面S以一平行光形式出射。當該光線投射至條碼路徑R時,由於該掃瞄模組14距離於該操作平面S的設置高度H固定不變,則該感測信號之該感測信號深度D皆相同(如第三圖b所示)。另配合參閱第二圖,該導光單元142係擴大該光線的出光角φ,使該出光角φ涵蓋該條碼路徑(如
第一圖a所示)。當該光線投射置該條碼路徑R時,係產生一反射影像光線,該反射影像光線係經由該聚光單元146聚焦後入射於該感測單元144,其中感測單元144的視角θ必須涵蓋該條碼路徑(如第一圖a所示),使有效地感測經由該條碼路徑R反射的反射影像光線。該感測單元144係接收該反射影像光線,並經信號處理後產生一對應該反射影像光線之感測信號,如第三圖(d)所示,並將該經處理後的感測信號傳遞至該控制模組16。
由於該感測單元144的視角θ固定,則對應之該感測信號之感測信號寬度N係不變(如第三圖d所示),因此,該控制模組16係可以透過該第一空間距離SD1及該第二空間距離SD2以判別該無人駕駛裝置10是否偏離該條碼路徑R。其判斷方式是藉由該控制模組16比較該第一空間距離SD1及該第二空間距離SD2的長度。其中當該無人駕駛裝置10行駛在該條碼路徑R上,該感測單元144所對應產生的感測信號係與該掃描模組14的感測方向左右可以設計同向,加上該掃描模組14設置於該無人駕駛裝置10的中間位置,因此,當該無人駕駛裝置10行駛對應於該條碼路徑R的中心位置時,該第一空間距離SD1係等於該第二空間距離SD2(如第三圖d所示)。而若該第一空間距離SD1大於該第二空間距離SD2,則該控制模組16判斷該無人駕駛裝置的行進方向偏向該條碼路徑R的左邊,反之,則該無人駕駛裝置的行進方向偏向該條碼路徑R的右邊。該控制模組16係提供一控制信號,並驅使該載具12調整行進方向,以避免該無人駕駛裝置10偏離於該條碼路徑R行駛。
另外,該無人駕駛裝置10更可以包含有一設定單元18(如第一圖a所示),該設定單元18設置於該載具12且電連接於該控制模組16,供使用者
依據實際使用狀態而設定該控制模組16的指令資料,其中該指令資料包含一預定路徑資料及一預定控制資料。
當該無人駕駛裝置10行駛至操作平面S設置之該交會點P時,係可以透過預先設置之該指令資料以驅使該無人駕駛裝置10停止、原地旋轉或選擇另一條碼路徑R。若該無人駕駛裝置10行駛至該交會點P,該控制模組16依據該預定控制資料以判斷是否停止該無人駕駛裝置10,若是,則停止該無人駕駛裝置的行進。而若該預定控制資料為不停止該無人駕駛裝置10,則該無人駕駛裝置10係必須依照該預定路徑資料選擇一新的條碼路徑R,其選擇方式說明如下:該無人駕駛裝置10係於該交會點P位置依據該預定路徑資料沿著一預定方向(如:順時針方向)地原地旋轉感測設置於該交會點P周圍的該等條碼路徑R,並經由該感測單元144讀取由各該條碼路徑R的反射影像光線,並傳遞一感測信號至該控制模組16。該控制模組16比對該感測信號及該預定路徑信號,若該感測信號與該預定路徑信號相同,則驅使該無人駕駛裝置10朝向該條碼路徑R行進;而若比對感測信號與該預定路徑信號不符,則持續地沿著該預定方向感測其他設置於該交會點P周圍的條碼路徑R。
配合參閱第四圖,為本發明第一實施例之該無人駕駛裝置之動作流程圖。該無人駕駛裝置10係供行駛於一操作平面S,該操作平面S上預先設置有複數個條碼路徑R,且該等條碼路徑R之交會處係設置有一交會點P。
該無人駕駛裝置10包含一載具12、一掃瞄模組14、一控制模組16及一設定單元18。該載具12係供承載該掃瞄模組14、該控制模組16及該設定單元18,且該載具12具有至少一滾輪120,以使便利地於該操作平面S上行
動。該掃瞄模組14包含該一發光單元140、一導光單元142、一感測單元144及一聚光單元146。
該無人駕駛裝置10的操作方法包含:首先,利用該掃瞄模組14之該發光單元140朝向該其中之一條碼路徑R方向出射一光線(步驟S400),該光線係由該導光單元142之一入光面1422入射至其導光本體1420,並經由一出光面1424以擴大出光角φ角度地投射置該條碼路徑R(步驟S401)。該條碼路徑R係反射該光線,該聚光單元146係將該反射之反射影像光線聚焦地入射於該感測單元144(步驟S402)。該感測單元144係接收該反射影像光線,並產生一對應該反射影像光線的感測信號(步驟S403),並將該感測信號傳遞至該控制模組16。
接著,該控制模組接收來自該設定單元之一指令資料(步驟S404),其中該指令資料包含一預定控制資料及一預定路徑資料。
又,該控制模組16係比對該感測信號及一預定路徑信號(步驟S406),若該感測信號與該預定路徑信號不相符(如行駛至交會點P),則該控制模組16係依據該預定控制資料判斷是否停止該無人駕駛裝置10(步驟S408)。若該預定控制資料指示當該感測信號與該預設路徑信號不相符時,係停止該無人駕駛裝置10行進,則該控制模組16係驅使該無人駕駛裝置10停止前進(步驟S410)。而若該預定控制資料指示於感測信號與該預定路徑信號不相符時,係不停止該無人駕駛裝置10的行進,則該控制模組16係驅使該無人駕駛裝置10選擇一新條碼路徑R(步驟S412),並回復至步驟S400。由該發光單元朝向其他各該條碼路徑R出射光線,並藉由比較反射影像光線與一預定路徑信號而使該無人駕駛裝置10持續的於該操作平面S上行進。
接續上述步驟S406,若該感測信號與該預定路徑信號相符,則進一步地確認該無人駕駛裝置10的行進方向是否偏離於該條碼路徑R,其判別流程如下:首先,該控制模組16係經由所接收該感測信號以判斷該感測信號的第一空間距離SD1(如第三圖d所示)及該第二空間距離SD2的長度是否相等(步驟S416)。若該第一空間距離SD1與該第二空間距離SD2相等,則確認該無人駕駛裝置10的行進方向與該條碼路徑R一致,且該無人駕駛裝置10係對應該條碼路徑的中心位置行駛,並回復步驟S400,由該發光單元140持續地朝向該條碼路徑R出射光線,並由該感測單元144接收一由該條碼路徑R反射之反射影像光線。另外,若經比較後之該感測信號的第一空間距離SD1與其第二空間距離SD2不相等,則緊接著判斷該第一空間距離SD1是否大於該第二空間距離SD2(步驟S418)。若經判斷後,該第一空間距離SD1大於該第二空間距離SD2,則該控制模組16係驅使該無人駕駛裝置10向右修正行進路徑(步驟S420),並於修正完成後回復步驟S400。而若該第一空間距離SD1不大於該第二空間距離SD2,則該控制模組16係驅使該無人駕駛裝置10向左修正行進路徑(步驟S422),並於修正完成後回復步驟S400。
配合參閱第五圖,為本發明第二實施例之無人駕駛裝置之上視圖。該無人駕駛裝置20係供設置於該載具12(如第一圖a所示),並電連接於該控制模組16及該設定單元18。
該掃瞄模組24包含一發光單元240、一感測單元244及一反射單元248。該反射鏡246係供設置於一微機電模組249,該微機電模組249可以於一固定角度內來回擺動,產生一擺動角度,藉以帶動該反射單元248以該固定角
度來回擺動,且該微機電模組249可以有效地控制該反射單元248的擺動方向及擺動速度。其中該反射單元為單鏡片,但不以此為限,其他可達到相等功效之均等元件,如旋轉的多面鏡皆應包含於本發明之範疇中。
該發光單元240係提供該掃描模組24所需之一光源輸出,該發光單元240係朝向Z軸方向出光;於本實施例中,該發光單元240為一雷射二極體,並朝向Z軸方向出射一具準直性的光線,且該光線係經由該反射單元248而改變其光路的朝向Y軸方向出射。同時,該發光單元244接收向Y軸出射之反射影像光線,該影像反射光線係經由該反射單元248而傳遞至該感測單元244。具有一定擺動方向及擺動速度之該反射單元248係將朝向Y軸出射之該光線於一一維方向(如:Z軸方向)以一出光角φ的展開,出光角φ即為其視角θ,其中該出光角φ係對應該反射單元248的該擺動角度而有所改變。
又,該掃瞄模組24係與上述第一實施例之載具12及該控制模組16搭配組合為一無人駕駛裝置20,其操作方式係大致與上述之第一實施例相同,在此則不予贅述。
配合參閱六圖,為本發明第三實施例之無人駕駛裝置之上視圖。該無人駕駛裝置30包含一載具32、一掃瞄模組34、一控制模組36及一記憶單元38,該載具32之底部裝設有滾輪(未圖示),使該無人駕駛裝置30能順利地於一操作平面S(如:地面)行進。
該掃瞄模組34包含一發光單元340、一導光單元342、一感測單元344及一聚光單元346。該發光單元340係提供該掃瞄模組34所需之一光源輸出,該發光單元340係朝向Y軸方向出射光線;於本實施例中,該發光單元340係為一雷射二極體,並朝向Y軸方向出射一具有準直性之線型光線。
導光單元342設置鄰近於該發光單元340的出光側,且該導光單元具有一透光本體3420,該透光本體3420包含一入光面3422及一出光面3424。該入光面3422係面對該發光單元340的出光側,以接收由該發光單元340所出射之點型光線,並使該點型光線進入該導光本體3420。該出光面3424係相對於該入光面3422,供進入該導光本體3420之線型光線出射,且該出光面3424設計為一朝向相反於該入光面方向凸伸之凸面。
由該發光單元340朝向Y軸方向出射的點型光線係經由該入光面3422入射至該導光元件342之該導光本體3420,並經由該導光本體3420傳遞至該出光面3424,再由該出光面3424出光;並且,該呈凸面狀之該出光面3424係可以有效地展開由該出光面3424出射之線型光線於一一維方向(如:Z軸方向)的出光角度,致使通過該導光單元342之該線型光線具有一出光角φ,其中該出光角φ的展開角度隨著係由該出光面3424之曲率而改變。
配合參閱第七圖,為本發明之線型光線的展開示意圖。依照線型光線的物理特性,其光強度I會隨著逐漸遠離於該發光單元340而逐漸的衰減,但是由於線型光線具有準直性,因此,當線型光線經由該導光單元342於一維方向(Z軸方向)以一出光角φ之角度展開後,該線型光線的光強度I係僅與該發光單元340的出光距離L成反比,亦即距離該發光單元340愈遠,則對應該位置之光強度I愈小。相較於其他的光源,如:發光二極體、白熾燈泡,其於一維方向展開後之光線的光強度係反比於出光距離的平方;相較之下,線型光線(如:雷射光)的光能量衰減較小,因此可以提供出射更長出射距離的光線。
以下係配合第七圖更詳細說明:假設該線型光線於一第一距離r處對應有一第一光強度Ia,且該線型光線於一第二距離2r(r+r)處對應有一第二光強
度Ib。對應上述之線型光線於一維方向(Z軸方向)展開後的光強度I係與其遠離於該發光單元的出光距離L成反比,因此,該線型光線於第一距離r處之第一光強度Ia為該線型光線第二距離2r處之第二光強度Ib的兩倍,即Ia=2Ib。相同地,該線型光線於一第三距離3r處對應有一第三光強度Ic,於一第四距離4r處對應有一第四光強度Id,則Ia=3Ic=4Id。
配合參閱第八圖,該掃描模組24之該感測單元344係面對於Y軸方向,以接收由該發光單元340及該導光單元342而朝向Y軸出光而經由一物體反射之反射影像光線。該感測單元340具有一視角θ,其係指該感測單元340所能感測光線的最大範圍,意即位於該視角θ內的物體皆可以有效地被該感測單元340感測;其中該感測單元340為電荷耦合元件、互補性氧化物半導體或其他具有光電轉換特性的元件。該聚光單元346設置鄰近於該感測單元344,以將由物體反射之反射影像光線準確地聚焦成像於該感測單元340。於本實施例中,該聚光單元346為一雙凸透鏡,但不以此為限,其他可達到相等功效之均等元件皆應包含於本發明之範疇中。
復參閱第六圖,該發光單元340的出光角φ係完全地涵蓋於該感測單元344的視角θ,並產生一第一重疊範圍A,位於該重疊範圍內的物體皆可以有效的被該發光單元340出射之線性光線所涵蓋,並同時產生一反射影像光線,經由該聚光單元346聚焦地入射至該感測單元344。
請同時參閱第六圖及第九圖,當物體位於該第一重疊區域內,且距離該感測單元344該第一距離r處,則對應反射一反射影像光線,並經由該聚光單元346聚焦地入射於該感測單元344。該感測單元344係對應產生有一感測信號,該感測信號具有一第一感測信號深度D1;其中該感測信號深度D(如第三
圖b所示)係指物體與該感測單元344的距離,且物體距離該感測單元344愈近,則該感測信號深度D愈深,反之,則愈淺。
又,當物體被分別的設置於距離該感測單元344該第二距離2r(r+r)、該第三距離3r及第四距離4r處,則該感測單元344係分別對應產生有一第二感測信號深度D2的感測信號、一第三感測信號深度D3的感測信號及一第四感測信號深度D4的感測信號。
又,藉由位於該第一重疊區域距離該感測單元344不同位置的該物體於該感測單元344所產生之具有不同感測信號深度的感測信號,並經由該控制模組36運算後,該無人駕駛裝置30可有效地定義出物體與該感測單元344間的距離。
另外,該無人駕駛裝置30可以透過預先設定之一指令資料,已趨使該無人駕駛裝置30於初始狀態時,預先針對一未知空間環繞一周(360度),並於不同的角度產生對應之感測信號,同時地將該等感測信號儲存於該記憶單元38。該控制模組36係藉由運算該等感測信號以定義出一空間平面,並藉由該空間平面以規劃出該無人駕駛裝置之一行進路徑,以避免該無人駕駛裝置30於相同路徑重覆來回行進。
配合參閱第十圖,為本發明第三實施例之該無人駕駛裝置之動作流程圖。該無人駕駛裝置30包含一載具32、一掃瞄模組34、一控制模組36及一記憶單元38。該載具32係供承載該掃瞄模組34、該控制模組36及該記憶單元38,且該載具32具有至少一滾輪,以使便利地於該操作平面S上行動。該掃瞄模組34包含該一發光單元340、一導光單元342、一感測單元344及一聚光單元346。
該無人駕駛裝置30操作方法包含:
1.提供一發光單元340,以朝向一預定方向出射一光線(步驟S500)。
2.提供一導光單元342,以擴大該光線的出光角度(步驟S502)。
3.提供一感測單元344,朝向該預定方向,該感測單元係具有一視角θ(步驟S504)。
3.使該出光角φ與該視角θ重疊,產生一重疊區域(步驟S506)。
4.該感測單元344係感測位於該重疊區域A內之物體,並接收由該物體反射的反射影像信號,並產生一對應該反射影像信號的感測信號,其中該感測信號包含有一感測信號寬度及一感測信號深度(步驟S508)。
5.該控制模組34係接收該感測信號,並藉由該感測信號以判斷該物體與該無人駕駛裝置30的距離,並將結果儲存於一記憶單元38(步驟S510)。
6.接著,該控制模組36係藉由該等感測信號以判斷該無人駕駛裝置30是否以旋轉一周(360度)(步驟S512)。
7.若該無人駕駛裝置以確實地旋轉360度,則該控制模組34藉由儲存於該記憶單元38的該等感測信號以定義出一空間平面(步驟S516)。
8.該控制模組36係藉由該空間平面以規劃該無人駕駛裝置30的行進路徑(步驟S518)。
9.呈上述步驟6,若該無人駕駛裝置未旋轉360度,則回復步驟S500,持續地由該發光單元朝向該未感測方位出射光線。
另外,本實施之該無人駕駛裝置30之該操作方法亦可以同時地使用於上述第一實施例或該第二實施例之該無人駕駛裝置10、20,使該第一實施
例之該無人駕駛裝置10及該第二實施例之該無人駕駛裝置20除了可於該條碼路徑R上行進外,同時可以偵測是否有外物(如:行走中的人或放置於條碼路徑R上的物品)靠近該無人駕駛裝置10、20。並且,將感測信號傳遞至該控制模組16,並由該控制模組16以驅使該無人駕駛裝置減速或停止。
由於該感測信號深度D係隨著逐漸遠離於該感測單元344而愈來愈淺,且當該發光單元340之出光角φ完全地涵蓋於該感測單元之該視角θ時,複數個設置遠離於該感測單元344超過一預定距離的物體經由該感測單元344感測後所產生之該感測信號深度D係幾乎重疊在一起,致使無法有效地區分出該等位於預定距離外之物體的準確位置。
為避免上述問題產生,本發明更提供一種第四實施例之無人駕駛裝置40,該無人駕駛裝置40係有效地避免該發光單元340的出光角θ與該感測單元344的視角φ完全地涵蓋,僅需部份之該出光角θ與該感測單元344的視角φ產生部分重疊。
配合參閱第十一圖,為本發明第四實施例之該無人駕駛裝置之上視圖。該無人駕駛裝置40包含一載具42、一掃瞄模組44、一控制模組46及一記憶單元48。該掃瞄模組44包含一發光單元440、一導光單元442、一感測單元444及一聚光單元446。
該載具42之底部裝設有滾輪(未圖示),使該無人駕駛裝置40能順利地於一操作平面S(如:地面)行進。
該發光單元440係提供該掃瞄模組44所需之一光源輸出,該發光單元440係朝向Y軸方向出射光線;於本實施例中,該發光單元440係為一雷射二極體,並朝向Y軸方向出射一具有準直性之線型光線。
該導光單元442設置鄰近於該發光單元440的出光側,且該導光單元具有一透光本體4420,該透光本體4420包含一入光面4422及一出光面4424。該入光面4422係面對該發光單元4440的出光側,以接收由該發光單元440所出射之線形光線,並使該線型光線進入該導光本體4420。該出光面4424係相對於該入光面4422,供進入該導光本體4420之線型光線出射,且該出光面4424設計為一朝向相反於該入光面方向凸伸之凸面。
由該發光單元440朝向Y軸方向出射的線型光線係經由該入光面4422入射至該導光元件442之該導光本體4420,並經由該導光本體4420傳遞至該出光面4424,再由該出光面4424出光;並且,該呈凸面狀之該出光面4424係可以有效地展開由該出光面4424出射之線型光線於一一維方向(如:Z軸方向)的出光角度,致使通過該導光單元442之該線型光線具有一出光角φ,其中該出光角φ的展開角度隨著係由該出光面4424之曲率而改變。
該發光單元440的出光角φ係部分地涵蓋於該感測單元444的視角θ,並產生一第二重疊範圍B,位於該重疊範圍B內的物體皆可以有效的被該發光單元440出射之線性光線所涵蓋,並同時產生一反射影像光線,經由該聚光單元446聚焦地入射至該感測單元444。
當物體被設置於該重疊區域B內,且距離該掃瞄模組34該第一距離r處時,該感測單元344產生一對應該物體位置之一感測信號,該感測信號係對應該物體遠離於該感測單元344的距離而具有一第一感測深度D1。又,該感測信號係對應該視角θ於重疊區域B內之該第一距離r的投影長度a1而具有一第一感測信號寬度N1,如第十一圖所示。
相同地,當物體被設置於該重疊區域B內,且分別與該掃瞄模組34具有一第二距離2r,該感測單元344係於該第二距離2r處的投影長度b1對應產生具有一第二感測深度D2及一第二感測信號寬度N2之感測信號。當物體被設置於該重疊區域B內,且分別與該掃瞄模組34具有一第三距離3r,該感測單元344係於該第三距離3r的投影長度c1處對應產生具有一第三感測深度D3及一第三感測信號寬度N3之感測信號。當物體被設置於該重疊區域B內,且分別與該掃瞄模組34具有一第四距離4r,該感測單元344係於該第四距離4r的投影長度d1處對應產生具有一第四感測深度D4及一第四感測信號寬度N4之感測信號。
如此,藉由不同感測深度D及不同感測信號寬度N之感測信號,以更有效地區別出物體距離於該掃瞄模組34的距離。
配合參閱第十三圖,為本發明第四實施例之該無人駕駛裝置之動作流程圖。該無人駕駛裝置40包含一載具42、一掃瞄模組44、一控制模組46及一記憶單元48。該載具42係供承載該掃瞄模組44、該控制模組46及該記憶單元48,且該載具42具有至少一滾輪,以使便利地於該操作平面S上行動。該掃瞄模組44包含該一發光單元440、一導光單元442、一感測單元444及一聚光單元446。
該無人駕駛裝置40操作方法包含:
1.提供一發光單元440,以朝向一預定方向出射一光線(步驟S600)。
2.提供一導光單元442,以擴大該光線的出光角度(步驟S602)。
3.提供一感測單元444,朝向該預定方向,該感測單元係具有一視角θ(步驟S604)。
3.使該出光角φ與該視角θ部分重疊,產生一重疊區域B(步驟S606)。
4.該感測單元444係感測位於該重疊區域B內之物體,並接收由該物體反射的反射影像信號,並產生一對應該反射影像信號的感測信號,其中該感測信號包含有一感測信號寬度及一感測信號深度(步驟S608)。
5.該控制模組44係接收該感測信號,並藉由該感測信號以判斷該物體與該無人駕駛裝置40的距離,並將結果儲存於一記憶單元48(步驟S610)。
6.接著,該控制模組46係藉由該等感測信號以判斷該無人駕駛裝置40是否以旋轉一周(360度)(步驟S612)。
7.若該無人駕駛裝置以確實地旋轉360度,則該控制模組44藉由儲存於該記憶單元48的該等感測信號以定義出一空間平面(步驟S616)。
8.該控制模組46係藉由該距離以規劃該無人駕駛裝置40的行進路徑(步驟S618)。
9.呈上述步驟6,若該無人駕駛裝置未旋轉360度,則回復步驟S600,持續地由該發光單元朝向該未感測方位出射光線。
然以上所述者,僅為本發明之較佳實施例,當不能限定本發明實施之範圍,即凡依本發明申請專利範圍所作之均等變化與修飾等,皆應仍屬本發明之專利涵蓋範圍意圖保護之範疇。
10‧‧‧無人駕駛裝置
12‧‧‧載具
14‧‧‧掃瞄模組
140‧‧‧發光單元
142‧‧‧導光單元
1420‧‧‧導光本體
1422‧‧‧入光面
1424‧‧‧出光面
144‧‧‧感測單元
146‧‧‧聚光單元
16‧‧‧控制模組
θ‧‧‧視角
φ‧‧‧出光角
Claims (18)
- 一種無人駕駛裝置,於一條碼上行進,該無人駕駛裝置包含:一載具;至少一掃描模組,設置於該載具,該掃瞄模組包含:一發光單元,係出射一光線至該條碼;一感測單元,係接收該條碼反射該光線所產生的一反射影像光線,並將該反射影像光線轉換為對應一感測信號,該感測信號具有一對應該條碼的分佈寬度之感測條碼寬度、一條碼起始點、一條碼終止點、一第一空間距離及一第二空間距離,其中該條碼起始點及該條碼終止點分別位於該感測條碼寬度的兩端點,該第一空間距離為該感測信號之起始點至該條碼起始點的距離,該第二空間距離為該感測信號之條碼終止點至該感測信號之終止點的距離;一控制模組,設置於該載具並電連接於該掃瞄模組;其中,該感測信號係傳送至該控制模組,該控制模組係依據該感測信號使該無人駕駛裝置行進,若該感測信號之該第一空間距離與該第二空間距離不相等,該控制模組驅使該無人駕駛裝置修正行進路徑。
- 如申請專利範圍第1項所述之無人駕駛裝置,其中,若該第一空間距離與該第二空間距離相等,該控制模組使該無人駕駛裝置維持行進方向。
- 如申請專利範圍第1項所數之無人駕駛系統,其中該掃描模組更包含一導光單元,該導光單元具有一透光本體,該透光本體包含:一入光面,設置鄰近於該發光單元之出光側,以供接收由該發光單元出射之光線;及 一出光面,相對於該入光面,且朝著相反於該入光面方向凸伸而為一凸面,以擴大該出射光線的出光角度。
- 如申請專利範圍第3項所數之無人駕駛裝置,其中該掃描模組更包含一聚光單元,設置鄰近於該感測單元,以將該反射光線聚焦於該感測模組。
- 如申請專利範圍第4項所述之無人駕駛裝置,其中該聚光單元為一雙凸透鏡。
- 如申請專利範圍第1項所數之無人駕駛裝置,其中該發光單元為一雷射二極體。
- 如申請專利範圍第1項所述之無人駕駛裝置,其中該感測單元為具有光電轉換特性的元件。
- 如申請專利範圍第7項所述之無人駕駛裝置,其中該感測單元為電荷耦合元件或互補性氧化物半導體。
- 如申請專利範圍第1項所述之無人駕駛裝置,其中該掃瞄模組更包含:一微機電模組,設置鄰近於該發光單元及該感測單元;及一反射單元,設置於該微機電模組;其中,微機電模組係帶動該反射單元來回地轉動,藉以將擴大該發光單元之出光角度,以及匯聚該反射光線。
- 如申請專利範圍第1項所述之無人駕駛裝置,更包含一設定單元,設置於該載具,且電連接於該控制模組。
- 一種無人駕駛裝置之操作方法,可藉由至少一物體定義出一空間平面,並規畫於該空間平面的行進路徑,該無人駕駛裝置之操作方法包含: A.提供一發光單元,該發光單元具有一出光角,且朝向一預定方向出射一線型光線;B.提供一感測單元,朝向該預定方向,該感測單元係具有一視角;C.使該出光角與該視角至少部分重疊,產生一重疊區域;D.該感測單元係感測位於該重疊區域內之該物體,並產生一對應的反射影像信號,並將該反射影像信號轉換為一感測信號,其中該感測信號包含有一感測信號寬度及一感測信號深度,其中該感測信號寬度為該感測信號的總寬度,該感測信號深度為該物體與該感測單元間的距離,且該感測信號寬度及該感測信號深度依據該物體與該感測單元間的距離而改變;E.該控制模組係接收該感測信號,並藉由該感測信號寬度及該感測信號深度判斷該物體與該無人駕駛裝置的距離,並該結果儲存於一記憶單元;F.該控制模組係藉由該等感測信號以判斷該無人駕駛裝置是否已旋轉360度;G.該控制模組判斷如果該無人駕駛裝置以確實地旋轉360度,則該控制模組藉由儲存於該記憶單元的該等感測信號以定義出該空間平面;H.該控制模組藉該空間平面以規劃該無人駕駛裝置的行進路徑;I.該控制模組判斷如果該無人駕駛裝置未旋轉360度,則回復步驟A,持續地由該發光單元朝向該未感測方位出射光線。
- 如申請專利範圍第11項所述之無人駕駛裝置之操作方法,更包含一步驟A1,於步驟A之後,提供一導光單元,以擴大該線型光線的出光角度。
- 如申請專利範圍第12項所述之無人駕駛裝置之操作方法,更包含一步驟B0,於步驟B之前,利用一聚光單元使該反射影像光線聚焦於該感測單元。
- 一種無人駕駛裝置之操作方法,該無人駕駛裝置係位於一操作平面,且該操作平面上設置有複數個條碼路徑,且該無人駕駛裝置係被設置於其中之一條碼路徑上,該無人駕駛裝置之操作方法包含:A.利用一發光單元出射一光線,且該光線出射至其中之一條碼路徑;B.利用一感測單元接收一經由該條碼路徑之反射影像光線,並將該反射影像光線轉換為對應該條碼路徑之一感測信號;C.利用一控制模組接收由一設定單元提供的指令資料;D.該控制模組判斷如果該感測信號與該預定路徑信號不相符,且該控制模組判斷如果該預定控制信號為停止行進,則該控制模組送出一控制信號以停止該無人駕駛裝置;E.該控制模組判斷如果該預定控制信號為不停止行進,則該控制模組送出一控制信號以使該無人駕駛裝置尋找一新條碼路徑;以及F.該控制模組判斷如果該感測信號與該預定路徑信號相符,且該控制模組如果判斷該感測信號之一第一空間距離大於一第二空間距離,則送出一控制信號以使該無人駕駛裝置向右修正行進路徑。
- 如申請專利範圍第14項所述之無人駕駛裝置之操作方法,在步驟F之後更包含:G.該控制模組如果判斷該感測信號之該第一空間距離小於該第二空間距離,則送出一控制信號以使該無人駕駛裝置向左修正行進路徑。
- 如申請專利範圍第14項所述之無人駕駛裝置之操作方法,更包含一步驟A1,於步驟A之後,利用一導光單元擴大該發光單元出射之光線的出光角度。
- 如申請專利範圍第16項所述之無人駕駛裝置之操作方法,更包含一步驟B0,於步驟B之前,利用一聚光單元使該反射影像光線聚焦於該感測單元。
- 如申請專利範圍第14項所述之無人駕駛裝置之操作方法,更包含一步驟A1,於步驟A之後,利用一反射單元及一微機電模組擴大該發光單元之光線的出光角度,並匯聚該反射光線。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW100103792A TWI514101B (zh) | 2011-01-31 | 2011-01-31 | 無人駕駛裝置及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW100103792A TWI514101B (zh) | 2011-01-31 | 2011-01-31 | 無人駕駛裝置及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201232213A TW201232213A (en) | 2012-08-01 |
TWI514101B true TWI514101B (zh) | 2015-12-21 |
Family
ID=47069517
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW100103792A TWI514101B (zh) | 2011-01-31 | 2011-01-31 | 無人駕駛裝置及其控制方法 |
Country Status (1)
Country | Link |
---|---|
TW (1) | TWI514101B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI502297B (zh) * | 2013-11-18 | 2015-10-01 | Weistech Technology Co Ltd | Mobile device with route memory function |
TWI657416B (zh) * | 2018-01-09 | 2019-04-21 | 冷中安 | 利用雷射反射定位之無人搬運車架構 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWM252592U (en) * | 2004-02-05 | 2004-12-11 | Jin-Syun Li | Matrix array light of car |
CN1925988A (zh) * | 2004-03-27 | 2007-03-07 | 微型机器人株式会社 | 用于位置自控制机器人的导航系统以及用于提供该导航系统使用的绝对坐标的地板材料 |
TWM348742U (en) * | 2008-06-27 | 2009-01-11 | Inst Of Transportation Motc | Structure improvement of unmanned underwater vehicle |
TW200948333A (en) * | 2008-03-19 | 2009-12-01 | Vorwerk Co Interholding | Automatically displaceable floor-dust collector and object with a sensor arrangement |
TWM370479U (en) * | 2009-07-24 | 2009-12-11 | Chung Shan Inst Of Science | Multi-function robot |
TW201042409A (en) * | 2009-05-20 | 2010-12-01 | Univ Nat Taiwan Science Tech | Mobile robot, method for planning paths of manipulating target objects thereof |
-
2011
- 2011-01-31 TW TW100103792A patent/TWI514101B/zh not_active IP Right Cessation
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWM252592U (en) * | 2004-02-05 | 2004-12-11 | Jin-Syun Li | Matrix array light of car |
CN1925988A (zh) * | 2004-03-27 | 2007-03-07 | 微型机器人株式会社 | 用于位置自控制机器人的导航系统以及用于提供该导航系统使用的绝对坐标的地板材料 |
TW200948333A (en) * | 2008-03-19 | 2009-12-01 | Vorwerk Co Interholding | Automatically displaceable floor-dust collector and object with a sensor arrangement |
TWM348742U (en) * | 2008-06-27 | 2009-01-11 | Inst Of Transportation Motc | Structure improvement of unmanned underwater vehicle |
TW201042409A (en) * | 2009-05-20 | 2010-12-01 | Univ Nat Taiwan Science Tech | Mobile robot, method for planning paths of manipulating target objects thereof |
TWM370479U (en) * | 2009-07-24 | 2009-12-11 | Chung Shan Inst Of Science | Multi-function robot |
Also Published As
Publication number | Publication date |
---|---|
TW201232213A (en) | 2012-08-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9440355B2 (en) | Mobile robot | |
JP6336716B2 (ja) | 障害物感知モジュール及びそれを備えた掃除ロボット | |
KR102527645B1 (ko) | 청소 로봇 및 그 제어 방법 | |
KR102326479B1 (ko) | 청소 로봇 및 그 제어 방법 | |
US10379679B2 (en) | Movable robot capable of providing a projected interactive user interface | |
US9239389B2 (en) | Obstacle sensor and robot cleaner having the same | |
US9180596B2 (en) | Robot cleaner and method of operating the same | |
US9675229B2 (en) | Robot cleaner and method for controlling the same | |
US8081299B2 (en) | Distance measuring apparatus | |
KR102143385B1 (ko) | 장애물 감지 모듈 및 이를 구비한 청소 로봇 | |
KR102335186B1 (ko) | 렌즈 조립체, 이를 이용한 장애물 감지유닛, 및 이를 구비한 이동로봇 | |
JP2013172961A (ja) | センサアセンブリ及びそれを備えたロボット掃除機 | |
JP2014048842A (ja) | 自律移動型機器 | |
US9739874B2 (en) | Apparatus for detecting distances in two directions | |
KR102138724B1 (ko) | 청소 로봇 및 그 제어 방법 | |
US11513525B2 (en) | Server and method for controlling laser irradiation of movement path of robot, and robot that moves based thereon | |
TWM397531U (en) | Detect apparatus and the of detect apparatus from removing apparatus the same | |
KR100632436B1 (ko) | 외부충전장치를 가지는 자율 이동 로봇 시스템 및 그제어방법 | |
KR20140068927A (ko) | 사용자 인터페이스 표시 장치 | |
TWI514101B (zh) | 無人駕駛裝置及其控制方法 | |
KR20120140176A (ko) | 물체 인식을 위한 반사 광학계 및 이를 이용한 이동형 로봇 | |
KR20080093768A (ko) | 주행로봇의 위치감지장치 및 이를 이용한 로봇 청소기 | |
KR20170087006A (ko) | 전방향 장애물 감지 장치, 이를 이용한 자율 이동 로봇 및 자율 이동 로봇의 장애물 감지 방법 | |
KR102007772B1 (ko) | 3차원 공간 측정 장치 및 동작 방법 | |
JP2008139992A (ja) | 自走式装置及び自走式装置誘導システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | Annulment or lapse of patent due to non-payment of fees |