實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... ·...

66
實務專題報告書 機器人設計模組之開發與 : 楊基鑫 專題製作學生: 四技電三乙 于宏業 BD103101 四技電三乙 劉宇軒 BD103083 中華民國 106 5 30 DEPARTMENT OF ELECTRICAL ENGINEERING HSIUPING UNIVERSITY OF SCIENCE AND TECHNOLOGY

Upload: others

Post on 19-Jun-2020

9 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

實務專題報告書

機 器 人 設 計 模 組 之 開 發 與

實 務 設 計 應 用

指 導 老 師 :楊基鑫

專題製作學生:

四技電三乙 于宏業 BD103101

四技電三乙 劉宇軒 BD103083

中華民國 106 年 5 月 30 日

修 平 科 技 大 學 電 機 工 程 系

DEPARTMENT OF ELECTRICAL ENGINEERING

HSIUPING UNIVERSITY OF SCIENCE AND TECHNOLOGY

Page 2: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

2

修 平 科 技 大 學

電機工程系

HSIU-PING UNIVERSITY OF SCIENCE

AND TECHNOLOGY

DEPARTMENT OF ELECTRICAL ENGINEERING

指導老師:楊基鑫

專題製作學生:于宏業、劉宇軒

製作日期:106 年 5 月 30 日

Page 3: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

3

摘要

隨著時代的進步機器人會越來越普及,而若要從零開始製作一台機器

人會耗費許多時間及金錢。而本專題使用Makeblock Ultimate Robot Kit及

mbot這兩組套組,透過套組的方式,以節省在設計機器人骨架所需的時間,

而在透過 mblock(scratch)撰寫機器人程式時,需要了解連接機器人感測器的

相關功能,才能夠準確的寫出所需的功能。

Page 4: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

4

目錄

表目錄 ................................................................................................................... 7

圖目錄 ................................................................................................................... 8

第一章 緒言 ....................................................................................................... 14

1.1研究動機 .................................................................................................... 14

1.2.研究目的 .................................................................................................... 14

1.3.研究流程 .................................................................................................... 14

第二章 Makeblock Ultimate Robot Kit ............................................................. 15

2.1 硬體介紹 ................................................................................................... 15

2.2 Makeblock Orion ....................................................................................... 17

2.3 組裝過程 ................................................................................................... 19

2.4 元件問題 ................................................................................................... 43

第三章 mbot簡介 .............................................................................................. 44

3.1 硬體介紹 ................................................................................................... 44

3.1.1mCore .................................................................................................... 44

3.1.2 Me Ultrasonic Sensor ........................................................................... 45

3.1.3 Me LED Matrix 8X16 .......................................................................... 45

3.1.4 Me Line Follower ................................................................................ 46

Page 5: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

5

3.1.5益眾 A03-M-CNY70 .......................................................................... 46

3.2 目標 ........................................................................................................... 47

第四章 紅外線感測器原理說明及運用 ........................................................... 48

4.1 CNY70簡介 .............................................................................................. 48

4.1.1 CNY70結構 ........................................................................................ 48

4.1.2.CNY70原理 ........................................................................................ 49

4.2 益眾 A03-M-CNY70詳細介紹 ............................................................... 50

4.2.1 益眾 A03-M-CNY70動作說明 ......................................................... 50

4.2.2.益眾 A03-M-CNY70運用 .................................................................. 50

第五章 軟體相關說明 ....................................................................................... 52

5.1 mblock簡介 ............................................................................................... 52

5.2 mbot程式說明 ........................................................................................... 57

5.2.1定義 Read_CNY70 .............................................................................. 57

5.2.2定義 Find_Bottle.................................................................................. 58

5.2.3定義 Find_Bottle-2 .............................................................................. 59

5.2.4.mbot 主程式 ....................................................................................... 60

Page 6: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

6

第六章 結論 ....................................................................................................... 62

參考文獻 ............................................................................................................. 63

附錄 ..................................................................................................................... 64

Page 7: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

7

表目錄

