]> rtime.felk.cvut.cz Git - eurobot/public.git/commitdiff
hokuyo: Fix bug in hokuyo transformation
authorMatous Pokorny <matous.pokorny@me.com>
Fri, 28 Sep 2012 19:43:41 +0000 (21:43 +0200)
committerMatous Pokorny <matous.pokorny@me.com>
Fri, 28 Sep 2012 19:44:38 +0000 (21:44 +0200)
src/hokuyo/hokuyo.h

index c4c90f61ffcb7e3000573375619f2b77586193e3..962d63766eba083f7aff4b78e7af2c198c74065a 100644 (file)
@@ -14,6 +14,6 @@
 #define HOKUYO_INDEX_TO_DEG(x) ((HOKUYO_START_ANGLE-(x)*360.0/HOKUYO_SPLIT_DIVISION) * HOKUYO_ORIENTATION)
 #define HOKUYO_INDEX_TO_RAD(x) (HOKUYO_INDEX_TO_DEG(x)/180.0*M_PI)
 
-#define HOKUYO_DEG_TO_INDEX(d) ((HOKUYO_START_ANGLE-(d))/(360.0/HOKUYO_SPLIT_DIVISION))
+#define HOKUYO_DEG_TO_INDEX(d) ((HOKUYO_START_ANGLE-(d)/HOKUYO_ORIENTATION)/(360.0/HOKUYO_SPLIT_DIVISION))
 
 #endif //HOKUYO_H