发明名称 |
磁导航自主轮式移动机器人的里程检测方法 |
摘要 |
本发明公开了一种磁导航自主轮式移动机器人的里程检测方法,包括以下步骤:步骤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号 |