表 1:接口顏色功能表………………………………………………………….18

表 2: A03-M-CNY70感應黑線對應動作表…………………………………..51

Page 8: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

8

圖目錄

圖 1.1:研究流程圖……………………………………………………………..14

圖 2.1:Makeblock Ultimate Robot Kit 零件列表-1…………………………...16

圖 2.2:Makeblock Ultimate Robot Kit 零件列表-2…………………………...16

圖 2.3:主控版Makeblock Orion……………………………………………….17

圖 2.4:所需零件(1)……………………………………………………………..19

圖 2.5:部件成品-1……………………………………………………………...19

圖 2.6:Shaft Connector 4mm大圖……………………………………………..20

圖 2.7:所需零件(2)……………………………………………………………..21

圖 2.8:步驟 1……………………………………………………………………21

圖 2.9:部件成品-2……………………………………………………………...21

圖 2.10:組裝材料及工具………………………………………………………22

圖 2.11:組裝方法……………………………………………………………….22

圖 2.12:成品及注意事項………………………………………………………22

圖 2.13:所需材料(3)……………………………………………………………23

圖 2.14:部件成品-3…………………………………………………………….23

圖 2.15:馬達正面………………………………………………………………24

圖 2.16:部件成品及注意事項…………………………………………………24

Page 9: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

9

圖 2.17:所需材料(4)……………………………………………………………25

圖 2.18:部件成品A…………………………………………………………….25

圖 2.19:部件成品(正面圖)……………………………………………………..25

圖 2.20:所需數量………………………………………………………………25

圖 2.21:所需材料(5)……………………………………………………………26

圖 2.22:步驟-1………………………………………………………………….26

圖 2.23:部分成品底部…………………………………………………………26

圖 2.24:步驟-2………………………………………………………………….27

圖 2.25:部件成品-4…………………………………………………………….27

圖 2.26:所需材料(6)……………………………………………………………28

圖 2.27:步驟-1………………………………………………………………….28

圖 2.28:部件成品 B…………………………………………………………….28

圖 2.29:所需材料(7)……………………………………………………………29

圖 2.30:部件成品-5…………………………………………………………….29

圖 2.31:所需部件成品數量……………………………………………………29

圖 2.32:所需材料(8)……………………………………………………………30

圖 2.33:部件成品-C……………………………………………………………30

圖 2.34:部件成品(俯視圖)……………………………………………………..30

Page 10: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

10

圖 2.35:所需材料(9)……………………………………………………………31

圖 2.36:步驟-1…………………………………………………………………31

圖 2.37:所需數量………………………………………………………………31

圖 2.38:步驟-2………………………………………………………………….32

圖 2.39:部件成品-6…………………………………………………………….32

圖 2.40:所需材料(10)…………………………………………………………..33

圖 2.41:步驟-1………………………………………………………………….33

圖 2.42:部件成品-D……………………………………………………………33

圖 2.43:所需材料(11)…………………………………………………………..34

圖 2.44:步驟 1…………………………………………………………………..34

圖 2.45:部件成品-7…………………………………………………………….34

圖 2.46:所需材料(12)…………………………………………………………..35

圖 2.47:部件成品-E…………………………………………………………….35

圖 2.48:部件成品(背後圖)……………………………………………………..35

圖 2.49:所需材料(13)…………………………………………………………..36

圖 2.50:步驟-1………………………………………………………………….36

圖 2.51:部分部件(正面圖)……………………………………………………..36

圖 2.52:部件成品-F…………………………………………………………….36

Page 11: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

11

圖 2.53:所需材料(14)…………………………………………………………..37

圖 2.54:步驟-1………………………………………………………………….37

圖 2.55:部分部件(正面圖)……………………………………………………..37

圖 2.56:步驟-2………………………………………………………………….38

圖 2.57:部件成品-G……………………………………………………………38

圖 2.58:所需材料(15)…………………………………………………………..39

圖 2.59:步驟-1………………………………………………………………….39

圖 2.60:部件成品(正面圖)……………………………………………………..39

