自動堆垛式載運機器人設計含SW三維及10張CAD圖

自動堆垛式載運機器人設計含SW三維及10張CAD圖,自動,堆垛,載運,機器人,設計,SW,三維,10,CAD 2012 年全國職業院校技能大年全國職業院校技能大賽中職組機器人賽項賽中職組機器人賽項 ZKRT300 自動堆垛式載運機器人說明手冊自動堆垛式載運機器人說明手冊 北京中科遠洋科技有限公司北京中科遠洋科技有限公司 2 目目 錄錄 一.主要功能 3 二.性能參數4 三.操作說明5 四.使用維護6 五.裝配調試說明6 3 一、主要功能：ZKRT-300型自動堆垛式載運機器人是面向職業教育類、工程教育類學生教學與實訓而開發的教學機器人。它體現了基于工程設計的機械機構、機械傳動技術和控制技術的完美結合，基于工程設計理念而開發，結構精巧，符合工程化設計標準，典型機構運用別具匠心，采用工業傳感器，工程化布線、接線，融合多項核心專利技術開發而成。本產品非常適合于中等職業教育和高等職業教育類學生機器人課程的教學以及機器人競賽使用。ZKRT-300型自動堆垛式載運機器人由機器人行走底盤、回轉機構、升降機構、平移機構、手爪機構以及單片機控制系統組成。主要可實現如下功能：1、循線計數行走、路徑規劃；2、自動取物、自動堆垛；3、多種貨物取放任務方案可自由設計；4、可自行更換手爪結構以滿足不同尺寸、形狀貨物的抓取任務。結構說明見圖1-1：圖1-1 ZKRT-300型自動堆垛式載運機器人結構 4 二性能參數說明二性能參數說明 1、設備組成設備組成 ZKRT-300 型自動堆垛式載運機器人由機械本體、微電腦控制系統、傳感器系統組成。2、設備主要參數及規格設備主要參數及規格 最大外形尺寸：（長 X 寬 X 高）650mmX360mmX650mm 底盤尺寸：（長 X 寬 X 高）365mmX280mmX140mm 手爪行程：30mm 升降行程：230mm 平移行程：430mm 回轉角度：90 度/次 回轉精度：3 手爪抓取方式：上下移動、平行夾緊 最大抓取物尺寸：80mm 額定抓取重量：0.5Kg 最大載重：6Kg 直線運行速度：Max 0.5 m/S 縱向白條定位精度：3mm 自動導引傳感器：專用 8 路光學循跡傳感器 電池組工作電壓：U=24VDC 電池續航時間：1 小時 充電方式：外置充電器 最大噪音：65db 5 三操作說明三操作說明 1、操作面板、操作面板 圖圖 3-1 操作面板操作面板 2、操作說明、操作說明（1）開電源時先打開 12V 電源開關，再打開 24V 電源開關；關電源時按以上順序反向操作。（2）當電源/低電指示燈由綠色轉為紅色時為低電報警，此時需連接外置充電器充電或更換電池組。（3）控制系統支持在線下載程序，將連接電腦的串口線連接至面板上的下載口按下載軟件操作指示下載程序。6 四、使用維護說明：四、使用維護說明：1、人推動小車時必須關閉所有電源開關，推動速度不宜過快，以免電機反電勢過大損壞驅動器。2.光學循跡傳感器在機器人前部下方，搬運過程中注意不得重壓循跡傳感器。3.機器人長期不用時，請務必將電池組充滿電，并關閉所有電源開關。五、裝配調試說明五、裝配調試說明（一）、機械結構裝配（一）、機械結構裝配 1、主要裝配任務、主要裝配任務 A、行走輪組件裝配 B、槽輪回轉機構裝配 C、絲杠升降機構裝配 D、同步帶平移機構裝配 E、雙曲線槽輪手爪機構裝配 F、總裝 2、使用工具、使用工具 A、內六角扳手 1 套 B、孔用卡簧鉗 1 把、軸用卡簧鉗 1 把 C、6活絡扳手 1 把 D、尖嘴鉗 2 把 E、十字螺絲刀 2 把 F、一字螺絲刀 1 把 G、小錘子 1 把 H、平口鉗（80mm）1 臺 I、25、34 銅棒各一根 J、潤滑油槍 1 把 7 3、裝配示意圖、裝配示意圖（1）車輪部件裝配示意圖 圖 5-1 車輪部件裝配示意圖（2）底盤部件裝配示意圖 8 圖 5-2 底盤部件裝配示意圖 9（3）回轉部件裝配示意圖 圖 5-3 回轉部件裝配示意圖 10（4）升降部件裝配示意圖 圖 5-4 升降部件裝配示意圖 11（5）平移部件裝配示意圖 圖 5-5 平移部件裝配示意圖 12（6）手爪部件裝配示意圖 圖 5-6 手爪部件裝配示意圖 13（7）整機裝配完成示意圖 圖 5-7 整機裝配完成示意圖 14（二）、電氣接線（二）、電氣接線 1、主要接線任務、主要接線任務 A、電機線走線 B、傳感器安裝、走線 C、電路板走線 D、壓線端子、穿線號 E、接線 F、電纜拖鏈安裝 2、使用工具、使用工具 A、內六角扳手 1 套 B、十字螺絲刀 2 把 C、一字螺絲刀 1 把 D、尖嘴鉗 1 把 E、剝線鉗 1 把 F、壓線鉗 1 把 G、萬用表 1 只 H、電鉻鐵 1 把 I、斜口鉗 1 把 3、電路板的安裝、電路板的安裝 1 將傳感器信號處理板、電機驅動板、主控制板固定在機器人底盤上。2 連接信號線：按照圖 5-8 所示，先連接三塊電路板之間的接線，具體為：用 10 芯排線連接 8 路巡線傳感器的輸出和傳感器信號處理板的傳感器輸入接口；用 10 芯排線連接傳感器信號處理板的信號輸出接口與主控制板的 8 路傳感器輸入接口；面板上的啟動按鈕連接主控制板的啟動按鈕插座；用 10 芯排線連接主控制板的行走電機接口與電機驅動板的行走電機接口；用 10 芯排線連接主控制板的電機 12 接口與電機驅動板的電機 12 接口；用 10 芯排線連接主控制板的電機 34接口與電機驅動板的電機 34 接口。3 連接電源線：面板上的 12V 開關電源線連接電機驅動板的 12V 電源輸 15 入插座；驅動板的 12V 電源輸出插座連接傳感器信號處理板的 12V 電源輸入插座；驅動板的 12V 電源輸出插座連接主控制板的 12V 電源輸入插座；面板上的 24V 電源連接電機驅動板的 24V 電源插座。連接電源時，務必確認主板上電源插座的正負極，切勿插反確認主板上電源插座的正負極，切勿插反。4 接線排連線：如圖 5-9 所示，機器人上部安裝了 2 個接線排，機器人上部 10 個接近傳感器和 4 個電機的連線全部通過接線排實施連接，在連線時需要注意每根線上面的線號，接在接線排相同標號處。+12VGNDTO：主板FROM：驅動板FROM：傳感器傳感器板接線圖 16 圖 5-8 線路板之間連接示意圖 圖5-9 接線排的接線 接線排1接線圖 17（三）、機器人控制系統說明（三）、機器人控制系統說明 1、概述、概述 機器人控制系統包括 8 路巡線傳感器、傳感器信號處理板、主控制板、電機驅動板組成。組成框圖如圖 5-10 所示 圖 5-10 機器人控制系統組成框圖 2、主控制板、主控制板 1概述 主控制板是機器人的大腦，承擔著信息接收、處理、外部設備控制的重要任務，主控制板中處理器選用了 STC12C5A60S2 芯片為主控芯片，控制板支持兩大類輸入，既 8 通道專用巡線傳感器輸入，和 12 個接近傳感器輸入（實際使用了 10 個）；輸出也是支持 2 大類，即可調速行走電機控制輸出和不可調速行走電機控制輸出。STC12C5A60S2 單片機是宏晶科技生產的單時鐘/機器周期(1T)的單片機，是高速/低功耗/超強抗干擾的新一代 8051 單片機，指令代碼完全兼容傳統 8051,但速度快 8-12 倍。內部集成 MAX810 專用復位電路,2 路 PWM,8路高速 10 位 A/D 轉換(250K/S),抗干擾能力強，適合應用在強干擾場合。具體功能和參數可以參考 STC12C5A60S2 數據手冊。18 主控制板使用的是 40 個引腳的單片機，共有 35 個 I/O 接口。主控制板實物如圖 5-11 所示。圖中，12V 電源輸入插座連接 12V 電源，12V 電源輸出插座連接傳感器信號處理板的 12V 電源插座（注意板子上的電源正極標志，不要插反），巡線傳感器輸入接口用于連接傳感器信號處理板，啟動按鈕輸入插座連接面板上啟動按鈕，左右車輪電機接口連接驅動板上的電機信號控制插座，程序下載接口用于程序的在線下載，8 通道傳感器輸入接口可以用于連接 8 個 NPN 型傳感器，非調速電機輸出接口用于上部機構各種電機的控制。圖 5-11 主控制板實物圖 主控制板的信號流程圖如圖 5-12 所示 圖 5-12 主控制板信號流程圖 10 通道接 近 開關輸入 電機 12 輸出接口 電機 34 輸出接口 12V 電源，上端為正 下載口 行走電機 輸出接口 19 2.巡線傳感器輸入接口 電路板上 JM15 插座即為巡線傳感器輸入接口，主要是用于接收 8 路巡線傳感器信號。312 路接近傳感器輸入接口 12 路接近傳感器輸入接口連接了機器人上部機構的 10 個接近開關，用于探測運動機構位置，其中 4 路輸入接口電路圖如圖 5-13 所示。圖 5-13 4 通道傳感器輸入接口 圖中，展示了 4路傳感器輸入接口，輸入信號使用了單片機的P3.3-P3.6口，插座 JM11-JM14 分別接 4 個傳感器，傳感器使用了接近傳感器，用于探測一些運動部件是否到位，探測距離一般在 5mm 以下，需要注意的是，裝在機器人手爪上的圓柱形接近傳感器探測距離在 1mm 左右，安裝的時候需要特別注意。傳感器上有 3 根引線，分別接 JM11-JM14 的 3 個引腳。圖 5-13 所示的的電路均為低電平有效低電平有效，即傳感器探測到目標時，反相器輸出端即單片機的 P3.3-P3.6 腳為低電平信號，否則為高電平。4PWM 和電機方向控制電路 PWM 和電機方向控制電路如圖 5-14 所示，STC12C5A60S2 本身具有 2 路 20 PWM 輸出，即 P1.3 和 P1.4 為 PWM 輸出端口，分別控制左（P1.4 控制）右（P1.3控制）電機的轉速，單片機 PWM 的設置請詳見 STC12C5A60S2 數據手冊。圖 5-14 中，P15 和 P12 分別是左（P1.5 控制）右（P1.2 控制）電機的方向控制信號，需要注意的是，P1.5 和 P1.2 是低電平有效，即 P1.5 和 P1.2是低電平時，行走電機反轉。圖 5-14 PWM 和電機方向控制電路 5非調速電機輸出接口 本電路板上設置了 8 個非調速電機輸出接口，可以用來控制機器人上部機構中 4 個正反轉直流電機，電路圖如圖 5-15 所示 圖 5-15 非調速電機輸出接口 21 圖 5-15 中，DJ1Z、DJ1F 為電機 1 控制信號，DJ2Z、DJ2F 為電機 2 控制信號，DJ3Z、DJ3F 為電機 3 控制信號，DJ4Z、DJ4F 為電機 4 控制信號。輸出接口與單片機的連接如圖 5-16 所示。4 個電機的 8 個控制信號使用了單片機的 P2.0-P2.3 引腳，需要注意，這些信號均是低電平有效。為了節省引腳，在此處利用 74HC373 鎖存器實現引腳復用，當 P1.7 為低電平時，P2.0-P2.3 的信號發送給 DJ1Z-DJ2F，當P1.7 為高電平時，P2.0-P2.3 的信號發送給 DJ3Z-DJ4F，而 DJ1Z-DJ2F 的信號保持原來的數值。圖 5-16 輸出接口與單片機的連接圖 6下載接口 本電路板上有一個 DB9 串口接口，可以用來實現程序的在線下載。在線下載的主要步驟為：1）首先關閉本電路板的 12V 電源，取出串口連接線。一頭接本電路板的 DB9 下載口，另一頭接 PC 機箱后的 9 針串口。如果你的電腦后面沒有空余 9 針串口，可以使用 USB 轉串口轉接頭。22 2）打開 STC-ISP 在線下載軟件，進行程序的下載，具體操作方法見STC12C5A60S2 數據手冊；下載完畢，從電路板上取下串口下載線。3、巡線傳感器巡線傳感器 機器人底部安裝了 8 路巡線傳感器，可以可靠地探測到地面白條以及白條的十字交叉點。傳感器光源發射部分采用了 8 個高亮 LED 發射管，用 8 個光敏電阻接受地面反射回來的光線，輸出插座連接傳感器信號處理板的巡線傳感器輸入接口。4、傳感器信號處理板傳感器信號處理板 1概述 傳感器信號處理板實物如圖5-17所示。圖中，巡線傳感器輸入接口連接安裝在機器人平臺底部的8路巡線傳感器；信號輸出接口連接單片機控制板，插座JP接12V電源，注意板子上的電源正極標志，不要插反。圖 5-17 傳感器信號處理板外圖 傳感器信號處理板電路原理框圖如圖 5-18 所示，完整的電路原理圖和12V 電源插座 下端引腳為正極信號輸出接口 信號測試點 巡線傳感器輸入接口 23 PCB 版圖另見附件。8 路巡線傳感器將采集到的地面白條信息送入本電路板，對于采集的信息先進行放大處理，放大后的信號跟標準電壓比較，保留白條反射的有效信號，過濾掉地面背景反射信號，有效信號再通過穩壓、反向、放大處理后送入單片機控制板，同時用發光二極管的亮暗指示當前某路傳感器是否在地面白條上。圖 5-18 傳感器信號處理板原理框圖 2信號放大電路 本電路板使用了 8 路信號放大電路，第一路傳感器信號放大電路如圖5-19 所示。（其余 7 路電路均相同）圖 5-19 單路信號放大電路 24 圖 5-19 中，Q0為單路傳感器輸入信號，數值很小，若巡線傳感器在地面白條上，大約在 0.9V 左右；若巡線傳感器不在地面白條上，數值大約在0.3V 左右，此信號輸入到由運放 LM324 組成的同相放大電路，調節電位器RW1 可以改變整個放大電路的放大倍數（實際電路中，RL 使用了阻值 1K的排阻），即調節了放大電路輸出的 QQ0。若 Q0為地面白條反射的有效信號，通過調節 RW1，使 QQ0的電壓輸出為 9.5V-10V 左右，若 Q0為地面背景反射的信號，根據地面背景的顏色以及光滑程度，QQ0大致在 4-6V 左右，越低越好。為了便于測量放大電路的輸出 QQ0-QQ7的數值，電路板上專門設置了測試點。3信號比較電路 第一路信號比較電路如圖 5-20 所示 圖 5-20 單路信號放大電路圖 圖 5-21 基準電壓電路 圖中用 LM324 運放連接成一個電壓比較器，反相輸入端為信號放大電路的輸出 QQ0，比較器的同相端接基準電壓 QV0，圖 5-21 為基準電壓電路，12V電源電壓通過穩壓管 D16 產生大約 8V 左右的基準電壓。當傳感器檢測到地面白條時，QQ0電壓大約為 9.5V-10V 左右，比較器輸出低電平，接近于 0V，通過反相器使得 QA0輸出為 5V；若傳感器檢測的是地面背景，QQ0電壓大約為 4-6V 左右，比較器輸出高電平，接近于 12V，通過 4.5V 的穩壓管，使得 25 反相器輸入端為 4.5V 左右的高電壓，反相器輸出 QA0為 0V 左右。8 路的輸出 QA0 QA7送入主控制板。4傳感器信號處理板的調試 本電路板的調試主要是通過調節電位器，從而改變信號放大電路的放大倍數，保證放大電路的輸出 QQ0-QQ7在合適的數值。調試步驟如下：（1）將機器人放到調試場地上，機器人底部的 8 路傳感器全部對準白條，打開 12V 電源開關，先測量此時 12V 電壓數值，確保電源電壓在 11.8V以上，否則，應給電池充電。（2）用萬用表測量測試點的電壓，調節電位器，使得電壓保證在9.5V-10V 左右，此時，電路板上 8 個指示發光二極管全亮。（3）移動機器人，使機器人底部的 8 路傳感器全部對準地面背景，此時，8 個發光二極管全暗；測量測試點的電壓，電壓大約為 4-6V 左右。5、電機驅動板電機驅動板 1概述 電機驅動板接受主控制板發來的電機 PWM 脈寬調制信號和方向信號，驅動機器人平臺上的 2 個 24V 直流減速電機。利用 PWM 信號占空比的不同，來控制電機的不同轉速；利用方向信號，控制直流電機的正反轉，從而實現機器人平臺的前進、后退和轉彎。電路板實物如圖 5-22 所示?？刂菩盘柌遄B接主控制板，24V 電源插座接 24V 電源（注意板子上的電源正極標志，不要插反），左右電機輸出插座接左右電機。26 圖 5-22 驅動板外形圖 圖 5-23 電機驅動板原理框圖 2LMD18200 電路 本電路板使用了 2 塊 LMD18200 直路電機驅動集成電路，分別用來驅動左輪和右輪電機，左輪電機驅動電路如圖 5-24 所示。LMD18200 是一種常用的直流電機驅動集成電路，輸出電流可以達到 3A 左右，可以實現單臺電機的正反轉控制，可靠性很高，具體參數可以參考 LMD18200 數據手冊。24V 電源開關 12V 電源開關 左行走電機 右行走電機 旋轉電機 上下電機 平移電機 手爪電機 電源插座 27 圖 5-24 左輪電機 LMD18200 驅動電路 3.L298 輸出電路 機器人上部結構所使用的4臺直流電機采用了2片L298進行控制，L298也是一種常用的直流電機驅動電路，一片 L298 可以實現 2 臺電機的正反轉控制，與 LMD18200 相比，輸出電流較小。L298 輸出電路如圖 5-25 所示 圖 5-25 L298 輸出電路 28（四）、機器人控制程序說明（四）、機器人控制程序說明 1、控制程序流程圖、控制程序流程圖 機器人的運行程序包括底盤巡線程序和上部機構運行程序，巡線程序的流程圖如圖 5-26 所示。機器人提供了 8 路巡線傳感器信號接受處理，平臺左右輪調速電機的控制以及相關程序，平臺可以沿白色引導線巡線前進、經過了指定數量的白色引導線交叉點后停止、轉彎等。圖 5-26 巡線程序流程圖 找到指定白條數停止運行否是否是初始化開始巡線運行按下啟動按鈕 29 圖 5-27 機器人程序設計流程圖 30 2、軟件函數說明、軟件函數說明 平臺提供了一些常用的函數，用戶可以直接使用這些函數，也可以自己定義和擴展函數。S_T()-程序初始化設置【功能】此函數為初始化程序設置。【說明】S_T()函數包括端口設置、PCA 時鐘源、控制寄存器、計數初值、啟動按鍵等設置，該函數只需在主程序開始時調用一次即可。delay_ms(T)-延時【功能】此函數為毫秒級延時函數?！菊f明】參數 T 用于調用時的延時時間設置，T 的取值范圍是 160000。如：delay_ms(1000);表示延時時間為 1 秒。SER_SELECT(gd)-接近開關選擇【功能】此函數為 PS_5 PS_8/PS_9 PS_12 接近開關選擇函數?！菊f明】參數 gd 用于選擇接近開關設置，PS_5 PS_8:PS58 /PS_9 PS_12:PS912。如：SER_SELECT(PS58)：表示選擇接近開關 PS_5 PS_8。motor(m,z,n)-電機運行【功能】此函數為電機運行函數。【說明】參數 m：選擇電機，l 代表左電機，r 代表右電機，DJ1 代表手抓電機，DJ2 代表平移電機，DJ3 代表上下電機，DJ4 代表旋轉電機。參數 z：設置電機的正反轉，f 代表正轉，b 代表反轉。參數 n：電機的占空比設置（轉速）。注：電機 1-4 此參數任意。31 如：motor(l,f,50);表示左電機以 50%的占空比正轉。stop(m)-電機停止【功能】此函數為電機停止函數?！菊f明】參數 m：選擇電機，l 代表左電機，r 代表右電機，rl 代表同時選擇左右電機，DJ1 代表手抓電機，DJ2 代表平移電機，DJ3 代表上下電機，DJ4 代表旋轉電機。如：stop(rl)；表示左右電機同時停止。FOLL_LINE(S_B,R_B,L_B,ti)-巡線計數【功能】此函數為 8 位巡線傳感器巡線計數函數?！菊f明】參數 S_B：巡線基準速度設置（即巡線時整機基本速度），范圍 1 100。參數 R_B：巡線右電機基準速度設置（即巡線時右電機基本速度，用于巡線微調），范圍 1 100。參數 L_B：巡線左電機基準速度設置（即巡線時左電機基本速度，用于巡線微調），范圍 1 100。參數 ti：巡線條數設置（即尋到設定條數時會跳出此函數），范圍 1 255。如：FOLL_FINE(70，70，70，3);表示平臺沿引導線前進檢測到 3 條交叉引導線。void TURN_90(e,r_s,l_s,qc_t,pb_t,end_t)-旋轉 90 度【功能】此函數為機器人旋轉 90 度（即尋找與前進方向 90 度交叉的白條）?！菊f明】參數 e：選擇機器人左轉或右轉，l 左轉 90 度，r 右轉 90 度。32 參數 r_s：轉彎右電機速度設置（即轉彎時右電機速度），范圍 1 100。參數 l_s：轉彎左電機速度設置（即轉彎時左電機速度），范圍 1 100。參數 qc_t：機器人檢測到白色引導條后前進到轉彎位置的時間，根據前進速度調整，范圍 1 60000。參數 pb_t：機器人轉彎開始時屏蔽傳感器正下方白色引導條的時間，根據轉彎速度調整，范圍 1 60000。參數 end_t：機器人轉彎中指定傳感器檢測到白色引導條后，根據機器人慣性需要保持的時間，根據轉彎速度和指定傳感器調整，范圍 1 60000。如：TURN_90(l,50,50,2900,500,2);表示機器人左轉 90 度（機器人檢測到白色引導條繼續前進 2.9 秒以 50 的速度左轉屏蔽時間 0.5 秒指定傳感器檢測到白色引導條繼續運行 2 毫秒）DJ1_JS(js)-手爪夾緊/松開【功能】此函數為手爪夾緊/松開函數?！菊f明】參數 js：選擇手抓夾緊或松開，夾緊（js=j）/松開（js=s）設定。如：DJ1_JS(j)；表示手抓夾緊。DJ2_PY(py)-手爪前后平移【功能】此函數為手爪前后平移函數?！菊f明】參數 py：選擇手抓向前或向后平移，向前（py=qpy）/向后（py=hpy）設定。如：DJ2_PY(hpy)；表示手抓向后平移。DJ3_SX(sx,wz)-手爪上下升降【功能】此函數為手爪上下升降運動函數。33【說明】參數 wz：選擇手抓上升或下降的位置，向上（sx=xs）/向下（sx=xx）設定。參數 sx：選擇手抓上升或下降到達的位置，從上至下 wz1（接近開關S05）；wz2（接近開關 S06）；wz3（接近開關 S07）；wz4（接近開關 S08）；wz5（接近開關 S09）。如：DJ3_SX(xx,wz3)；表示手抓下降到位置 3。DJ4_HZ(hz)-手爪回轉 90 度【功能】此函數為手爪回轉 90 度函數?！菊f明】參數 hz：選擇手抓逆時針或順時針旋轉 90 度，逆時針回轉（hz=qhz）/順時針回轉（hz=hhz）設定。如：DJ4_HZ(qhz)；表示手抓逆時針回轉 90 度。（五）、機器人調試說明（五）、機器人調試說明 在機器人全部裝配完畢，初步檢查無誤后，下一步就進行必要的調試，主要的調試步驟如下：1先進行循線傳感器信號處理板的調試。2.編寫一個接近開關傳感器測試程序，按照下列接近傳感器的順序給信號：S01-S02-S03-S04-S05-S06-S07-S08-S09-S10，選取升降電機 DJ3 作為測試電機，彈性聯軸器上緊定螺釘松開，讓電機空轉。驅動板上其它電機接口先拔除，以免測試過程中發生誤動作，損壞其它執行機構。測試程序可按如下方法編寫：DJ3 正轉S01 有信號時停止 2 秒后反轉S02 有信號時停止 2 秒后正轉S03 有信號時停止 2 秒后反轉以此類推直至 S10。測試時按以上順序用鐵片給接近開關信號，查看每個接近開關是否正確接收信號。34 3、編寫電機正反轉測試程序，查看每個電機正反轉的定義與對應功能是否符合。例：DJ1 正轉 200ms對應手爪夾緊動作、DJ1 反轉 200ms對應手爪松開動作。測試過程中注意動作時間給定，不要讓電機超出極限位置而損壞機構或電機。4、單獨測試每個功能函數動作是否正確，詳見功能函數說明。5編寫功能驗證程序，機械手先逆時針旋轉 180 度，停止 5 秒，再順時針旋轉 180 度后停止機械手從最低位上升，分別在 4 個位置處停止 5 秒，直至最高位停止機械手從最高位下降，分別在 4 個位置處停止 5 秒，直至最低位停止機械手從最前端開始向后移動，直至最后端停止 5 秒，再反向運動，直至最前端停止機械手夾緊一個工件后持續 5 秒，再松開到位機器人以恒定速度前進 5 秒，停止 3 秒，再以同樣速度后退 5 秒，停止 3 秒，左轉 90 度，停止 3 秒，右轉 90 度后停止。6、編寫任務程序，將機器人放到場地上進行調試。