?

　　本節制系統采用ARM(Advanced RISC Machine)微措置器，其與單片機和DSP 等對比具有很強的通用性，以其高速度、高性價比和低功耗等利益被普遍應用于各個規模。

　　1 節制系統功能要求

　　漿果采摘機械人的首要執行部門———機械手分為手臂和手腕兩部門。機械手若何遁藏障礙物并能切確達到果實方針的位置是由機械手的自由度抉擇的，凡是機械手在空間的位置和行為規模首要取決于手臂部門的自由度，為了使機械手能夠達到空間的任一指定位置，其手臂部門至少應具有3 個自由度。手腕部門自由度主若是用來調整結尾執行器在空間的姿態，為了使結尾執行器在空間也能取得肆意要求的姿態,在理論上要求手腕部門也應具有3 個自由度。

　　節制系統的使命是從上位機接管指令，驅動各自由度所對應的電機，從而使采摘機械手達到指定位置進行功課。

　　2 節制系統硬件設計

　　機械人節制系統一般需要知足以下幾個根基要求。

　　①節制系統的小型化、輕型化和模塊化;

　　②節制系統的實時性;

　　③系統的不變性和開放性。

　　為此將本節制系統設計成由主節制模塊、驅動模塊和反饋模塊三部門組成。

　　2.1 主節制模塊設計

　　為了能夠知足機械人節制需求，同時兼顧機械人對節制器體積、重量、功耗等敏感特征的要求，主節制模塊采用Samsung 公司基于ARM920T 核(合用于實時情形) 的低功耗、16/32bit、高機能的RISC 微措置器S3C2410，其主頻為266MHz。操作系統則選用源碼公開、專為ARM 設計，靠得住性高的實時、多使命內核arm-Linux。要使微措置器能夠正常工作，必需對其外圍進行擴展。

　　電源模塊負責為整個模塊供給不變、清潔的直流電源。JTAG 調試單元用來實現軌范的在線調試。串行通信模塊則經由過程RS232 通信尺度實現主節制模塊與上位機的通信。為使系統能夠運行較年夜的軌范(如LINUX內核和文件系統)，在微措置器外圍擴展了32M 字節的SDRAM 內存芯片。擴展了16M 字節的FLASH 芯片作為軌范和數據的存儲設備，以保證失蹤電時軌范和數據不會丟失蹤。

　　2.2 驅動模塊設計

　　本機械人系統采用直流電機節制，電機驅動芯片選用ST 公司的L298。L298 是ST 公司出產的一種高電壓、年夜電流電機驅動芯片。該芯片的首要特點是工作電壓高，輸出電流年夜，瞬間峰值電流可達3A，持續工作電流為2A;內含兩個H 橋的高電壓年夜電流全橋式驅動器，可用來驅動直流電念頭、步進電念頭、繼電器和線圈等感性負載;采用尺度TTL 邏輯電平旌旗燈號節制;具有兩個使能節制端，在不受輸入旌旗燈號影響的情形下許可或禁止器件工作;有一個邏輯電源輸入端，使內部邏輯電路部門在低電壓下工作;可外接檢測電阻，將轉變量反饋給節制電路。

　　2.3 反饋模塊設計

　　本系統的電機使用光電編碼器進行測速。光電編碼器具有低慣量、低噪聲、高分辯率和高精度等特點，適合于節制直流電機。將編碼器發生的脈沖旌旗燈號經變換獲得電念頭速度用于速度反饋形成速度閉環，同時可以對脈沖旌旗燈號進行計數和運算，從而獲得采摘機械手的位置和速度。

　　3 節制系統軟件設計

　　節制系統中節制使命的實現由應用軌范來完成，應用軌范設計的口角將直接抉擇整個系統的節制質量和節制效率。為了更好地進行系統調試以及功能擴展，節制系統軟件也采用了模塊化結構設計。系統主軌范首要分為初始化模塊和運行模塊兩年夜部門。

　　3.1 初始化模塊

　　初始化模塊需要完成的工作是：異常向量表界說、倉庫初始化、系統變量初始化、間斷系統初始化、I/O 初始化和外圍初始化等操作。

　　3.2 運行模塊

　　運行模塊經由過程間斷形式進行，搜羅測速模塊、PID節制模塊和PWM 波輸出模塊。首要工作流程為：首先判定是否有新的速度指令，若有，則判定出速度巨細和標的目的，并將其轉換成軌范中劃定的統一形式，以便利進行PID 節制;然后判定是否有新的傳感器反饋值，若有，則計較出電機的速度巨細，并執行電機的PID 節制軌范，接著挪用電機驅動軌范，改變PWM 占空比，輸出PWM 波，實現電機的速度節制。

　　4 竣事語

　　基于ARM 的行為節制系統是漿果采摘機械人系統的一個主要組成部門。ARM 微措置器機能好、功耗低、體積小、移植性較好。以ARM 微措置器為焦點的行為節制系統可以經由過程硬件平臺的改良和進級、軟件算法的再生和模塊化使整個節制系統具備可移植性，具有必然應用價值。