圖 2.61:部件成品-H……………………………………………………………39

圖 2.62:所需材料(16)…………………………………………………………..40

圖 2.63:部件成品-I……………………………………………………………..40

圖 2.64:所需材料(17)…………………………………………………………..41

圖 2.65:步驟-1………………………………………………………………….41

圖 2.66:步驟-2………………………………………………………………….41

圖 2.67:部件成品-8…………………………………………………………….41

圖 2.68:所需材料(18)…………………………………………………………..42

圖 2.69:機體成品………………………………………………………………42

圖 2.70:Beam 0808-88,鋁製框架受損……………………………………….43

Page 12: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

12

圖 2.71:Track,栓孔龜裂……………………………………………………….43

圖 3.1:mCore主控版…………………………………………………………...44

圖3.2:Me Ultrasonic Sensor……………………………………………………45

圖3.3:Me LED Matrix 8X16…………………………………………………...45

圖 3.4:Me Line Follower……………………………………………………….46

圖 3.5:益眾 A03-M-CNY70…………………………………………………...46

圖4.1:CNY70結構……………………………………………………………..48

圖 4.2:CNY70接線圖………………………………………………………….49

圖 5.1:mblock介面……………………………………………………………..52

圖 5.2:動作方塊………………………………………………………………..53

圖 5.3:外觀方塊………………………………………………………………..53

圖 5.4:聲音方塊………………………………………………………………..53

圖 5.5:畫筆方塊………………………………………………………………..54

圖 5.6:聲音和指令方塊……………………………………………….……….54

圖 5.7:事件方塊………………………………………………………………..54

圖 5.8:控制方塊 ………………………………………………………………..55

圖 5.9:偵測方塊………………………………………………………………..55

圖 5.10:運算方塊………………………………………………………………55

Page 13: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

13

圖 5.11:機器人模組方塊……………………………………………………….56

圖 5.12:定義 Read_CNY70程式………………………………………………57

圖 5.13:益眾 A03-M-CNY70設定數位腳位………………………………….57

圖 5.14:Find_Bottle-1…………………………………………………………..58

圖 5.15:Find_Bottle-2…………………………………………………………..59

圖5.16:mbot 主程式(無表情)…………………………………………………61

圖5.17:mbot 主程式(有表情)…………………………………………………61

Page 14: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

14

第一章 緒言

1.1研究動機

讓生活更便利是人們所追尋的,到了近代有許多便利的機器人已經發

展出來了,適合家庭使用的打掃/拖地機器人;適合工業用的機械手臂;適

合探勘災區/危險處理的履帶機器人、無人(飛)機、爆裂物處理機器人。

但要從頭開始製作具有功能性的機器人,需要耗費大量的時間以及金錢,

因此我們透過Makeblock Ultimate Robot Kit及 mbot這兩組套組,以達節省

時間及成本。

1.2.研究目的

藉由Makeblock Ultimate Robot Kit及 mbot這兩組套組的組裝,了解其

自由度,從中得知優缺點,並透過程式撰寫的方式,以達到所需的功能。

1.3.研究流程

圖 1.1:研究流程圖

Page 15: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

15

第二章 Makeblock Ultimate Robot Kit

2.1 硬體介紹

Makeblock Ultimate Robot Kit是一款可以讓你容易組裝、撰寫程式的一

件套組,此套組擁有六個感測器,而結構骨架是能長時間使用的堅固擠壓

鋁件結構,而軟體方面除了Mblock以外,也可以用 makeblock app來操作。

圖 2及圖 3為本套組所有零件表。

Page 16: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

16

圖 2.1:Makeblock Ultimate Robot Kit 零件列表-1

圖 2.2:Makeblock Ultimate Robot Kit 零件列表-2

Page 17: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

17

2.2 Makeblock Orion

Makeblock Orion 是一個基於 Arduino Uno針對教學用途,升級改進的

主控板。它擁有強大的驅動能力,輸出功率可達 18W,可以驅動 4個直流

