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

index 8a92cbe0a41b500c3583b6618ea879d22d2b5640..ede488b3156a9ac904e8a5ff375d92b4ef6ad7e7 100644 (file)
@@ -12,6 +12,6 @@
 #define SICK_INDEX_TO_DEG(x) ((SICK_START_ANGLE-(x)*360.0/SICK_SPLIT_DIVISION) * SICK_ORIENTATION)
 #define SICK_INDEX_TO_RAD(x) (SICK_INDEX_TO_DEG(x)/180.0*M_PI)
 
-#define SICK_DEG_TO_INDEX(d) ((SICK_START_ANGLE-(d))/(360.0/SICK_SPLIT_DIVISION))
+#define SICK_DEG_TO_INDEX(d) ((SICK_START_ANGLE-(d)/SICK_ORIENTATION)/(360.0/SICK_SPLIT_DIVISION))
 
 #endif //SICK_H