深海采矿车自主定位系统及其在最优切削中的应用研究
|
摘要
深海采矿车自主定位系统是采矿车自主导航、智能控制、安全作业等过程的基础。针对深海地形崎岖不平、车轮打滑、周围能见度低等复杂的工作环境,本文提出了一种基于从动轮的航位推算定位方法。为了获取相关深海地貌数据计算采矿车最优切削深度,实现最优开采,定位系统要对采矿车定位获得采矿区域的准确位置数据,基于最优切削深度的钴结壳优化开采方法要求定位系统实时、连续、稳定的工作。航位推算定位方法受外部环境的依赖性较小、实时性强、短程定位精度高,对实现深海钴结壳优化开采有重要意义。
在建立某一时刻的斜面采矿车空间运动学模型基础上,用不同时刻、不同方位斜面复合成三维地形空间运动学模型,建立采矿车空间连续航位推算模型。针对采矿车打滑的测速问题,研制一种具有地形感知能力的从动轮测速机构。通过运动学分析,建立从动轮速度和采矿车速度之间的关系,以及定位系统在最优切削中的应用模型。在此基础上设计采矿车空间航位推算定位系统:用VC编写定位系统软件,采用三轴数字罗盘、角位移传感器等测量采矿车测量采矿车的动态参数,对系统采用的关键传感器进行数据预处理方法研究,提高其在动态情况下测量精度。
最后,在实验室条件下进行各种地形上模型车定位试验,分析定位系统的误差,验证其定位精度、实时性和稳定性,结果表明基于空间航位推算方法的定位系统是可行的。本文的研究为深海采矿车定位系统和建立完整的采矿车控制系统打下良好理论和试验基础。
The independent position system of deep-sea mining vehicle is the base of self-localization, intelligent controlling, independent navigation and safely working. Taking into account complex working environment: uneven physiognomy of deep-sea, wheel's skid, low visibility of surrounding and so on, dead reckoning based on driven wheel for localization was brought forward in this paper. For getting correlative physiognomy compute the best cut depth of mining vehicle, the correct location date should be got at first by the position system of mining vehicle. The method to collect optimized theory of mineral resources cut depth require the system characterized with real-time, continuous, steady and credibility. Dead Reckoning with its advantages of low depending on surrounding, high accuracy in short time, real-time, it is necessary for deep-sea cobalt-rich crusts optimized collection.
Dead-Reckoning kinematics model was founded at a certain time on a plane, the three-dimensional space kinematics models founded by the models of different planes and different time. A velocity measuring device based on driven wheel, which can detect the terrain. The velocity was designed in allusion to measure the velocity of the slipping mining vehicle. The velocity relation between mining vehicle and driven wheel ,the application model of position system for the best cut depth established by the kinematics analyze .Then, the software designed on VC6.0 platform, 3-axes digital compass and angular displacement sensor chose to measure the dynamic information, it's result will be treat for improving precision.
At last, Dead-Reckoning position system's accuracy, real time and stability proved by experiment, it also helps to analyze errors. It shows that the Dead Reckoning adapt to position system. The research is a good theory and experimental base for studying on the deep-sea position and founding a whole control system of mining vehicle.
在建立某一时刻的斜面采矿车空间运动学模型基础上,用不同时刻、不同方位斜面复合成三维地形空间运动学模型,建立采矿车空间连续航位推算模型。针对采矿车打滑的测速问题,研制一种具有地形感知能力的从动轮测速机构。通过运动学分析,建立从动轮速度和采矿车速度之间的关系,以及定位系统在最优切削中的应用模型。在此基础上设计采矿车空间航位推算定位系统:用VC编写定位系统软件,采用三轴数字罗盘、角位移传感器等测量采矿车测量采矿车的动态参数,对系统采用的关键传感器进行数据预处理方法研究,提高其在动态情况下测量精度。
最后,在实验室条件下进行各种地形上模型车定位试验,分析定位系统的误差,验证其定位精度、实时性和稳定性,结果表明基于空间航位推算方法的定位系统是可行的。本文的研究为深海采矿车定位系统和建立完整的采矿车控制系统打下良好理论和试验基础。
The independent position system of deep-sea mining vehicle is the base of self-localization, intelligent controlling, independent navigation and safely working. Taking into account complex working environment: uneven physiognomy of deep-sea, wheel's skid, low visibility of surrounding and so on, dead reckoning based on driven wheel for localization was brought forward in this paper. For getting correlative physiognomy compute the best cut depth of mining vehicle, the correct location date should be got at first by the position system of mining vehicle. The method to collect optimized theory of mineral resources cut depth require the system characterized with real-time, continuous, steady and credibility. Dead Reckoning with its advantages of low depending on surrounding, high accuracy in short time, real-time, it is necessary for deep-sea cobalt-rich crusts optimized collection.
Dead-Reckoning kinematics model was founded at a certain time on a plane, the three-dimensional space kinematics models founded by the models of different planes and different time. A velocity measuring device based on driven wheel, which can detect the terrain. The velocity was designed in allusion to measure the velocity of the slipping mining vehicle. The velocity relation between mining vehicle and driven wheel ,the application model of position system for the best cut depth established by the kinematics analyze .Then, the software designed on VC6.0 platform, 3-axes digital compass and angular displacement sensor chose to measure the dynamic information, it's result will be treat for improving precision.
At last, Dead-Reckoning position system's accuracy, real time and stability proved by experiment, it also helps to analyze errors. It shows that the Dead Reckoning adapt to position system. The research is a good theory and experimental base for studying on the deep-sea position and founding a whole control system of mining vehicle.
引文
[1]T Yamazaka,R Sharama,K Tsurusaki.Influence of Distribution Characteristics and Associated Seabed Features Exploitation of Cobalt-Rich Manganese Deposits.Proceedings of the ISOPE Ocean Mining Symposium.1995,119-124
[2]简曲.中太平洋富钴结壳的研究.矿业研究与丌发,1999,19(1):25-27
[3]P Claude,H Michel.Characteristics of Co-rich ferromanganese nodules and crust sampled in French Polynesia.Marine Geology,1987,77:109-119
[4]2001年中国大洋矿产资源研究开发学术研讨会论文集(上).北京:中国大洋协会办公室,2001
[5]文先保.海洋开发,北京:冶金工业出版社,1996,4
[6]Manheim F T.Marine cobalt resources.Science.1987,232:600-608.
[7]国家海洋局发展战略研究所.海洋采矿前景预测,北京,1995,5:2-6
[8]潘家华,刘淑琴.西太平洋富钴结壳的分布、组分及元素地球化学[J].地球学报,1999,20(1):47-54
[9]菲尔莫尔C F.埃尔尼著,翟国谦等译.海洋矿产资源.北京:海洋出版社,1991
[10]莫杰.中国大洋矿产资源勘查进展概况.海洋地质动态,2000,16(3):6-8
[11]简曲.21世纪的大洋采矿.矿山机械,2000,4:1-3
[12]何清华,李爱强,邹湘伏.大洋富钴结壳调查进展及开采技术.金属矿山,2005,347(5):4-7
[13]吕东,何将三,刘少军.深海资源开采技术的研究现状.矿山机械,2004,9:6-8
[14]沈裕军,钟祥.大洋钴结壳资源研究开发现状.矿冶工程,1999,19(2):11-13
[15]John E.Halkyard.Technology for mining cobalt rich manganese crusts from seamounts.New York,1985,352-374
[16]王明和,阳宁.深海采矿中试整体系统研究开发.矿业研究与开发,2001:20-30
[17]李俊.自主式水下潜器导航技术发展现状与展望.中国造船,2004:45(3)1-8
[18]任凤跃.基于AVS/Express可视化技术的回转接触式微地形探测系统研究: [硕士学位论文].长沙:中南大学,2005
[19]潘家华,刘淑琴.西太平洋富钴结壳的分布、组分及元素地球化学[J].地球学报,1999,20(1):47-54
[20]刘光华.海底钴结壳自行式采矿车自主定位系统研究:[硕士学位论文].长沙:中南大学,2006
[21]罗柏文.四轮驱动履带式海底钴结壳采矿车及其采集过程可视化研究:[硕士学位论文].长沙:中南大学,2003
[22]王震宇,刘少军,李力.Crawling Feasihility Simulation Study on Tracked vehicle for Deep Ocean Mining.系统仿真学报,2004,16(4):644-647
[23]国家海洋局第二海洋研究所,“中国大洋矿产资源勘查航次调查报告(DY95-6、DY95-8)”,杭州,1994
[24]国际海底区域研究开发”十五”计划项目总体设计(审查稿).中国大洋矿产资源研究开发协会办公室,2001,3
[25]国家海洋局第二海洋研究所,DY95-6/8航次调查报告,中国大洋矿产资源协会,1999
[26]刘勇.深海钴结壳螺旋滚筒切削法采掘头设计理论与方法虚拟研究:[博士论文].长沙:中南大学,2002
[27]2001年中国大洋矿产资源研究开发学术研讨会论文集(上).北京:中国大洋协会办公室,2001
[28]长沙矿山研究院,“深海采矿中试集矿机技术设计”课题报告,长沙,2000
[29]长沙矿冶研究院,“深海采矿中试破碎机的研究开发”课题研究报告,长沙,2000
[30]深海技术发展项目(DY105-03),深海资源开采技术子项目(DYl05-03-02),钴结壳采集关键技术及关键装备研究课题申请书.中南大学,长沙矿山研究院,长沙矿冶研究院
[31]王庆天,邢志刚,刘伯胜.智能水下机器人水声精确定位技术的研究.海洋工程,1999,17(11):99-100
[32]吴勇亭,周兴华,杨龙.水下声学定位系统及其应用.海洋测绘,2003,23(7):18-21
[33]Keith Vickery,Acoustic Positioning System -New Concepts- Future.IEEE.1998,0-7803-5190-8298c
[34]阳凡林,康志忠,独知行等.海洋导航定位技术及其应用与展望.海洋测绘,2006,26(1),71-74
[35]李守军,包更生吴水根.水声定位技术的发展现状与展望.海洋技术,2005 24(3):130-133
[36]邢志伟,张禹,封锡盛.基于超短基线多普勒的水下机器人位置估计.机器人,2003,25(3):231-234
[37]刘金会,郝静如.自主移动机器人导航定位技术研究初探.传感器世界,2005,1:23-26
[38]Dissanayake G,Newman P M,eta].Asolution to the simultaneous localization and map building(SLAM)problem[J].IEEE Transactionson Robotics and Automatio,2001,17(3):229-241.
[39]冯子龙,刘建,刘开舟.AUV自主导航航位推算算法的分析研究.海洋技术,2006,25(3):1-4
[40]Bennamon M,etc.The Development of an Integrated GPS/INS/SONAR Navigation System for Autonomous Underwater Vehicle Navigation[A].Proceedings of IEEE OCEAN' s96[C].1996:256-261
[41]杨放琼,彭高明,谭青.深海自行式集矿机的定位与综合导航.中山大学学报(自然科学版),2006,45(5):39-42
[42]万磊,李璐,刘建成等.一种基于航迹推算的水下机器人导航算法.中国造船,2004,45(12):77-82
[43]Leonard J J,Bennett A A etc.Autonomous Underwater Vehicle Navigation[R].MIT Marine Robotics Laboratory Technical Memorandum.1998
[44]陈峰,桂卫华,王随平等.深海底采矿机器车的研究现状.矿山机械,2002,33(9):21-24
[45]徐德,谭民.移动机器人移动的在线实时定位研究.自动化学报,2003,29(5):1-10
[46]于金霞,蔡自兴,邹小兵等.非平坦地形下移动机器人航迹推算方法研究.河南理工大学学报,24(3):210-216
[47]孙永荣,刘建业,陆涛等.基于自适应滤波的车载DR系统研究.南京航空航天大学学报,2000,32(4):1-5
[48]张传斌,田蔚风,金志华.车载DR导航的非线性滤波方法研究.系统工程与电子技术,2005,27(6):1-4
[49]富立,范耀祖.智能航迹推算系统的研究.航空学报.2000,21(4):299-301
[50]仲欣,吕恬生.基于多传感器信息融合的斜面移动机器人定位新方法.机器人,1999,21(9):321-326
[51]J Borensteinl,L Feng2.A Method for Measuring,Comparing,and Correcting Dead-reckoning Errors in Mobile Robots[In].Copies of this report are available from the University of Michigan as:Technical Report UM-MEAM-94-22,20-22.
[52]刘方湖,李满华,马培荪.管道形轮腿式月球探测机器人的运动学建模.东南大学学报(自然科学版),2003,33(6):741-745
[53]丁宝新.关于定位与测磁中的坐标转换问题.水雷战与舰艇防护,1994,2:5-14
[54]付孙钟.几种常用坐标系问的坐标转换.测绘技术装备,2003,5(3):1-2
[55]胡风华,方庆法,张晶,沈新华.浅谈三委坐标系的转换。煤炭技术,2003,22(11):1-2
[56]黄中华,刘少军,谢雅,富钴结壳轮式集矿机越障性能研究.计算机仿真.2006,23(8):45-47
[57]“863计划水下GPS高精度定位系统”课题组.我国首套水下GPS高精度定位导航系统简介.中国水利,2004,3:52-53
[58]秦宣云.基于微地形重构的深海钴结壳最佳采集切削深度控制模型研究:[博士论文].长沙:中南大学,2005
[59]陈峰,桂卫华,王随平.深海底履带机器车建模及仿真研究.机器人,2004,26(11):510-513
[60]王卫华,熊有伦,孙容磊.一种移动机器人轮子打滑的实验校核方法.机器人,2003,27(5):197-202
[61]戴念祖.电和磁的历史.长沙:湖南教育出版社,2001.78-80
[62]袁波.提高RS-485通信可靠性的措施.电子世界,2005,15:53-54
[63]李现勇.Visual C++串口通信技术与工程实践.北京:人民邮电出版社,2004.55-180
[64]杨锋,桂卫华,陈锋等.基于VC++串口通信编程在深海底自动采矿系统中的应用.电脑开发与应用,2004,17(10):6-8
[65]陈锆生,徐军等.HMR3000数字罗盘在微型飞行器中的应用.传感器技术,2001,20(9):44-46
[66]赵来定,徐江,周月臣.小型三轴数字罗盘测量误差分析.现代雷达,2004,26(11):53-56
[67]朱海,莫军.水下导航信息融合技术.北京:国防工业出版社,2002.25-30
[68]朱荣生,施小成.一种用于GPS数据处理中剔除异值的算法.中国惯性技术学报,2000,8(2):74-79
[69]刘爱东,倪永强,王建国.一种实时剔除雷达测量数据中异值的方法分析.火 力与指挥控制,2004,29(6):25-28
[70]张桂凤,徐小力,吴国新.热分析仪采集信号中异值的剔除与修正.北京机械工业学院学报,2004.19(9):25-29
[71]沙震,阮火军.分形与拟合.杭州:浙江大学出版社,2005.60-85
[72]吴宗敏.散乱数据拟合的模型、方法和理论.北京:科学出版社,2007.5-17
[73]赵红梅.Matlab7基础与提高.北京:电子工业出版社,2006.77-79
[2]简曲.中太平洋富钴结壳的研究.矿业研究与丌发,1999,19(1):25-27
[3]P Claude,H Michel.Characteristics of Co-rich ferromanganese nodules and crust sampled in French Polynesia.Marine Geology,1987,77:109-119
[4]2001年中国大洋矿产资源研究开发学术研讨会论文集(上).北京:中国大洋协会办公室,2001
[5]文先保.海洋开发,北京:冶金工业出版社,1996,4
[6]Manheim F T.Marine cobalt resources.Science.1987,232:600-608.
[7]国家海洋局发展战略研究所.海洋采矿前景预测,北京,1995,5:2-6
[8]潘家华,刘淑琴.西太平洋富钴结壳的分布、组分及元素地球化学[J].地球学报,1999,20(1):47-54
[9]菲尔莫尔C F.埃尔尼著,翟国谦等译.海洋矿产资源.北京:海洋出版社,1991
[10]莫杰.中国大洋矿产资源勘查进展概况.海洋地质动态,2000,16(3):6-8
[11]简曲.21世纪的大洋采矿.矿山机械,2000,4:1-3
[12]何清华,李爱强,邹湘伏.大洋富钴结壳调查进展及开采技术.金属矿山,2005,347(5):4-7
[13]吕东,何将三,刘少军.深海资源开采技术的研究现状.矿山机械,2004,9:6-8
[14]沈裕军,钟祥.大洋钴结壳资源研究开发现状.矿冶工程,1999,19(2):11-13
[15]John E.Halkyard.Technology for mining cobalt rich manganese crusts from seamounts.New York,1985,352-374
[16]王明和,阳宁.深海采矿中试整体系统研究开发.矿业研究与开发,2001:20-30
[17]李俊.自主式水下潜器导航技术发展现状与展望.中国造船,2004:45(3)1-8
[18]任凤跃.基于AVS/Express可视化技术的回转接触式微地形探测系统研究: [硕士学位论文].长沙:中南大学,2005
[19]潘家华,刘淑琴.西太平洋富钴结壳的分布、组分及元素地球化学[J].地球学报,1999,20(1):47-54
[20]刘光华.海底钴结壳自行式采矿车自主定位系统研究:[硕士学位论文].长沙:中南大学,2006
[21]罗柏文.四轮驱动履带式海底钴结壳采矿车及其采集过程可视化研究:[硕士学位论文].长沙:中南大学,2003
[22]王震宇,刘少军,李力.Crawling Feasihility Simulation Study on Tracked vehicle for Deep Ocean Mining.系统仿真学报,2004,16(4):644-647
[23]国家海洋局第二海洋研究所,“中国大洋矿产资源勘查航次调查报告(DY95-6、DY95-8)”,杭州,1994
[24]国际海底区域研究开发”十五”计划项目总体设计(审查稿).中国大洋矿产资源研究开发协会办公室,2001,3
[25]国家海洋局第二海洋研究所,DY95-6/8航次调查报告,中国大洋矿产资源协会,1999
[26]刘勇.深海钴结壳螺旋滚筒切削法采掘头设计理论与方法虚拟研究:[博士论文].长沙:中南大学,2002
[27]2001年中国大洋矿产资源研究开发学术研讨会论文集(上).北京:中国大洋协会办公室,2001
[28]长沙矿山研究院,“深海采矿中试集矿机技术设计”课题报告,长沙,2000
[29]长沙矿冶研究院,“深海采矿中试破碎机的研究开发”课题研究报告,长沙,2000
[30]深海技术发展项目(DY105-03),深海资源开采技术子项目(DYl05-03-02),钴结壳采集关键技术及关键装备研究课题申请书.中南大学,长沙矿山研究院,长沙矿冶研究院
[31]王庆天,邢志刚,刘伯胜.智能水下机器人水声精确定位技术的研究.海洋工程,1999,17(11):99-100
[32]吴勇亭,周兴华,杨龙.水下声学定位系统及其应用.海洋测绘,2003,23(7):18-21
[33]Keith Vickery,Acoustic Positioning System -New Concepts- Future.IEEE.1998,0-7803-5190-8298c
[34]阳凡林,康志忠,独知行等.海洋导航定位技术及其应用与展望.海洋测绘,2006,26(1),71-74
[35]李守军,包更生吴水根.水声定位技术的发展现状与展望.海洋技术,2005 24(3):130-133
[36]邢志伟,张禹,封锡盛.基于超短基线多普勒的水下机器人位置估计.机器人,2003,25(3):231-234
[37]刘金会,郝静如.自主移动机器人导航定位技术研究初探.传感器世界,2005,1:23-26
[38]Dissanayake G,Newman P M,eta].Asolution to the simultaneous localization and map building(SLAM)problem[J].IEEE Transactionson Robotics and Automatio,2001,17(3):229-241.
[39]冯子龙,刘建,刘开舟.AUV自主导航航位推算算法的分析研究.海洋技术,2006,25(3):1-4
[40]Bennamon M,etc.The Development of an Integrated GPS/INS/SONAR Navigation System for Autonomous Underwater Vehicle Navigation[A].Proceedings of IEEE OCEAN' s96[C].1996:256-261
[41]杨放琼,彭高明,谭青.深海自行式集矿机的定位与综合导航.中山大学学报(自然科学版),2006,45(5):39-42
[42]万磊,李璐,刘建成等.一种基于航迹推算的水下机器人导航算法.中国造船,2004,45(12):77-82
[43]Leonard J J,Bennett A A etc.Autonomous Underwater Vehicle Navigation[R].MIT Marine Robotics Laboratory Technical Memorandum.1998
[44]陈峰,桂卫华,王随平等.深海底采矿机器车的研究现状.矿山机械,2002,33(9):21-24
[45]徐德,谭民.移动机器人移动的在线实时定位研究.自动化学报,2003,29(5):1-10
[46]于金霞,蔡自兴,邹小兵等.非平坦地形下移动机器人航迹推算方法研究.河南理工大学学报,24(3):210-216
[47]孙永荣,刘建业,陆涛等.基于自适应滤波的车载DR系统研究.南京航空航天大学学报,2000,32(4):1-5
[48]张传斌,田蔚风,金志华.车载DR导航的非线性滤波方法研究.系统工程与电子技术,2005,27(6):1-4
[49]富立,范耀祖.智能航迹推算系统的研究.航空学报.2000,21(4):299-301
[50]仲欣,吕恬生.基于多传感器信息融合的斜面移动机器人定位新方法.机器人,1999,21(9):321-326
[51]J Borensteinl,L Feng2.A Method for Measuring,Comparing,and Correcting Dead-reckoning Errors in Mobile Robots[In].Copies of this report are available from the University of Michigan as:Technical Report UM-MEAM-94-22,20-22.
[52]刘方湖,李满华,马培荪.管道形轮腿式月球探测机器人的运动学建模.东南大学学报(自然科学版),2003,33(6):741-745
[53]丁宝新.关于定位与测磁中的坐标转换问题.水雷战与舰艇防护,1994,2:5-14
[54]付孙钟.几种常用坐标系问的坐标转换.测绘技术装备,2003,5(3):1-2
[55]胡风华,方庆法,张晶,沈新华.浅谈三委坐标系的转换。煤炭技术,2003,22(11):1-2
[56]黄中华,刘少军,谢雅,富钴结壳轮式集矿机越障性能研究.计算机仿真.2006,23(8):45-47
[57]“863计划水下GPS高精度定位系统”课题组.我国首套水下GPS高精度定位导航系统简介.中国水利,2004,3:52-53
[58]秦宣云.基于微地形重构的深海钴结壳最佳采集切削深度控制模型研究:[博士论文].长沙:中南大学,2005
[59]陈峰,桂卫华,王随平.深海底履带机器车建模及仿真研究.机器人,2004,26(11):510-513
[60]王卫华,熊有伦,孙容磊.一种移动机器人轮子打滑的实验校核方法.机器人,2003,27(5):197-202
[61]戴念祖.电和磁的历史.长沙:湖南教育出版社,2001.78-80
[62]袁波.提高RS-485通信可靠性的措施.电子世界,2005,15:53-54
[63]李现勇.Visual C++串口通信技术与工程实践.北京:人民邮电出版社,2004.55-180
[64]杨锋,桂卫华,陈锋等.基于VC++串口通信编程在深海底自动采矿系统中的应用.电脑开发与应用,2004,17(10):6-8
[65]陈锆生,徐军等.HMR3000数字罗盘在微型飞行器中的应用.传感器技术,2001,20(9):44-46
[66]赵来定,徐江,周月臣.小型三轴数字罗盘测量误差分析.现代雷达,2004,26(11):53-56
[67]朱海,莫军.水下导航信息融合技术.北京:国防工业出版社,2002.25-30
[68]朱荣生,施小成.一种用于GPS数据处理中剔除异值的算法.中国惯性技术学报,2000,8(2):74-79
[69]刘爱东,倪永强,王建国.一种实时剔除雷达测量数据中异值的方法分析.火 力与指挥控制,2004,29(6):25-28
[70]张桂凤,徐小力,吴国新.热分析仪采集信号中异值的剔除与修正.北京机械工业学院学报,2004.19(9):25-29
[71]沙震,阮火军.分形与拟合.杭州:浙江大学出版社,2005.60-85
[72]吴宗敏.散乱数据拟合的模型、方法和理论.北京:科学出版社,2007.5-17
[73]赵红梅.Matlab7基础与提高.北京:电子工业出版社,2006.77-79