馬達。精心設計的色標體系,與感測器模組完美匹配。8個獨立的 RJ25接

口,輕鬆實現電路連接。

另外,它不僅支持絕大多數 arduino 編程工具(Arduino /Scratch / adublock ),

而且我們提供了兩種 Scratch升級版的圖形編程工具(Mblock/ Makeblock

HD)。

圖 2.3:主控版Makeblock Orion

Page 18: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

18

而Makeblock Orion這塊板子共有六種不同的顏色,有紅色、黃色、藍

色、灰色、黑色、和白色,而這六種顏色都代表各自功能,而這六種顏色

可以對應到Makeblock的各項主控版。

顏色 功能 模組

紅色代表輸出電壓值為 6-12v,通常他會

鏈接到需要 6-12v電壓的電機驅動模塊

1.馬達驅動模組

2.舵機驅動模組

3.步進馬達驅動模組

單向數字接口(黃色) 1.超聲波模組

2.彩色 LED模組

3.限位開關

雙向數字接口(藍色) 1.七段數碼管模組

2.人體紅外傳感器模組

3.快門線模組

4.巡線傳感器模組

5.紅外接收模組

硬件串口(灰色) 1.雙模藍牙模組

雙向或單向模擬信號接口(黑色) 1.光線和灰度傳感器模組

2.電位器模組

3.搖桿

4.按鍵模組

5.聲音傳感器模組

I²C 接口(白色) 1.陀螺儀模組

表 1:接口顏色功能表

Page 19: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

19

2.3 組裝過程

此套組主要以 Robotic Arm Tank(機械手臂坦克車)為主,以下為本機器

人組裝過程圖

第一步驟(部件成品-1)

圖 2.4:所需零件(1)

Timing Pulley

90T*1

Screw M4*14*2

Shaft Connector

4mm*1

圖 2.5:部件成品-1

Page 20: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

20

注意:這個元件有四個孔洞,其中有兩個有螺絲紋,螺絲必須鎖在有螺絲紋上

圖 2.6:Shaft Connector 4mm大圖

Page 21: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

21

第二步驟(部件成品-2)

圖 2.7:所需零件(2)

Timing Pulley 90T*1

Flange bearing 4*8*3mm*2

Shaft Coller 4mm*1

HeadlessSetScrewM3*5*1

Plastic Ring 4*7*2*1

Threaded Shaft 4*39*1

圖 2.8:步驟 1

先將 Flange bearing 4*8*3mm鑲在

Timing Pulley 90T裡,在將其他零

件依序裝進去。

圖 2.9:部件成品-2

Page 22: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

22

注意: Shaft Coller 4mm 和 HeadlessSetScrewM3*5組裝

圖 2.10:組裝材料及工具

材料

Shaft Coller 4mm*1

HeadlessSetScrewM3*5*1

工具

Hex Allen Key 1.5mm*1

圖 2.11:組裝方法

1.先將 HeadlessSetScrew

裝在 Hex Allen Key

1.5mm,然後將

HeadlessSetScrew鎖在

Shaft Coller的螺絲孔上。

圖 2.12:成品及注意事項

鎖上去後,不要鎖到底,

讓 Shaft Coller中間呈現中

空,等到要卡住其他零件

時,才要將它鎖緊。

Page 23: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

23

第三步驟(部件成品-3)

圖 2.13:所需材料(3)

DC Motor-25*1

DC Motor-25

Bracket*1

Screw M3*8*2

圖 2.14:部件成品-3

Page 24: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

24

注意: DC Motor-25組裝

圖 2.15:馬達正面

馬達正面有兩個未

鎖上螺絲的孔洞

圖 2.16:部件成品

及注意事項

螺絲要鎖在未鎖上

螺絲的孔洞上,而

DC Motor-25

Bracket的凸出部

分,必須要與馬達

接線孔形成對立。

Page 25: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

25

第四步驟(部件成品 A)

圖 2.17:所需材料(4)

部件成品 1~3*1

Beam 0824-144*1

Plastic Ring 4*7*2*1

