update g4 reversion

yangfuyuan · Jul 17, 2018 · 3e38a49 · 3e38a49
1 parent 94441c3
commit 3e38a49
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/CYdLidar.cpp b/src/CYdLidar.cpp
@@ -136,7 +136,7 @@ bool  CYdLidar::doProcessSimple(LaserScan &outscan,LaserScan &syncscan, PointClo
             for( ; i < count; i++) {
                 if ((nodes[i].distance_q) != 0) {
                     float angle = (float)((nodes[i].angle_q6_checkbit >> LIDAR_RESP_MEASUREMENT_ANGLE_SHIFT)/64.0f);
-                    if(reversion&&m_Reversion){
+                    if(reversion&&!m_Reversion){
                        angle=angle+180;
                        if(angle>=360){ angle=angle-360;}
                         nodes[i].angle_q6_checkbit = ((uint16_t)(angle * 64.0f)) << LIDAR_RESP_MEASUREMENT_ANGLE_SHIFT;