一種基于電子羅盤的智能小車行走定位方法

基本信息

申請?zhí)?/td> CN201410319367.X 申請日 -
公開(公告)號 CN104049635A 公開(公告)日 2014-09-17
申請公布號 CN104049635A 申請公布日 2014-09-17
分類號 G05D1/02(2006.01)I 分類 控制;調(diào)節(jié);
發(fā)明人 趙亮;張義德 申請(專利權(quán))人 浙江海曼機(jī)器人有限公司
代理機(jī)構(gòu) 杭州求是專利事務(wù)所有限公司 代理人 林超
地址 315336 浙江省杭州市杭州灣新區(qū)興慈大道濱海五路
法律狀態(tài) -

摘要

摘要 本發(fā)明公開了一種基于電子羅盤的智能小車行走定位方法。包括電子羅盤模塊,驅(qū)動系統(tǒng)模塊,位置計(jì)算模塊和控制中心模塊,位置計(jì)算模塊的位置定位計(jì)算包括:將小車的車輪外表面周長和車輪轉(zhuǎn)動的圈數(shù)相乘得到小車在該方向的行進(jìn)路程;以出發(fā)點(diǎn)、向東和向北分別作為原點(diǎn)、X軸和Y軸;從出發(fā)點(diǎn)根據(jù)某方向下的行進(jìn)路程以及該方向與X、Y軸的夾角得到相對于原點(diǎn)的坐標(biāo)增量,得到實(shí)時坐標(biāo);繼續(xù)另一方向行駛,根據(jù)該方向的行駛路程以及該方向與X、Y軸的夾角得到新的坐標(biāo)增量,加上改變方向前的坐標(biāo)得到新坐標(biāo),以此重復(fù)得到小車的實(shí)時位置。本發(fā)明可實(shí)現(xiàn)相對于出發(fā)點(diǎn)位置的自身位置確定,在已知環(huán)境區(qū)域可以通過程序控制來使小車行駛到目標(biāo)位置。