Nut M4*1

Screw M4*14*2

圖 2.18:部件成品 A

圖 2.19:部件成品(正面圖)

圖 2.20:所需數量

部件成品 A*2

Page 26: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

26

第五步驟(部件成品-4)

圖 2.21:所需材料(5)

Beam 0824-96*2

Bracket 3*3*2

Beam 0808-88*2

Screw M4*14*4

Screw M4*30*2

Nut M4*2

圖 2.22:步驟-1

先將 Beam 0824-96和兩個

Beam 0808-88鎖在一起。

圖 2.23:部分成品底部

Page 27: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

27

圖 2.24:步驟-2

然後將部分成品和 Beam

0824-96及兩個 Bracket 3*3再

鎖在一起。

圖 2.25:部件成品-4

Page 28: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

28

第六步驟(部件成品 B)

圖 2.26:所需材料(6)

部件成品-A*2

部件成品-4*1

Screw M4*14*4

Nut M4*4

圖 2.27:步驟-1

將兩個部件成品-A和

部件成品-4*1鎖在一起。

圖 2.28:部件成品 B

Page 29: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

29

第七步驟(部件成品-5)

圖 2.29:所需材料(7)

Beam 0808-88*2

Plate 45o*4

Screw M4*14*8

Nut M4*8

圖 2.30:部件成品-5

圖 2.31:所需部件成品數量

Page 30: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

30

第八步驟(部件成品-C)

圖 2.32:所需材料(8)

部件成品-B*1

部件成品-5*2

Screw M4*8*4

圖 2.33:部件成品-C

圖 2.34:部件成品(俯視圖)

Page 31: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

31

第九步驟(部件成品-6)

圖 2.35:所需材料(9)

Beam 0808-184*4

Beam 0824-80*1

Beam 0824-64*2

Plate 3*6*2

Screw M4*14*12

Screw M4*8*4

Nylon Lock Nut M4*4

圖 2.36:步驟-1

先將兩個 Beam 0808-184和

Beam 0824-64鎖在一起。

圖 2.37:所需數量

Page 32: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

32

圖 2.38:步驟-2

將兩個相同部件用 Nylon

Lock Nut M4鎖在兩個 Plate

3*6上,之後再將 Beam

0824-80鎖上去。

圖 2.39:部件成品-6

Page 33: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

33

第十步驟(部件成品-D)

圖 2.40:所需材料(10)

部件成品-C*1

部件成品-6*1

D Shaft 4*128mm*2

Timing Pulley 62T*1

Timing Belt 240MXL*1

Shaft Coller 4mm*8

HeadlessSetScrewM3*8

Flange bearing 4*8*3mm*2

Plastic Ring 4*7*2*2

Screw M4*22*1

Nut M4*1

圖 2.41:步驟-1

先將上方插入 D Shaft

4*128mm,然後再將下方鎖

好。

圖 2.42:部件成品-D

Page 34: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

34

第十一步驟(部件成品-7)

圖 2.43:所需材料(11)

DC Motor-37*1

DC Motor-37 Bracket*1

Bracket 3*6*1

Timing Pulley 18T*1

Screw M3*8*4

Screw M4*8*2

Nut M4*2

圖 2.44:步驟 1

先將 DC Motor-37

Bracket依孔洞鎖在 DC

Motor-37上,然後再將

Bracket 3*6鎖上去。

圖 2.45:部件成品-7

Page 35: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

35

第十二步驟(部件成品-E)

圖 2.46:所需材料(12)

部件成品-D*1

部件成品-7*1

Screw M4*8*2

圖 2.47:部件成品-E

圖 2.48:部件成品(背後圖)

Page 36: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

36

第十三步驟(部件成品-F)

圖 2.49:所需材料(13)

部件成品-E*1

Robot Gripper*1

Plate 3*6*1

Screw M4*8*4

Screw M4*14*2

Nut M4*2

圖 2.50:步驟-1

先將 Plate 3*6鎖在 Robot Gripper

上。

圖 2.51:部分部件(正面圖)

