发明名称 磁导航自主轮式移动机器人的里程检测方法
摘要 本发明公开了一种磁导航自主轮式移动机器人的里程检测方法,包括以下步骤:步骤1:确定磁条或磁道钉的铺设间距L;步骤2:记录机器人在前进过程中,前后两排磁传感器组不能检测磁场的次数N<sub>1</sub>,N<sub>2</sub>;步骤3:通过以下里程计算公式计算出机器人当前的里程s:<img file="dda0000113371390000011.GIF" wi="451" he="108" />或<img file="dda0000113371390000012.GIF" wi="500" he="108" />式中,A表示磁条的长度,R表示磁道钉的半径,本发明通过科学设定磁道钉或磁条的铺设间隔,得到磁道钉或磁条磁场间的空隙,然后通过记录前后两排磁传感器组不能读到磁场的次数,并结合磁条或磁道钉的铺设间隔长度实现对机器人里程的检测,该方法计算简单、相对准确、不受外部环境影响,尽量克服了传统里程计算的缺陷,并节约自主轮式移动机器人的硬件成本和软件成本。
申请公布号 CN102506891A 申请公布日期 2012.06.20
申请号 CN201110385513.5 申请日期 2011.11.28
申请人 重庆大学 发明人 廖孝勇;孙棣华;刘卫宁;赵敏;郑林江;郭磊;孙焕山
分类号 G01C22/00(2006.01)I 主分类号 G01C22/00(2006.01)I
代理机构 北京同恒源知识产权代理有限公司 11275 代理人 赵荣之
主权项 磁导航自主轮式移动机器人的里程检测方法,其特征在于包括以下步骤:步骤1:确定磁条或磁道钉的铺设间距L;步骤2:记录机器人在前进过程中前后两排磁传感器组不能检测磁场的次数N1,N2;步骤3:通过以下里程计算公式计算出机器人当前的里程s: <mrow> <mi>s</mi> <mo>=</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <msub> <mi>N</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>N</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>*</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mi>A</mi> <mo>)</mo> </mrow> </mrow> <mn>2</mn> </mfrac> </mrow>或 <mrow> <mi>s</mi> <mo>=</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <msub> <mi>N</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>N</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>*</mo> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <mn>2</mn> <mi>R</mi> <mo>)</mo> </mrow> </mrow> <mn>2</mn> </mfrac> <mo>,</mo> </mrow>式中,A表示磁条的长度,R表示磁道钉的半径。
地址 400044 重庆市沙坪坝区沙正街174号