裝箱機器人控制系統(tǒng)開發(fā)
本文關鍵詞: 開放式 四元數 控制系統(tǒng) 裝箱 出處:《江南大學》2015年碩士論文 論文類型:學位論文
【摘要】:機器人作為一種先進的制造裝備,已經被廣泛應用于各個行業(yè)。在機器人的研發(fā)與設計過程中,機器人控制系統(tǒng)的研究與開發(fā)一直是人們探討的熱點之一。作為工業(yè)機器人的一種,包裝機器人在包裝行業(yè)的應用非常廣泛,主要包括裝箱機器人,搬運機器人,碼垛機器人,裝袋機器人,灌裝機器人等。包裝機器人的廣泛應用大幅降低人力資源的消耗,而且在惡劣環(huán)境中,能夠降低操作安全風險,同時,提高包裝的質量與操作穩(wěn)定性,從而提高效率。本文選擇五自由度機器人作為裝箱機器人研究對象,開發(fā)了基于運動控制器的機器人控制系統(tǒng),最終將其應用于FANUC LR MATE100i五自由度機器人上,并實現了對其的控制。主要研究內容如下:首先,本文為實現對食品,香煙,藥品等輕質量物件的裝箱操作,分析現有不同自由度機器人各自的用途與特點,選擇五自由度機器人作為裝箱機器人研究對象,設計開放式控制系統(tǒng)總體方案,選用GUC-T系列的運動控制器進行系統(tǒng)運動學計算及軌跡規(guī)劃,采用CDHD系列的伺服驅動器驅動電機,在此基礎上,為裝箱機器人控制系統(tǒng)設計控制柜外形尺寸及總電路圖。隨后,對裝箱機器人進行了運動學分析,運用D-H法則建立了機器人運動學模型,并對機器人運動學正反解進行了求解。在此基礎上,對機器人笛卡爾空間的軌跡規(guī)劃進行研究,實現了機器人笛卡爾空間的空間直線插補運動及空間圓弧插補運動。針對歐拉角姿態(tài)表示方式存在奇異性以及姿態(tài)過渡不平穩(wěn)的問題,采用四元數表示機器人姿態(tài),并提出機器人姿態(tài)四元數直接逆解的方法,舍去姿態(tài)四元數需轉化為姿態(tài)矩陣的過程,簡化計算過程,提高了程序的運行效率,并驗證了算法的正確性。然后,運用運動控制器提供的Otostudio軟件開發(fā)工具為五自由度機器人控制系統(tǒng)開發(fā)軟件,將軟件分為初始化模塊、示教模塊、再現模塊、運動控制模塊、信息反饋模塊、文件管理模塊六大模塊及圖形化人機交互界面,實現了各模塊所需完成的功能,同時,為控制系統(tǒng)軟件設計了人機交互界面。最后,將機器人控制系統(tǒng)運用于FANUC LR MATE 100i五自由度機器人上,實現了對機器人的控制,并運用FARO激光跟蹤儀采用幾何方法對機器人進行角度測量,得出機器人各關節(jié)轉動一圈所發(fā)脈沖的數目,并加以修正,最終實現了FANUC機器人在笛卡爾空間的直線運動及空間圓弧運動,并成功完成物流線上小包裝件的裝箱操作。
[Abstract]:As an advanced manufacturing equipment, robot has been widely used in various industries, in the development and design of robots. The research and development of robot control system has been one of the hot topics. As a kind of industrial robot, packaging robot is widely used in packaging industry, including packing robot. Handling robot, palletizing robot, bagging robot, filling robot and so on. The extensive application of packaging robot greatly reduces the human resource consumption, and in the bad environment, can reduce the operation safety risk, at the same time. In order to improve the quality and operation stability of packaging and improve efficiency, a robot control system based on motion controller is developed in this paper. Finally, it is applied to FANUC LR MATE100i five-degree-of-freedom robot, and its control is realized. The main research contents are as follows: firstly, this paper aims to realize the realization of food and cigarette. The paper analyzes the use and characteristics of the existing robots with different degrees of freedom, selects the five-degree-of-freedom robot as the research object of the packing robot, and designs the general scheme of the open control system. The motion controller of GUC-T series is used to calculate the system kinematics and trajectory planning, and the servo driver of CDHD series is used to drive the motor. Then, the kinematics analysis of the boxed robot is carried out, and the kinematics model of the robot is established by using D-H rule. On the basis of this, the trajectory planning of the robot in Cartesian space is studied. The motion of space linear interpolation and space arc interpolation of robot in Cartesian space is realized, and the singularity and unsteady attitude transition of Euler angle attitude are discussed. The quaternion is used to express the attitude of the robot, and the method of direct inverse solution of the quaternion of the robot attitude is proposed. The process of converting the quaternion of the attitude to the attitude matrix is proposed, which simplifies the calculation process and improves the running efficiency of the program. And verify the correctness of the algorithm. Then, using the motion controller provided by the Otostudio software development tools for the five-degree-of-freedom robot control system development software, the software is divided into initialization module. Teaching module, reproduction module, motion control module, information feedback module, file management module six modules and graphical man-machine interface, achieve the required functions of each module, at the same time. The human-computer interface is designed for the control system software. Finally, the robot control system is applied to FANUC LR MATE 100i five-degree-of-freedom robot to realize the control of the robot. The FARO laser tracker is used to measure the angle of the robot, and the number of pulses produced by the rotation of each joint of the robot is obtained and corrected. Finally, the linear motion and circular arc movement of FANUC robot in Cartesian space are realized, and the packing operation of small package on the logistics line is successfully completed.
【學位授予單位】:江南大學
【學位級別】:碩士
【學位授予年份】:2015
【分類號】:TP242
【參考文獻】
相關期刊論文 前10條
1 楊福馨;機器人技術在包裝中的應用研究[J];包裝世界;2005年01期
2 楊曉花;;嵌入式運動控制器交互系統(tǒng)設計[J];信息安全與技術;2014年10期
3 姚志良;我國工業(yè)機器人發(fā)展的幾點思考[J];機器人技術與應用;2005年03期
4 蔣新松;國外機器人的發(fā)展及我們的對策研究[J];機器人;1987年01期
5 王天然,曲道奎;工業(yè)機器人控制系統(tǒng)的開放體系結構[J];機器人;2002年03期
6 沈軍行 ,孫守遷 ,潘云鶴;從運動捕獲數據中提取關鍵幀[J];計算機輔助設計與圖形學學報;2004年05期
7 畢勝;;國內外工業(yè)機器人的發(fā)展現狀[J];機械工程師;2008年07期
8 劉放;汪鎏;胡俊;姚振強;;基于四元數的空間圓弧插補算法[J];機械科學與技術;2009年11期
9 張豐華;韓寶玲;羅慶生;石琳;黃麟;;基于PLC的新型工業(yè)碼垛機器人控制系統(tǒng)設計[J];計算機測量與控制;2009年11期
10 馬艷紅;胡軍;;姿態(tài)四元數相關問題[J];空間控制技術與應用;2008年03期
相關碩士學位論文 前2條
1 伍文偉;六自由度開放式機器人控制系統(tǒng)的研究[D];湖南大學;2007年
2 張明;白酒包裝自動碼垛機器人的研制[D];四川理工學院;2013年
,本文編號:1456481
本文鏈接:http://sikaile.net/guanlilunwen/wuliuguanlilunwen/1456481.html