圖 2.52:部件成品-F

將部分部件鎖在部件成品-E

Page 37: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

37

第十四步驟(部件成品-G)

圖 2.53:所需材料(14)

BaseBracket*1

Makeblock Orion*1

Screw M4*8*4

Screw M4*14*6

Nut M4*4

Nylon Stud M4*30*4

Plastic Ring 4*7*2*6

圖 2.54:步驟-1

先將Makeblock Orion鎖在

BaseBracket透明板上。

圖 2.55:部分部件(正面圖)

Page 38: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

38

圖 2.56:步驟-2

將四個 Nylon Stud M4*30鎖

在透明板上,之後再鎖上車

子底部。

圖 2.57:部件成品-G

Page 39: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

39

第十五步驟(部件成品-H)

圖 2.58:所需材料(15)

Battery Holder for (6)AA*1

BaseBracket*1

Screw M4*8*6

Nut M4*2

圖 2.59:步驟-1

將 Battery Holder for (6)AA鎖在

BaseBracket透明板上。

圖 2.60:部件成品(正面圖)

圖 2.61:部件成品-H

Page 40: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

40

第十六步驟(部件成品-I)

圖 2.62:所需材料(16)

部件成品-H*1

Me Bluetooth Module*1

Me Dual Motor Driver*1

Me RJ25 Adapter*1

Screw M4*8*3

圖 2.63:部件成品-I

每個模組都只用一個

Screw M4*8鎖上即可

Page 41: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

41

第十七步驟(部件成品-8)

圖 2.64:所需材料(17)

Track*19(2)

Track Axle*19(1)

圖 2.65:步驟-1

將兩個Track用Track Axle拴

圖 2.66:步驟-2

然後依序拴住 Track,共用 19

個 Track和 19個 Track Axle

圖 2.67:部件成品-8

而需要兩個履帶共用 38 個

Track及 38個 Track Axle

Page 42: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

42

第十八步驟(機體成品)

圖 2.68:所需材料(18)

部件成品-8

Terminal Block*4

Motor Cable*4

RJ25 Cable-25cm*1

RJ25 Cable-30cm*2

圖 2.69:機體成品

Page 43: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

43

2.4 元件問題

圖 2.70:Beam 0808-88,鋁製

框架受損

在鎖部件成品-7及部件成品

-I時,由於不能百分之百水

平地的鎖上去,所以會造成

鋁製框架受損。

圖 2.71:Track,栓孔龜裂

在操作 Robotic Arm Tank

時,突然發現 Track(履帶)條

鬆脫,然後一查才看到有地

方龜裂。

由於不好用一般的方式呈現

龜裂的地方,因此用螺絲撐

住。

Page 44: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

44

第三章 mbot簡介

3.1 硬體介紹

3.1.1mCore

mCore系列是專為mBot設計的易於使用的主控板,集成了各種感應器,

如蜂鳴器、光線感應器、RGB LED等。擁有四色標記的 RJ25連接器,方

便佈線和擴展更多的 Arduino感測器。而若要知道這四個顏色的功能可參考

表 1。

圖 3.1:mCore主控版

Page 45: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

45

3.1.2 Me Ultrasonic Sensor

Me Ultrasonic Sensor 是一個超音波傳感器,板載 LED指示燈用於除錯和訊

息回饋使用 RJ25 介面,使用者將更方便的去使用它。

偵測距離 3 公分到 4 公尺,角度為 30 度範圍以內。

圖 3.2:Me Ultrasonic Sensor

3.1.3 Me LED Matrix 8X16

Me LED Matrix 8X16是一個 8×16的點矩陣,有 128個藍色 LED。

透過Mlock(scratch)編程可使機器人顯示簡單的動畫、文字或各種情緒表

情。

圖 3.3:Me LED Matrix 8X16

Page 46: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

46

3.1.4 Me Line Follower

Me Line Follower有兩組感測器每個感測器有一個反射式紅外線發射

LED,及高靈敏度光電晶體管偵測元件,讓 mbot能夠沿著白色背景上的黑

