[发明专利]一种水下航行器的避障方法无效
申请号: | 201210102688.5 | 申请日: | 2012-04-10 |
公开(公告)号: | CN102621988A | 公开(公告)日: | 2012-08-01 |
发明(设计)人: | 崔荣鑫;严卫生;宋保维;刘明雍;张福斌;高剑;彭星光;张立川 | 申请(专利权)人: | 西北工业大学 |
主分类号: | G05D1/10 | 分类号: | G05D1/10 |
代理公司: | 西北工业大学专利中心 61204 | 代理人: | 王鲜凯 |
地址: | 710072 *** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 水下 航行 方法 | ||
1.一种水下航行器的避障方法,其特征在于步骤如下:
步骤1:根据水下航行器探测到的障碍物的情况,将位于水下航行器中轴线两侧的障碍物分为第1类,位于水下航行器中轴线上的障碍物分为第2类;
步骤2:计算水下航行器与障碍物之间的距离对应每个语言变量的隶属度,
d为障碍物与水下航行器的距离,{“近”,“较远”,“远”}为该距离的语言变量;
步骤3:计算水下航行器中轴与障碍物之间的角度对应每个语言变量的隶属度
Φ为障碍物与水下航行器中轴的角度,{“小”,“较小”,“较大”,“大”}为该角度的语言变量;
步骤4:定义水下航行器避开障碍物角度的语言变量为ψavd,其取值为{“小”,“较小”,“较大”,“大”,“很大”},利用下表所示的模糊规则,计算每条规则的推理结果C′n;
第1类的模糊规则共12条,分别为
第2类的模糊规则共12条,分别为
利用下式计算水下航行器避开障碍物角度的隶属度函数
步骤5:根据前提“水下航行器与障碍物之间距离为d、障碍物与水下航行器中轴的角度为Φ”和每条模糊规则采用Mandani推理法得到推理结果C′n,n=1…12的隶属函数
其中,∧为MIN,取最小值,n表示规则序号;
步骤6:综合所有模糊规则推理结果C′n得到最终结论C′,其计算方法为:
其中,∨为MAX,即取最大值;
步骤7去模糊化:计算水下航行器避开障碍物的精确角度
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于西北工业大学,未经西北工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210102688.5/1.html,转载请声明来源钻瓜专利网。
- 上一篇:煤仓煤位报警装置
- 下一篇:一种直流道低温低压长方形燃料电池