一種基于電子羅盤的智能小車行走定位方法
基本信息
申請?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)位置。 |