色線條移動,或是黑色背景上的白色線條移動。

圖 3.4:Me Line Follower

3.1.5益眾 A03-M-CNY70

A03-M-CNY70是益眾整合了 5顆 CNY70所做的感測器。

本模組會在紅外線感測器原理說明及運用這個章節詳細說明。

圖 3.5:益眾 A03-M-CNY70

Page 47: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

47

3.2 目標

本次專題為了表現出套組機器人的可行性,我們將參加在修平舉辦的

亞洲智慧型機器人大賽中的 mbot方程式及自走車拐彎抹角,盡量取得優秀

名次,而參加比賽需要需要了解益眾 A03-M-CNY70相關功能及 mblock程

式撰寫,因此將開始講解相關事項。

Page 48: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

48

第四章 紅外線感測器原理說明及運用

4.1 CNY70簡介

4.1.1 CNY70結構

光濾波器:唯一僅讓波長為紅外線附近光譜通過的濾光透境,可用來加

強光電晶體的雜抗訊能力(紅外線以外不可見與可見光的干擾)。

紅外線發光二極體:類似發光二極體(LED)的功能,當 PN 兩端加上順

向偏壓時可發出波長為 800nm 的紅外線不可見光。

光電晶體:為一個對紅外線波長具敏感反應的光偵測元件,當光電晶體

受紅外線光照射時為低阻抗,而未受光時呈現高阻抗。

圖 4.1:CNY70結構

Page 49: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

49

4.1.2.CNY70原理

當 CNY70偵測到黑色,光電晶體未導通,A0輸出低電位

當 CNY70偵測到白色,光電晶體導通,A0輸出高電位

圖 4.2:CNY70接線圖

Page 50: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

50

4.2 益眾 A03-M-CNY70詳細介紹

4.2.1 益眾 A03-M-CNY70動作說明

益眾 A03-M-CNY70是益眾科技股份有限公司設計的模組,原先一般的

紅外線感測器是偵測到黑色,A0輸出低電位,白色輸出高電位,而益眾

A03-M-CNY70設計成當 CNY70偵測到黑色,A0輸出高電位;當 CNY70

偵測到白色,A0輸出低電位。

4.2.2.益眾 A03-M-CNY70運用

由於 CNY70偵測到黑色,A0輸出高電位,因此在撰寫程式上,必須

有所變動。下表是 A03-M-CNY70感應黑線對應動作表

Page 51: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

51

24 23 22 21 20 功能

0 0 1 0 0 4 前進

0 0 0 1 0 2 向右微修

0 0 1 1 0 6

0 1 0 0 0 8 向左微修

0 1 1 0 0 12

0 0 1 1 1 7 急右轉

0 1 1 1 1 15

1 1 1 1 0 30 急左轉

1 1 1 0 0 28

0 0 0 0 1 1 右轉

0 0 0 1 1 3

0 1 0 0 0 16 左轉

1 1 0 0 0 24

表 2: A03-M-CNY70感應黑線對應動作表

Page 52: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

52

第五章 軟體相關說明

5.1 mblock簡介

mBlock是以 Scratch 2.0為基礎所發展出來的圖形化程式軟體﹐透過簡

單地拖放功能性積木﹐就能製作程式專案與互動性應用程式。

而 mblock的程式區分別有動作、外觀、聲音、畫筆、資料和指令、事件、

控制、偵測、運算、機器人模組,共有 10種。

圖 5.1:mblock介面

以下分別介紹每個程式區所擁有的功能

Page 53: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

53

圖 5.2:動作方塊 圖 5.3:外觀方塊 圖 5.4:聲音方塊

Page 54: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

54

圖 5.5:畫筆方塊 圖 5.6:聲音和指令方塊 圖 5.7:事件方塊

Page 55: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

55

圖 5.8:控制方塊 圖 5.9:偵測方塊 圖 5.10:運算方塊

Page 56: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

56

圖 5.11:機器人模組方塊

Page 57: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

57

5.2 mbot程式說明

在mbot方程式及自走車拐彎抹角中,需要運用避障、循跡及表情模組,

而本次專題設計了幾個程式,以下說明程式功能

5.2.1定義 Read_CNY70

功能:這是益眾 A03-M-CNY70設定的功能,當黑線碰到圖 2-1其中一格時,

就會輸出相對應位子的訊號。

例子:當黑線碰到 15上面那格時,該格就會輸出訊號。

目的:為了能夠在發生某些情況後,能夠回到特定的位子。

圖 5.12:定義 Read_CNY70程式

圖 5.13: 益眾 A03-M-CNY70設定數位腳位

Page 58: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

58

5.2.2定義 Find_Bottle

功能:在第一次遇到障礙物時,會先左轉 0.25秒在前進 0.85秒之後再右

轉 0.45秒;第二次避障則是相反。

目的:自走車拐彎抹角這項在比賽中有兩個須避障物品,第一個避障物品

右邊就是場地邊界,第二個物品左邊就是場地邊界,為了能夠不超過邊界,

而寫的程式。

缺點:避障角度過大,容易因電力問題而出問題。

圖 5.14:Find_Bottle-1

Page 59: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

59

5.2.3定義 Find_Bottle-2

功能:先原地右轉 0.4秒,0.4秒後前進偏左 0.4秒,0.4秒後大幅度左轉

0.3秒,0.3秒後前進偏左 0.3秒,當數位 15前都前進偏左,當遇到數位 17

後前進偏右。

目的:能夠比三角避障還要精確地方式避障,而且能夠套用第一、二避

障物品。

圖 5.15:Find_Bottle-2

Page 60: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

60

5.2.4.mbot 主程式

以下為 mbot方程式及自走車拐彎角的主程式,其中 mbot方程式的主

程式有紅外線循跡及表情模組,而自走車拐彎角只有紅外線循跡。

功能:當按下板載按鈕,才會開始動作,而當 CNY70=??就會執行前面

「紅外線感測器原理說明及運用-益眾A03-M-CNY70運用」所敘述的功能,

而表情模組則是,當碰到 CNY70=31,表情模組+1

缺點:在某些程式條件並沒寫的太詳細,因此當電力過強,有時會發生

問題;而表情模組則是,最高只會計數到 3

Page 61: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

61

圖 5.16:mbot 主程式(無表情) 圖 5.17:mbot 主程式(有表情)

Page 62: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

62

第六章 結論

隨著時代的進步,機器人會越來越普及,除了自己設計、切削零件外,

我們可以使用套組機器人來省去從零開始的窘境,雖然會被原先設計的框

架給限制住它的外型,但整體來說很方便,而在程式方面可以使用 mblock

來撰寫程式,mblock可以讓人很容易就入手,對不會寫 Arduino程式的人

來說,是個很不錯的選擇。

Page 63: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

63

參考文獻 [1] Ultimate robot kit 1

http://www.smart-robot.com.tw/mobile/product_d.php?lang=tw&tb=1&id=157

&cid=49

[2] Makeblock電子模組手冊-Makeblock Orion

http://magiccar.let-do.com/forum.php?mod=viewthread&tid=410

[3] 07_mBot機器人-循線感應器的應用:mBot小姐走台步

http://syps104maker.blogspot.tw/2016/02/07mbotmbot.html

[4] 感測器要如何選購

https://tw.answers.yahoo.com/question/index?qid=20070329000015KK10543

[5] 雄:Arduino : CNY70

http://gsyan888.blogspot.tw/2013/04/arduino-cny70.html

[6] 益眾科技股份有限公司

http://www.icci.com.tw/

[6] Ultimate robot kit終極機器人說明書

Page 64: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

64

附錄

Page 65: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

65

Page 66: 實務專題報告書 - ir.hust.edu.twir.hust.edu.tw/bitstream/310993100/6150/1/7... · 紅色代表輸出電壓值為6-12v,通常他會 鏈接到需要6-12v 電壓的電機驅動模塊

66